Hello Stratlis, I have been in the same time of situation of having to use a PID process control to correct the drift on my robot. I recommend a post called “Correcting drift with a PID process control”. Link: Correcting Drift with a PID process control
From, 12510X MechaManiax