Add single source shortest path implementation