C++ Code for the 2014 Season Robot