Fix to PID controller

The integral term does not reset now once the setpoint is reached.