Hemingroth / Pathfinding using A* search algorithm