Robot control code for the Cal Poly Robotics Club's 2005 entry into the Roborodentia competition