Chantilly Robotics Code for 2012 FRC Challenge