Implement CreatePathDijkstra() and CreatePathAStar()