Add new module for whole body joint torque control