Team 1922's C++ code for the 2012 FRC competition