PID controller overflow fixed