NOTE: Programming is not done (our setpoints are not set... yet) Also most of this video was more of early week six/ late week five. Autonomous was 100% Reliable on hanging straight. Then we put a gyro on for the Y and it screwed up the code somehow, i just got back from the shop and already have a good idea of how to make our wheel encoders a gyro... Control-Z did not fix it... Oh did i mention we are writing our own pid loop that saves motors

?