Pathfinding with Dijkstra and A*