Some changes, but not complete for the JOINT_TRAJ_PT_FULL_EX messages