way-points drift away everytime for amcl navigation
Running in the simulation with the clearpath husky. I have husky gazebo running at the background. What I intend is to have a set of waypoints and send it as goals through move base.
I tried waypoint_generator at first and declared a set of waypoints around in yaml and when I replayed my map with the yaml the waypoints have already drifted. The yaml looks like series of similar points :
waypoints:
- frame_id: odom
name: 3.74155664444_0.696490764618
pose:
orientation:
w: 1
x: 0
y: 0
z: 2.4
position:
x: 5.0515566444396973
y: 2.4264907646179199
z: 0.0
e.g. The originally (1,1,1) position set when replayed has moved to some other location. This is how the drifted waypoints look like.
It could be probably due to the gazebo, for which the world space and coordinates are continuously changing, as a result, the scans don't match too.
Then I also tried using this script that converting amcl pose to 2D Euler and then declares an initial pose and sends a sequence of goals. I configured to my initial pose and a set of 6 points. However as I relaunch the static map, all the points have already moved. As a result, it can never reach its goal and the loop of sending the goal never ends.
Any idea how to stop this drifting of the waypoints and improve the localization.
waypoints
does it do the same if you change the frame_id to map in the yaml?
@harshal Hello that solves the problem, thanks a lot. However now at some waypoints, it gets stuck for a while at times trying to get out of the way. Could not quite realize why such a behavior is occurring.
Gets stuck, as in it can't create a plan(planner) or can't execute the plan(controller)?
If while it is stuck, you can still see the plan by the global planner, try re configuring your local planner params (footprint(global and local), dist from obstacle, inflation,etc)
Thanks @harshal. I guess I have taken care of it in the real robot... anyways just a video of the getting stuck thing, you are probably right about the footprint and inflation. https://drive.google.com/open?id=1tmp...