Estimate speed and position error from motor current, torque