Robotics code used by the Rolling Thunder Robotics Team