The firmware to my National Robotics Challenge entry (4/7/13)