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](https://github.com/MengGuo/Jackal_Velodyne_Duke/blob/master/navigation/seq_goal_nav.py) 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.
↧