Changed PID Calculation - Seems to work a bit better.
Changed PID Calculation - Seems to work a bit better.