Supress torque controller error

- Supress error message of torque controller using debugLevel. (no message in default value 0).
- Output qRefIn from qRefOut when TorqueController is not working due to some fault of input.