Logo AND Algorithmique Numérique Distribuée

Public GIT Repository
Merge branch 'master' into CRTP
[simgrid.git] / src / kernel / routing / DijkstraZone.cpp
1 /* Copyright (c) 2009-2019. The SimGrid Team. All rights reserved.          */
2
3 /* This program is free software; you can redistribute it and/or modify it
4  * under the terms of the license (GNU LGPL) which comes with this package. */
5
6 #include "simgrid/kernel/routing/DijkstraZone.hpp"
7 #include "simgrid/kernel/routing/NetPoint.hpp"
8 #include "src/surf/network_interface.hpp"
9 #include "src/surf/xml/platf_private.hpp"
10 #include "surf/surf.hpp"
11 #include "xbt/string.hpp"
12
13 #include <cfloat>
14 #include <queue>
15 #include <vector>
16
17 XBT_LOG_NEW_DEFAULT_SUBCATEGORY(surf_route_dijkstra, surf, "Routing part of surf -- dijkstra routing logic");
18
19 namespace simgrid {
20 namespace kernel {
21 namespace routing {
22
23 class GraphNodeData {
24 public:
25   explicit GraphNodeData(int id) : id_(id) {}
26   int id_;
27   int graph_id_ = -1; /* used for caching internal graph id's */
28 };
29
30 DijkstraZone::DijkstraZone(NetZoneImpl* father, const std::string& name, resource::NetworkModel* netmodel, bool cached)
31     : RoutedZone(father, name, netmodel), cached_(cached)
32 {
33 }
34
35 static void graph_node_data_free(void* n)
36 {
37   delete static_cast<simgrid::kernel::routing::GraphNodeData*>(n);
38 }
39
40 static void graph_edge_data_free(void* e)
41 {
42   delete static_cast<simgrid::kernel::routing::RouteCreationArgs*>(e);
43 }
44
45 DijkstraZone::~DijkstraZone()
46 {
47   xbt_graph_free_graph(route_graph_, &graph_node_data_free, &graph_edge_data_free, nullptr);
48 }
49
50 void DijkstraZone::seal()
51 {
52   unsigned int cursor;
53   xbt_node_t node = nullptr;
54
55   if (not route_graph_)
56     route_graph_ = xbt_graph_new_graph(1, nullptr);
57
58   /* Add the loopback if needed */
59   if (network_model_->loopback_ && hierarchy_ == RoutingMode::base) {
60
61     xbt_dynar_foreach (xbt_graph_get_nodes(route_graph_), cursor, node) {
62       bool found = false;
63       xbt_edge_t edge = nullptr;
64       unsigned int cursor2;
65       xbt_dynar_foreach (xbt_graph_node_get_outedges(node), cursor2, edge) {
66         if (xbt_graph_edge_get_target(edge) == node) { // There is an edge from node to itself
67           found = true;
68           break;
69         }
70       }
71
72       if (not found) {
73         RouteCreationArgs* route = new simgrid::kernel::routing::RouteCreationArgs();
74         route->link_list.push_back(network_model_->loopback_);
75         xbt_graph_new_edge(route_graph_, node, node, route);
76       }
77     }
78   }
79
80   /* initialize graph indexes in nodes after graph has been built */
81   xbt_dynar_t nodes = xbt_graph_get_nodes(route_graph_);
82
83   xbt_dynar_foreach (nodes, cursor, node) {
84     GraphNodeData* data = static_cast<GraphNodeData*>(xbt_graph_node_get_data(node));
85     data->graph_id_     = cursor;
86   }
87 }
88
89 xbt_node_t DijkstraZone::route_graph_new_node(int id)
90 {
91   xbt_node_t node = xbt_graph_new_node(route_graph_, new GraphNodeData(id));
92   graph_node_map_.emplace(id, node);
93
94   return node;
95 }
96
97 xbt_node_t DijkstraZone::node_map_search(int id)
98 {
99   auto ret = graph_node_map_.find(id);
100   return ret == graph_node_map_.end() ? nullptr : ret->second;
101 }
102
103 /* Parsing */
104
105 void DijkstraZone::get_local_route(NetPoint* src, NetPoint* dst, RouteCreationArgs* route, double* lat)
106 {
107   get_route_check_params(src, dst);
108   int src_id = src->id();
109   int dst_id = dst->id();
110
111   xbt_dynar_t nodes = xbt_graph_get_nodes(route_graph_);
112
113   /* Use the graph_node id mapping set to quickly find the nodes */
114   xbt_node_t src_elm = node_map_search(src_id);
115   xbt_node_t dst_elm = node_map_search(dst_id);
116
117   int src_node_id = static_cast<GraphNodeData*>(xbt_graph_node_get_data(src_elm))->graph_id_;
118   int dst_node_id = static_cast<GraphNodeData*>(xbt_graph_node_get_data(dst_elm))->graph_id_;
119
120   /* if the src and dst are the same */
121   if (src_node_id == dst_node_id) {
122
123     xbt_node_t node_s_v = xbt_dynar_get_as(nodes, src_node_id, xbt_node_t);
124     xbt_node_t node_e_v = xbt_dynar_get_as(nodes, dst_node_id, xbt_node_t);
125     xbt_edge_t edge     = xbt_graph_get_edge(route_graph_, node_s_v, node_e_v);
126
127     if (edge == nullptr)
128       throw std::invalid_argument(xbt::string_printf("No route from '%s' to '%s'", src->get_cname(), dst->get_cname()));
129
130     RouteCreationArgs* e_route = static_cast<RouteCreationArgs*>(xbt_graph_edge_get_data(edge));
131
132     for (auto const& link : e_route->link_list) {
133       route->link_list.insert(route->link_list.begin(), link);
134       if (lat)
135         *lat += static_cast<resource::LinkImpl*>(link)->get_latency();
136     }
137   }
138
139   auto elm                   = route_cache_.emplace(src_id, std::vector<int>());
140   std::vector<int>& pred_arr = elm.first->second;
141
142   if (elm.second) { /* new element was inserted (not cached mode, or cache miss) */
143     int nr_nodes      = xbt_dynar_length(nodes);
144     std::vector<double> cost_arr(nr_nodes); /* link cost from src to other hosts */
145     pred_arr.resize(nr_nodes);              /* predecessors in path from src */
146     typedef std::pair<double, int> Qelt;
147     std::priority_queue<Qelt, std::vector<Qelt>, std::greater<Qelt>> pqueue;
148
149     /* initialize */
150     cost_arr[src_node_id] = 0.0;
151
152     for (int i = 0; i < nr_nodes; i++) {
153       if (i != src_node_id) {
154         cost_arr[i] = DBL_MAX;
155       }
156
157       pred_arr[i] = 0;
158
159       /* initialize priority queue */
160       pqueue.emplace(cost_arr[i], i);
161     }
162
163     /* apply dijkstra using the indexes from the graph's node array */
164     while (not pqueue.empty()) {
165       int v_id = pqueue.top().second;
166       pqueue.pop();
167       xbt_node_t v_node = xbt_dynar_get_as(nodes, v_id, xbt_node_t);
168       xbt_edge_t edge   = nullptr;
169       unsigned int cursor;
170
171       xbt_dynar_foreach (xbt_graph_node_get_outedges(v_node), cursor, edge) {
172         xbt_node_t u_node                  = xbt_graph_edge_get_target(edge);
173         GraphNodeData* data                = static_cast<GraphNodeData*>(xbt_graph_node_get_data(u_node));
174         int u_id                           = data->graph_id_;
175         RouteCreationArgs* tmp_e_route     = static_cast<RouteCreationArgs*>(xbt_graph_edge_get_data(edge));
176         int cost_v_u                       = tmp_e_route->link_list.size(); /* count of links, old model assume 1 */
177
178         if (cost_v_u + cost_arr[v_id] < cost_arr[u_id]) {
179           pred_arr[u_id] = v_id;
180           cost_arr[u_id] = cost_v_u + cost_arr[v_id];
181           pqueue.emplace(cost_arr[u_id], u_id);
182         }
183       }
184     }
185   }
186
187   /* compose route path with links */
188   NetPoint* gw_src   = nullptr;
189   NetPoint* first_gw = nullptr;
190
191   for (int v = dst_node_id; v != src_node_id; v = pred_arr[v]) {
192     xbt_node_t node_pred_v = xbt_dynar_get_as(nodes, pred_arr[v], xbt_node_t);
193     xbt_node_t node_v      = xbt_dynar_get_as(nodes, v, xbt_node_t);
194     xbt_edge_t edge        = xbt_graph_get_edge(route_graph_, node_pred_v, node_v);
195
196     if (edge == nullptr)
197       throw std::invalid_argument(xbt::string_printf("No route from '%s' to '%s'", src->get_cname(), dst->get_cname()));
198
199     RouteCreationArgs* e_route = static_cast<RouteCreationArgs*>(xbt_graph_edge_get_data(edge));
200
201     NetPoint* prev_gw_src = gw_src;
202     gw_src                = e_route->gw_src;
203     NetPoint* gw_dst      = e_route->gw_dst;
204
205     if (v == dst_node_id)
206       first_gw = gw_dst;
207
208     if (hierarchy_ == RoutingMode::recursive && v != dst_node_id && gw_dst->get_name() != prev_gw_src->get_name()) {
209       std::vector<resource::LinkImpl*> e_route_as_to_as;
210
211       NetPoint* gw_dst_net_elm      = nullptr;
212       NetPoint* prev_gw_src_net_elm = nullptr;
213       get_global_route(gw_dst_net_elm, prev_gw_src_net_elm, e_route_as_to_as, nullptr);
214       auto pos = route->link_list.begin();
215       for (auto const& link : e_route_as_to_as) {
216         route->link_list.insert(pos, link);
217         if (lat)
218           *lat += link->get_latency();
219         pos++;
220       }
221     }
222
223     for (auto const& link : e_route->link_list) {
224       route->link_list.insert(route->link_list.begin(), link);
225       if (lat)
226         *lat += static_cast<resource::LinkImpl*>(link)->get_latency();
227     }
228   }
229
230   if (hierarchy_ == RoutingMode::recursive) {
231     route->gw_src = gw_src;
232     route->gw_dst = first_gw;
233   }
234
235   if (not cached_)
236     route_cache_.clear();
237 }
238
239 void DijkstraZone::add_route(NetPoint* src, NetPoint* dst, NetPoint* gw_src, NetPoint* gw_dst,
240                              std::vector<resource::LinkImpl*>& link_list, bool symmetrical)
241 {
242   add_route_check_params(src, dst, gw_src, gw_dst, link_list, symmetrical);
243
244   if (not route_graph_)
245     route_graph_ = xbt_graph_new_graph(1, nullptr);
246
247   new_edge(src->id(), dst->id(), new_extended_route(hierarchy_, src, dst, gw_src, gw_dst, link_list, symmetrical, 1));
248
249   if (symmetrical == true)
250     new_edge(dst->id(), src->id(), new_extended_route(hierarchy_, dst, src, gw_dst, gw_src, link_list, symmetrical, 0));
251 }
252
253 void DijkstraZone::new_edge(int src_id, int dst_id, simgrid::kernel::routing::RouteCreationArgs* route)
254 {
255   XBT_DEBUG("Create Route from '%d' to '%d'", src_id, dst_id);
256
257   // Get the extremities, or create them if they don't exist yet
258   xbt_node_t src = node_map_search(src_id);
259   if (src == nullptr)
260     src = route_graph_new_node(src_id);
261
262   xbt_node_t dst = node_map_search(dst_id);
263   if (dst == nullptr)
264     dst = route_graph_new_node(dst_id);
265
266   // Make sure that this graph edge was not already added to the graph
267   if (xbt_graph_get_edge(route_graph_, src, dst) != nullptr) {
268     if (route->gw_dst == nullptr || route->gw_src == nullptr)
269       throw std::invalid_argument(
270           xbt::string_printf("Route from %s to %s already exists", route->src->get_cname(), route->dst->get_cname()));
271     else
272       throw std::invalid_argument(xbt::string_printf("Route from %s@%s to %s@%s already exists",
273                                                      route->src->get_cname(), route->gw_src->get_cname(),
274                                                      route->dst->get_cname(), route->gw_dst->get_cname()));
275   }
276
277   // Finally add it
278   xbt_graph_new_edge(route_graph_, src, dst, route);
279 }
280 }
281 }
282 } // namespace