Allow Queuing Multiple Trajectories #6
Description
Allow the user to submit multiple trajectory goals to be executed sequentially instead of just preempting the current trajectory when receiving a new one.
This would require #4 to be completed first in order to provide guarantees about ending position being within acceptable tolerance of subsequent trajectories' starting position.