Add Dijkstra path finding example