Fixed dimension problem with the user torques, added gc when the controller is not enabled