Get the PID3 working in auton and driver