C++ Code for the 2012 Season Robot