Add integral part to the PID controller