C++ code for the 2015 robot