Add initial implementation of path search based on Dijkstra's algorithm.