-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathsolver.py
79 lines (59 loc) · 1.87 KB
/
solver.py
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
class Node(object):
def __init__(self, V):
self.V = V
self.edges = {}
def add_edge(self, node, cost):
self.edges[node] = cost
class Graph(object):
def __init__(self, vertices):
self.vertices = {
n: {
'distance': float('inf'),
'previous': None,
'visited' : False
} for n in vertices
}
def min_distance(self):
min_dist = float('inf')
node = None
for v in self.vertices:
if not self.is_visited(v) and self.get_distance(v) < min_dist:
min_dist = self.get_distance(v)
node = v
return node
def is_visited(self, node):
return self.vertices[node]['visited']
def mark_as_visited(self, node):
self.vertices[node]['visited'] = True
def get_distance(self, node):
return self.vertices[node]['distance']
def set_distance(self, node, distance):
self.vertices[node]['distance'] = distance
def set_previous(self, node, previous):
self.vertices[node]['previous'] = previous
def get_previous_from(self, node):
return self.vertices[node]['previous']
def dijkstra(self, source):
# Initialize source with zero distance
self.set_distance(source, 0)
node = self.min_distance()
while node:
for edge, edge_distance in node.edges.items():
if self.is_visited(edge):
continue
# Calculate the distance to the edge and, if shorter,
# updates the vertex distance and previous node
d = self.get_distance(node) + edge_distance
if d < self.get_distance(edge):
self.set_distance(edge, d)
self.set_previous(edge, node)
self.mark_as_visited(node)
node = self.min_distance()
def shortest_path(self, source, target):
self.dijkstra(source)
path, node = [], target
while node:
path.append(node)
node = self.get_previous_from(node)
path.reverse()
return path