A package that will buffer move_base
goals until instructed to navigate to all waypoints in sequence.
$ sudo apt-get install ros-kinetic-follow-waypoints
Documentation on wiki: http://wiki.ros.org/follow_waypoints
rosrun follow_waypoints follow_waypoints.py
A wait_duration parameter. This sets wait duration in between waypoints. The default value is set to 0.0 sec.
rosparam set wait_duration 5.0
A distance threshold parameter. Issue the next goal target if the robot reaches within this distance. This has the effect of smoothing motion and not stopping at each waypoint. The default value is set to 0.0 distance which disables the feature.
rosparam set waypoint_distance_tolerance 0.5
follow_waypoints/saved_path/pose.csv
rostopic pub /start_journey std_msgs/Empty -1