The code that I wrote for Robotics class, and then used at the VEX competition