Sample C++ Code for the FRC TEAM 2836