Pass t_param as reference in setTorqueControllerParam
Added const to setTorqueControllerParam argument and debug comments