shortest path algorithm code snippets in csharp