WholeBodyInterface: added offset control parameter to Actuators.
Implemented set pid gains (p,d,i) and offset for torque control (currently only for single joint is implemented. Setting all joints will return false)
Joint Torque Control: changed control from PWM to Torque Mode. I set the proportional gain of the low level torque control to zero and I command only the offset to the PWM value