Code for NXT Maze Solver project written in RobotC