joint_traj_demo tweaks