mj_InvertedPendulum Using Optimzation based Operational-Space Control to track the End-Effector position of the Double Pendulum. Screencast.from.05-16-2022.12.11.42.AM.mov ur5 End-Effector Trajectory and Error ur51.mov