Add impedance control to jointTorqueControl module