Code for the Arduino/NXT Hybrid Test Robot