Add A*-graph-search algorithm