Removed resetting pid_sum when PID is turned on (at beginning they are initialized as 0 already, and when we update the PID parameters or turn it off and on again, this does not reset the last values).