Add more monitoring variables to jointTorqueControl

Add torque error, joint position and desired joint position.