Updated single-dest shortest-path algo