Fixed a reference to the wrong JointTrajectoryPoint