Development C++ code for the 4077 FIRST Robotics Team