A testing version to check required torques
(this uses old MPC controller to get tau (18)
to generate given GRF.
A good reference to compare new generated torques)
Added Point/Torque Actuators on Foot Point
(to apply contact forces and torques on multibody dynamics,
to replace the need to read external load file,
missing: running getControl method)