My junior year of high school, I lead FRC Team 5667's programming team. This is the Java code which controlled our robot.