Add integrated current position. Keep measuring at zero speed/pwm.