C++ Code for the T-Shirt/Test Base Robot