Create Follow Trajectory Action

[amessing]

Create an action that causes the robot to follow a preplanned trajectory

[xxAtrain223]

Theoretically works, needs to be tested on hardware.
Latest work f264a75 on navigation/localization.