removed setControlMode for joints with calib type=0 or 2 or 4