-
Notifications
You must be signed in to change notification settings - Fork 18
Expand file tree
/
Copy pathmap.py
More file actions
267 lines (210 loc) · 9.33 KB
/
Copy pathmap.py
File metadata and controls
267 lines (210 loc) · 9.33 KB
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
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
# Copyright 2024 D-Wave Systems Inc.
#
# Licensed under the Apache License, Version 2.0 (the "License");
# you may not use this file except in compliance with the License.
# You may obtain a copy of the License at
#
# http://www.apache.org/licenses/LICENSE-2.0
#
# Unless required by applicable law or agreed to in writing, software
# distributed under the License is distributed on an "AS IS" BASIS,
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
# See the License for the specific language governing permissions and
# limitations under the License.
from __future__ import annotations
import random
from pathlib import Path
import folium
import folium.plugins as plugins
import networkx as nx
import numpy as np
import osmnx as ox
from folium import Element
from numpy.typing import NDArray
from scipy.spatial import cKDTree
from demo_configs import ADDRESS, DEPOT_LABEL, DISTANCE, RESOURCES
from src.demo_enums import VehicleType
ox.settings.use_cache = True
ox.settings.overpass_rate_limit = False
depot_icon_path = Path(__file__).parent / "static/depot_location.png"
depot_icon = folium.CustomIcon(str(depot_icon_path), icon_size=(30, 48))
def _get_coordinates(node_index_map: dict) -> NDArray:
"""Returns an array of coordinates for all nodes."""
coordinates = np.zeros((len(node_index_map), 2))
for node_index, node in node_index_map.items():
coordinates[node_index][0] = node[1]["y"]
coordinates[node_index][1] = node[1]["x"]
return coordinates
def _find_node_index_central_to_network(node_index_map: dict) -> int:
"""Finds node index central to network."""
coordinates = _get_coordinates(node_index_map)
centroid = np.sum(coordinates, 0) / len(node_index_map)
kd_tree = cKDTree(coordinates)
return kd_tree.query(centroid)[1]
def generate_mapping_information(num_clients: int) -> tuple[nx.MultiDiGraph, int, list, list]:
"""Return ``nx.MultiDiGraph`` with client demand, depot id in graph, client ids in graph.
Args:
num_clients: Number of locations to be visited in total.
Returns:
map_network: ``nx.MultiDiGraph`` where nodes and edges represent locations and routes.
depot_id: Node ID of the depot location.
client_subset: List of client IDs in the map's graph.
map_bounds: List of lower and upper bound locations for map
"""
random.seed(num_clients)
G = ox.graph_from_address(
address=ADDRESS, dist=DISTANCE, network_type="drive", truncate_by_edge=True
)
map_network = ox.truncate.largest_component(G, strongly=True)
node_index_map = dict(enumerate(map_network.nodes(data=True)))
depot_id = node_index_map[_find_node_index_central_to_network(node_index_map)][0]
graph_copy = map_network.copy()
graph_copy.remove_node(depot_id)
client_subset = random.sample(list(graph_copy.nodes), num_clients)
for node_id in client_subset:
map_network.nodes[node_id]["demand"] = 0
for i in range(len(RESOURCES)):
map_network.nodes[node_id][f"resource_{i}"] = random.choice([1, 2])
map_network.nodes[node_id]["demand"] += map_network.nodes[node_id][f"resource_{i}"]
# Get min and max coordinates to determine map bounds
coordinates = _get_coordinates(node_index_map)
map_bounds = [coordinates.min(0).tolist(), coordinates.max(0).tolist()]
return map_network, depot_id, client_subset, map_bounds
def _get_node_info(
G: nx.Graph, node_id: int, icon_name: str
) -> tuple[folium.CustomIcon, list[int]]:
"""Get node demand values and icons for each client location."""
icon_path = Path(__file__).parent / f"static/location_icons/{icon_name}.png"
location_icon = folium.CustomIcon(str(icon_path), icon_size=(30, 48))
return location_icon, [G.nodes[node_id][f"resource_{i}"] * 100 for i in range(len(RESOURCES))]
def show_locations_on_initial_map(
G: nx.MultiDiGraph, depot_id: int, client_subset: list, map_bounds: list[list]
) -> folium.Map:
"""Prepare map to be rendered initially on app screen.
Args:
G: ``nx.MultiDiGraph`` to build map from.
depot_id: Node ID of the depot location.
client_subset: List of client IDs in the map's graph.
Returns:
folium.Map: Map with depot, client locations and tooltip popups.
"""
# create folium map on which to plot depots
tiles = "cartodb positron" # foilum map theme
folium_map = ox.graph_to_gdfs(G, nodes=False, node_geometry=False).explore(
style_kwds={"opacity": 0}, # Change opacity to 1 to see graph edges/roads in blue
tiles=tiles,
)
folium_map.fit_bounds(map_bounds)
# add marker to the depot location
folium.Marker(
location=(G.nodes[depot_id]["y"], G.nodes[depot_id]["x"]),
tooltip=folium.map.Tooltip(text=DEPOT_LABEL, style="font-size: 1.4rem;"),
icon=depot_icon,
).add_to(folium_map)
# add markers to all the client locations
for node_id in client_subset:
if node_id == depot_id:
continue
location_icon, nodes = _get_node_info(G, node_id, "location_orange")
folium.Marker(
location=(G.nodes[node_id]["y"], G.nodes[node_id]["x"]),
tooltip=folium.map.Tooltip(
text=" <br> ".join(
[f"{resource}: {nodes[index]}" for index, resource in enumerate(RESOURCES)]
),
style="font-size: 1.4rem;",
),
icon=location_icon,
).add_to(folium_map)
# add fullscreen button to map
plugins.Fullscreen().add_to(folium_map)
accessibility_css = """
<style>
.leaflet-container .leaflet-control-attribution {
background: white;
}
.leaflet-control-attribution a {
text-decoration: underline !important;
color: #0044cc !important;
}
.leaflet-control-scale-line {
color: #737373 !important;
text-shadow: none;
background: white;
}
</style>
"""
folium_map.get_root().html.add_child(Element(accessibility_css))
return folium_map
def plot_solution_routes_on_map(
folium_map: folium.Map,
routing_parameters,
routing_solver,
) -> folium.folium.Map:
"""Generate interactive folium map for drone routes given solution dictionary.
Args:
folium_map: Initial folium map to plot solution on.
routing_parameters: Routing problem parameters.
routing_solver: Solver class containing the solution (if run).
Returns:
`folium.folium.Map` object, dictionary with solution cost information.
"""
solution_cost_information = {}
G = routing_parameters.map_network
solution = routing_solver.solution
cost = routing_solver.cost_between_nodes
paths = routing_solver.paths_and_lengths
# get colorblind palette from seaborn (10 colors) and expand if more vehicles
palette = [
("location_blue", "#56b4e9"),
("location_yellow", "#ece133"),
("location_grey", "#949494"),
("location_pink", "#fbafe4"),
("location_beige", "#ca9161"),
("location_purple", "#cc78bc"),
("location_orange", "#d55e00"),
("location_green", "#029e73"),
("location_gold", "#de8f05"),
("location_navy", "#0173b2"),
] * (len(solution) // 10 + 1)
locations = {}
for index, route_network in solution.items():
vehicle_id = index + 1
icon_name, route_color = palette.pop()
solution_cost_information[vehicle_id] = {
"optimized_cost": 0,
"serviced": len(route_network.nodes) - 1,
}
for i in range(len(RESOURCES)):
solution_cost_information[vehicle_id][f"resource_{i}"] = 0
for stop_number, node in enumerate(route_network.nodes):
locations.update({node: (G.nodes[node]["y"], G.nodes[node]["x"])})
if node != routing_parameters.depot_id:
location_icon, nodes = _get_node_info(G, node, icon_name)
folium.Marker(
locations[node],
tooltip=folium.map.Tooltip(
text=" <br> ".join(
[f"{resource}: {nodes[i]}" for i, resource in enumerate(RESOURCES)]
)
+ f" <br> Vehicle ID: {vehicle_id} <br> Stop: #{stop_number} of {len(route_network.nodes)-1}",
style="font-size: 1.4rem;",
),
icon=location_icon,
).add_to(folium_map)
for i in range(len(RESOURCES)):
solution_cost_information[vehicle_id][f"resource_{i}"] += nodes[i]
for start, end in route_network.edges:
solution_cost_information[vehicle_id]["optimized_cost"] += cost(
locations[start], locations[end], start, end
)
if routing_parameters.vehicle_type is VehicleType.TRUCKS:
route = paths[start][1][end]
folium_map = ox.graph_to_gdfs(G.subgraph(route), nodes=False).explore(
m=folium_map, color=route_color, style_kwds={"weight": 4}
)
else: # if vehicle_type is DELIVERY_DRONES
folium.PolyLine((locations[start], locations[end]), color=route_color).add_to(
folium_map
)
return folium_map, solution_cost_information