Implemented trajectory action that better mirrors trajectories that can be sent to the arm