- Notifications
You must be signed in to change notification settings - Fork 1.6k
/
Copy pathDijkstraAlgorithm.cs
98 lines (76 loc) · 3.33 KB
/
DijkstraAlgorithm.cs
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
usingSystem;
usingSystem.Collections.Generic;
usingSystem.Linq;
usingDataStructures.Graph;
namespaceAlgorithms.Graph.Dijkstra;
publicstaticclassDijkstraAlgorithm
{
/// <summary>
/// Implementation of the Dijkstra shortest path algorithm for cyclic graphs.
/// https://en.wikipedia.org/wiki/Dijkstra%27s_algorithm.
/// </summary>
/// <param name="graph">Graph instance.</param>
/// <param name="startVertex">Starting vertex instance.</param>
/// <typeparam name="T">Generic Parameter.</typeparam>
/// <returns>List of distances from current vertex to all other vertices.</returns>
/// <exception cref="InvalidOperationException">Exception thrown in case when graph is null or start
/// vertex does not belong to graph instance.</exception>
publicstaticDistanceModel<T>[]GenerateShortestPath<T>(DirectedWeightedGraph<T>graph,Vertex<T>startVertex)
{
ValidateGraphAndStartVertex(graph,startVertex);
varvisitedVertices=newList<Vertex<T>>();
vardistanceArray=InitializeDistanceArray(graph,startVertex);
vardistanceRecord=newPriorityQueue<DistanceModel<T>,double>();
distanceRecord.Enqueue(distanceArray[0],distanceArray[0].Distance);
while(visitedVertices.Count!=distanceArray.Length&&distanceRecord.Count!=0)
{
while(visitedVertices.Contains(distanceRecord.Peek().Vertex!))
{
distanceRecord.Dequeue();
}
varminDistance=distanceRecord.Dequeue();
varcurrentPath=minDistance.Distance;
visitedVertices.Add(minDistance.Vertex!);
varneighborVertices=graph
.GetNeighbors(minDistance.Vertex!)
.Where(x =>x!=null&&!visitedVertices.Contains(x))
.ToList();
foreach(varvertexinneighborVertices)
{
varadjacentDistance=graph.AdjacentDistance(minDistance.Vertex!,vertex!);
vardistance=distanceArray[vertex!.Index];
varfullDistance=currentPath+adjacentDistance;
if(distance.Distance>fullDistance)
{
distance.Distance=fullDistance;
distance.PreviousVertex=minDistance.Vertex;
distanceRecord.Enqueue(distance,fullDistance);
}
}
}
returndistanceArray;
}
privatestaticDistanceModel<T>[]InitializeDistanceArray<T>(
IDirectedWeightedGraph<T>graph,
Vertex<T>startVertex)
{
vardistArray=newDistanceModel<T>[graph.Count];
distArray[startVertex.Index]=newDistanceModel<T>(startVertex,startVertex,0);
foreach(varvertexingraph.Vertices.Where(x =>x!=null&&!x.Equals(startVertex)))
{
distArray[vertex!.Index]=newDistanceModel<T>(vertex,null,double.MaxValue);
}
returndistArray;
}
privatestaticvoidValidateGraphAndStartVertex<T>(DirectedWeightedGraph<T>graph,Vertex<T>startVertex)
{
if(graphisnull)
{
thrownewArgumentNullException(nameof(graph));
}
if(startVertex.Graph!=null&&!startVertex.Graph.Equals(graph))
{
thrownewArgumentNullException(nameof(graph));
}
}
}