Simple Maze Solving Algorithm Python Code