Start work on pathfinding. Next step is push indeces onto stack and fill pathMap