PID function to reduce drift

[Jared]

You should not shut off your pid loop when you reach your target. Instead, you should make sure that your error is near zero, and the rate at which your error is changing is near zero.

You should also increase the D gain of your PID controller to decrease the overshoot you're describing. The D gain compensates for the robot's tendency to keep moving when power applied to the motors is zero.