-correction in torque calculation
-mase support in control_mode_torque configurable