Hey guys I just finished my autonomous program on bag night and the next day realised how long and messy it was. So I got some help and made functions but I can't test them
. So if anyone is able to help me here's the github link
https://github.com/curtis0gj/5033-2014-15?files=1.