Path points following

edit

I would suggest setting up a base global planner for the global path and teb local planner for the local one since teb local planner actually supports points.

See http://wiki.ros.org/teb_local_planner

take a look at the subscribed topics you'll find "via_points (nav_msgs/Path)" in the optimization parameters you can weight the local planner to follow the via points more.

Note: You'll need to set global path via point seperation to a negative number. Otherwise the planner will strictly follow the global path since it is supplying the via points now.

It should be fairly simple to implement that behavior.

EDIT:

I just thought about it again, if you run into timing problems between supplying the goal and the via points it might be an option to set everything from one node. Using the actionlib you can provide the goal and a simple publisher can publish your points. Then you can define precise timings and prevent a edgecase where you are supplying waypoints from the past.