Joint torque control: added monitor port, added send command option, fixed bugs