Actually abort trajectories when preempt function is called
Calling the preempt function would just set the action server to preempted, by not stop running the trajectory.
Calling the preempt function would just set the action server to preempted, by not stop running the trajectory.