Maze Code for our Mindstorms NXT, written in NXC (Not Exactly C)