Pathfinding implemented. A* search algorithm.