Improved maze_navigator. Untested in the maze