Code for the ECE 556 project on the NXT brick