Python Find Shortest Path In Maze