Fixed bug with the joint min and max torque commands in the wrong places (SORRY!!!)