Added interface to stop torque control forcely (preserve joint angles), but seq.setJointAngle cannot preserve qCurrent but return to qRef.