Add new compliance msgs, add a modifed JointTrajectory msg