Optimized for low number of total nodes traversed --> all mazes traverse under 500 nodes
Merge branch 'master' of https://github.com/PrincetonRoboticsClub/BrownMaze2013
Small changes to MazeNode class