ds_follow_waypoints Daniel Snider package that will buffer move_base goals until instructed to navigate to all waypoints in sequence.