Position and current, torque control loop