Add position integral to correct pwm offset