Code from the 2013 MechMurf Robot C++