Code to The Force Team 1073's 2009 Robot Loco Foco for FIRST Robotics Competition