Added single-destination shortest path algorithm