Observe speed and select torque as function of position reference, to compensate torque