src/surf/surf_routing_dijkstra.cpp

   1 /* Copyright (c) 2009-2015. The SimGrid Team.
   2  * All rights reserved.                                                     */
   3
   4 /* This program is free software; you can redistribute it and/or modify it
   5  * under the terms of the license (GNU LGPL) which comes with this package. */
   6
   7 #include "src/surf/surf_routing_private.hpp"
   8 #include "src/surf/surf_routing_dijkstra.hpp"
   9 #include "src/surf/network_interface.hpp"
  10
  11 XBT_LOG_NEW_DEFAULT_SUBCATEGORY(surf_route_dijkstra, surf, "Routing part of surf -- dijkstra routing logic");
  12
  13 /* Free functions */
  14
  15 static void route_cache_elem_free(void *e)
  16 {
  17   route_cache_element_t elm = (route_cache_element_t) e;
  18   if (elm) {
  19     xbt_free(elm->pred_arr);
  20     xbt_free(elm);
  21   }
  22 }
  23
  24 static void graph_node_map_elem_free(void *e)
  25 {
  26   graph_node_map_element_t elm = (graph_node_map_element_t) e;
  27   xbt_free(elm);
  28 }
  29
  30 static void graph_edge_data_free(void *e) // FIXME: useless code duplication
  31 {
  32   sg_platf_route_cbarg_t e_route = (sg_platf_route_cbarg_t) e;
  33   if (e_route) {
  34     xbt_dynar_free(&(e_route->link_list));
  35     xbt_free(e_route);
  36   }
  37 }
  38
  39 /* Utility functions */
  40
  41 namespace simgrid {
  42 namespace surf {
  43 void AsDijkstra::Seal()
  44 {
  45   /* Create the topology graph */
  46   if(!p_routeGraph)
  47     p_routeGraph = xbt_graph_new_graph(1, NULL);
  48   if(!p_graphNodeMap)
  49     p_graphNodeMap = xbt_dict_new_homogeneous(&graph_node_map_elem_free);
  50
  51   if (m_cached && !p_routeCache)
  52     p_routeCache = xbt_dict_new_homogeneous(&route_cache_elem_free);
  53
  54   /* Add the loopback if needed */
  55   if (routing_platf->p_loopback && hierarchy_ == SURF_ROUTING_BASE)
  56     addLoopback();
  57
  58   /* initialize graph indexes in nodes after graph has been built */
  59   xbt_dynar_t nodes = xbt_graph_get_nodes(p_routeGraph);
  60
  61   xbt_node_t node = NULL;
  62   unsigned int cursor2;
  63   xbt_dynar_foreach(nodes, cursor2, node) {
  64     graph_node_data_t data = (graph_node_data_t) xbt_graph_node_get_data(node);
  65     data->graph_id = cursor2;
  66   }
  67 }
  68
  69 xbt_node_t AsDijkstra::routeGraphNewNode(int id, int graph_id)
  70 {
  71   xbt_node_t node = NULL;
  72   graph_node_data_t data = NULL;
  73   graph_node_map_element_t elm = NULL;
  74
  75   data = xbt_new0(struct graph_node_data, 1);
  76   data->id = id;
  77   data->graph_id = graph_id;
  78   node = xbt_graph_new_node(p_routeGraph, data);
  79
  80   elm = xbt_new0(struct graph_node_map_element, 1);
  81   elm->node = node;
  82   xbt_dict_set_ext(p_graphNodeMap, (char *) (&id), sizeof(int),
  83       (xbt_dictelm_t) elm, NULL);
  84
  85   return node;
  86 }
  87
  88 graph_node_map_element_t AsDijkstra::nodeMapSearch(int id)
  89 {
  90   graph_node_map_element_t elm = (graph_node_map_element_t)
  91           xbt_dict_get_or_null_ext(p_graphNodeMap,
  92               (char *) (&id),
  93               sizeof(int));
  94   return elm;
  95 }
  96
  97 /* Parsing */
  98
  99 void AsDijkstra::newRoute(int src_id, int dst_id, sg_platf_route_cbarg_t e_route)
 100 {
 101   XBT_DEBUG("Load Route from \"%d\" to \"%d\"", src_id, dst_id);
 102   xbt_node_t src = NULL;
 103   xbt_node_t dst = NULL;
 104
 105   graph_node_map_element_t src_elm = (graph_node_map_element_t)
 106           xbt_dict_get_or_null_ext(p_graphNodeMap,
 107               (char *) (&src_id),
 108               sizeof(int));
 109   graph_node_map_element_t dst_elm = (graph_node_map_element_t)
 110           xbt_dict_get_or_null_ext(p_graphNodeMap,
 111               (char *) (&dst_id),
 112               sizeof(int));
 113
 114
 115   if (src_elm)
 116     src = src_elm->node;
 117
 118   if (dst_elm)
 119     dst = dst_elm->node;
 120
 121   /* add nodes if they don't exist in the graph */
 122   if (src_id == dst_id && src == NULL && dst == NULL) {
 123     src = this->routeGraphNewNode(src_id, -1);
 124     dst = src;
 125   } else {
 126     if (src == NULL) {
 127       src = this->routeGraphNewNode(src_id, -1);
 128     }
 129     if (dst == NULL) {
 130       dst = this->routeGraphNewNode(dst_id, -1);
 131     }
 132   }
 133
 134   /* add link as edge to graph */
 135   xbt_graph_new_edge(p_routeGraph, src, dst, e_route);
 136 }
 137
 138 void AsDijkstra::addLoopback() {
 139   xbt_dynar_t nodes = xbt_graph_get_nodes(p_routeGraph);
 140
 141   xbt_node_t node = NULL;
 142   unsigned int cursor2;
 143   xbt_dynar_foreach(nodes, cursor2, node) {
 144     xbt_dynar_t out_edges = xbt_graph_node_get_outedges(node);
 145     xbt_edge_t edge = NULL;
 146     unsigned int cursor;
 147
 148     int found = 0;
 149     xbt_dynar_foreach(out_edges, cursor, edge) {
 150       xbt_node_t other_node = xbt_graph_edge_get_target(edge);
 151       if (other_node == node) {
 152         found = 1;
 153         break;
 154       }
 155     }
 156
 157     if (!found) {
 158       sg_platf_route_cbarg_t e_route = xbt_new0(s_sg_platf_route_cbarg_t, 1);
 159       e_route->link_list = xbt_dynar_new(sizeof(sg_routing_link_t), NULL);
 160       xbt_dynar_push(e_route->link_list, &routing_platf->p_loopback);
 161       xbt_graph_new_edge(p_routeGraph, node, node, e_route);
 162     }
 163   }
 164 }
 165
 166 xbt_dynar_t AsDijkstra::getOneLinkRoutes()
 167 {
 168   xbt_dynar_t ret = xbt_dynar_new(sizeof(Onelink*), xbt_free_f);
 169   sg_platf_route_cbarg_t route = xbt_new0(s_sg_platf_route_cbarg_t,1);
 170   route->link_list = xbt_dynar_new(sizeof(sg_routing_link_t),NULL);
 171
 172   int src,dst;
 173   NetCard *src_elm, *dst_elm;
 174   int table_size = (int)xbt_dynar_length(vertices_);
 175   for(src=0; src < table_size; src++) {
 176     for(dst=0; dst< table_size; dst++) {
 177       xbt_dynar_reset(route->link_list);
 178       src_elm = xbt_dynar_get_as(vertices_, src, NetCard*);
 179       dst_elm = xbt_dynar_get_as(vertices_, dst, NetCard*);
 180       this->getRouteAndLatency(src_elm, dst_elm,route, NULL);
 181
 182       if (xbt_dynar_length(route->link_list) == 1) {
 183         void *link = *(void **) xbt_dynar_get_ptr(route->link_list, 0);
 184         Onelink *onelink;
 185         if (hierarchy_ == SURF_ROUTING_BASE)
 186           onelink = new Onelink(link, src_elm, dst_elm);
 187         else if (hierarchy_ == SURF_ROUTING_RECURSIVE)
 188           onelink = new Onelink(link, route->gw_src, route->gw_dst);
 189         else
 190           onelink = new Onelink(link, NULL, NULL);
 191         xbt_dynar_push(ret, &onelink);
 192       }
 193     }
 194   }
 195   return ret;
 196 }
 197
 198 void AsDijkstra::getRouteAndLatency(NetCard *src, NetCard *dst, sg_platf_route_cbarg_t route, double *lat)
 199 {
 200
 201   /* set utils vars */
 202
 203   srcDstCheck(src, dst);
 204   int *src_id = src->getIdPtr();
 205   int *dst_id = dst->getIdPtr();
 206
 207   if (!src_id || !dst_id)
 208     THROWF(arg_error,0,"No route from '%s' to '%s'",src->getName(),dst->getName());
 209
 210   int *pred_arr = NULL;
 211   int src_node_id = 0;
 212   int dst_node_id = 0;
 213   int *nodeid = NULL;
 214   int v;
 215   sg_platf_route_cbarg_t e_route;
 216   int size = 0;
 217   unsigned int cpt;
 218   void *link;
 219   xbt_dynar_t links = NULL;
 220   route_cache_element_t elm = NULL;
 221   xbt_dynar_t nodes = xbt_graph_get_nodes(p_routeGraph);
 222
 223   /* Use the graph_node id mapping set to quickly find the nodes */
 224   graph_node_map_element_t src_elm = nodeMapSearch(*src_id);
 225   graph_node_map_element_t dst_elm = nodeMapSearch(*dst_id);
 226
 227   src_node_id = ((graph_node_data_t)
 228       xbt_graph_node_get_data(src_elm->node))->graph_id;
 229   dst_node_id = ((graph_node_data_t)
 230       xbt_graph_node_get_data(dst_elm->node))->graph_id;
 231
 232   /* if the src and dst are the same */
 233   if (src_node_id == dst_node_id) {
 234
 235     xbt_node_t node_s_v = xbt_dynar_get_as(nodes, src_node_id, xbt_node_t);
 236     xbt_node_t node_e_v = xbt_dynar_get_as(nodes, dst_node_id, xbt_node_t);
 237     xbt_edge_t edge = xbt_graph_get_edge(p_routeGraph, node_s_v, node_e_v);
 238
 239     if (edge == NULL)
 240       THROWF(arg_error, 0, "No route from '%s' to '%s'", src->getName(), dst->getName());
 241
 242     e_route = (sg_platf_route_cbarg_t) xbt_graph_edge_get_data(edge);
 243
 244     links = e_route->link_list;
 245     xbt_dynar_foreach(links, cpt, link) {
 246       xbt_dynar_unshift(route->link_list, &link);
 247       if (lat)
 248         *lat += static_cast<Link*>(link)->getLatency();
 249     }
 250
 251   }
 252
 253   if (m_cached) {
 254     /*check if there is a cached predecessor list avail */
 255     elm = (route_cache_element_t)
 256             xbt_dict_get_or_null_ext(p_routeCache, (char *) (&src_id),
 257                 sizeof(int));
 258   }
 259
 260   if (elm) {                    /* cached mode and cache hit */
 261     pred_arr = elm->pred_arr;
 262   } else {                      /* not cached mode or cache miss */
 263     double *cost_arr = NULL;
 264     xbt_heap_t pqueue = NULL;
 265     int i = 0;
 266
 267     int nr_nodes = xbt_dynar_length(nodes);
 268     cost_arr = xbt_new0(double, nr_nodes);      /* link cost from src to other hosts */
 269     pred_arr = xbt_new0(int, nr_nodes); /* predecessors in path from src */
 270     pqueue = xbt_heap_new(nr_nodes, xbt_free_f);
 271
 272     /* initialize */
 273     cost_arr[src_node_id] = 0.0;
 274
 275     for (i = 0; i < nr_nodes; i++) {
 276       if (i != src_node_id) {
 277         cost_arr[i] = DBL_MAX;
 278       }
 279
 280       pred_arr[i] = 0;
 281
 282       /* initialize priority queue */
 283       nodeid = xbt_new0(int, 1);
 284       *nodeid = i;
 285       xbt_heap_push(pqueue, nodeid, cost_arr[i]);
 286
 287     }
 288
 289     /* apply dijkstra using the indexes from the graph's node array */
 290     while (xbt_heap_size(pqueue) > 0) {
 291       int *v_id = (int *) xbt_heap_pop(pqueue);
 292       xbt_node_t v_node = xbt_dynar_get_as(nodes, *v_id, xbt_node_t);
 293       xbt_dynar_t out_edges = xbt_graph_node_get_outedges(v_node);
 294       xbt_edge_t edge = NULL;
 295       unsigned int cursor;
 296
 297       xbt_dynar_foreach(out_edges, cursor, edge) {
 298         xbt_node_t u_node = xbt_graph_edge_get_target(edge);
 299         graph_node_data_t data = (graph_node_data_t) xbt_graph_node_get_data(u_node);
 300         int u_id = data->graph_id;
 301         sg_platf_route_cbarg_t tmp_e_route = (sg_platf_route_cbarg_t) xbt_graph_edge_get_data(edge);
 302         int cost_v_u = (tmp_e_route->link_list)->used;    /* count of links, old model assume 1 */
 303
 304         if (cost_v_u + cost_arr[*v_id] < cost_arr[u_id]) {
 305           pred_arr[u_id] = *v_id;
 306           cost_arr[u_id] = cost_v_u + cost_arr[*v_id];
 307           nodeid = xbt_new0(int, 1);
 308           *nodeid = u_id;
 309           xbt_heap_push(pqueue, nodeid, cost_arr[u_id]);
 310         }
 311       }
 312
 313       /* free item popped from pqueue */
 314       xbt_free(v_id);
 315     }
 316
 317     xbt_free(cost_arr);
 318     xbt_heap_free(pqueue);
 319   }
 320
 321   /* compose route path with links */
 322   NetCard *gw_src = NULL, *gw_dst, *prev_gw_src, *first_gw = NULL;
 323   NetCard *gw_dst_net_elm = NULL, *prev_gw_src_net_elm = NULL;
 324
 325   for (v = dst_node_id; v != src_node_id; v = pred_arr[v]) {
 326     xbt_node_t node_pred_v =
 327         xbt_dynar_get_as(nodes, pred_arr[v], xbt_node_t);
 328     xbt_node_t node_v = xbt_dynar_get_as(nodes, v, xbt_node_t);
 329     xbt_edge_t edge =
 330         xbt_graph_get_edge(p_routeGraph, node_pred_v, node_v);
 331
 332     if (edge == NULL)
 333       THROWF(arg_error, 0, "No route from '%s' to '%s'", src->getName(), dst->getName());
 334
 335     prev_gw_src = gw_src;
 336
 337     e_route = (sg_platf_route_cbarg_t) xbt_graph_edge_get_data(edge);
 338     gw_src = e_route->gw_src;
 339     gw_dst = e_route->gw_dst;
 340
 341     if (v == dst_node_id)
 342       first_gw = gw_dst;
 343
 344     if (hierarchy_ == SURF_ROUTING_RECURSIVE && v != dst_node_id
 345         && strcmp(gw_dst->getName(), prev_gw_src->getName())) {
 346       xbt_dynar_t e_route_as_to_as=NULL;
 347
 348       routing_platf->getRouteAndLatency(gw_dst_net_elm, prev_gw_src_net_elm, &e_route_as_to_as, NULL);
 349       if (edge == NULL)
 350         THROWF(arg_error,0,"No route from '%s' to '%s'", src->getName(), dst->getName());
 351       links = e_route_as_to_as;
 352       int pos = 0;
 353       xbt_dynar_foreach(links, cpt, link) {
 354         xbt_dynar_insert_at(route->link_list, pos, &link);
 355         if (lat)
 356           *lat += static_cast<Link*>(link)->getLatency();
 357         pos++;
 358       }
 359     }
 360
 361     links = e_route->link_list;
 362     xbt_dynar_foreach(links, cpt, link) {
 363       xbt_dynar_unshift(route->link_list, &link);
 364       if (lat)
 365         *lat += static_cast<Link*>(link)->getLatency();
 366     }
 367     size++;
 368   }
 369
 370   if (hierarchy_ == SURF_ROUTING_RECURSIVE) {
 371     route->gw_src = gw_src;
 372     route->gw_dst = first_gw;
 373   }
 374
 375   if (m_cached && elm == NULL) {
 376     /* add to predecessor list of the current src-host to cache */
 377     elm = xbt_new0(struct route_cache_element, 1);
 378     elm->pred_arr = pred_arr;
 379     elm->size = size;
 380     xbt_dict_set_ext(p_routeCache, (char *) (&src_id), sizeof(int),
 381         (xbt_dictelm_t) elm, NULL);
 382   }
 383
 384   if (!m_cached)
 385     xbt_free(pred_arr);
 386 }
 387
 388 AsDijkstra::~AsDijkstra()
 389 {
 390   xbt_graph_free_graph(p_routeGraph, &xbt_free_f,
 391       &graph_edge_data_free, &xbt_free_f);
 392   xbt_dict_free(&p_graphNodeMap);
 393   if (m_cached)
 394     xbt_dict_free(&p_routeCache);
 395 }
 396
 397 /* Creation routing model functions */
 398
 399 AsDijkstra::AsDijkstra(const char*name, bool cached)
 400   : AsGeneric(name)
 401   , m_cached(cached)
 402 {
 403   p_routeGraph = NULL;
 404   p_graphNodeMap = NULL;
 405   p_routeCache = NULL;
 406   /*new_component->generic_routing.parse_route = model_dijkstra_both_parse_route;
 407   new_component->generic_routing.parse_ASroute = model_dijkstra_both_parse_route;
 408   new_component->generic_routing.get_route_and_latency = dijkstra_get_route_and_latency;
 409   new_component->generic_routing.get_onelink_routes =
 410       dijkstra_get_onelink_routes;
 411   new_component->generic_routing.get_graph = generic_get_graph;
 412   new_component->generic_routing.finalize = dijkstra_finalize;
 413   new_component->cached = cached;*/
 414 }
 415
 416 void AsDijkstra::end()
 417 {
 418   xbt_node_t node = NULL;
 419   unsigned int cursor2;
 420   xbt_dynar_t nodes = NULL;
 421
 422   /* Create the topology graph */
 423   if(!p_routeGraph)
 424   p_routeGraph = xbt_graph_new_graph(1, NULL);
 425   if(!p_graphNodeMap)
 426     p_graphNodeMap = xbt_dict_new_homogeneous(&graph_node_map_elem_free);
 427
 428   if (m_cached && !p_routeCache)
 429     p_routeCache = xbt_dict_new_homogeneous(&route_cache_elem_free);
 430
 431   /* Add the loopback if needed */
 432   if (routing_platf->p_loopback && hierarchy_ == SURF_ROUTING_BASE)
 433     addLoopback();
 434
 435   /* initialize graph indexes in nodes after graph has been built */
 436   nodes = xbt_graph_get_nodes(p_routeGraph);
 437
 438   xbt_dynar_foreach(nodes, cursor2, node) {
 439     graph_node_data_t data = (graph_node_data_t) xbt_graph_node_get_data(node);
 440     data->graph_id = cursor2;
 441   }
 442
 443 }
 444
 445 void AsDijkstra::parseASroute(sg_platf_route_cbarg_t route)
 446 {
 447   parseRoute(route);
 448 }
 449
 450 void AsDijkstra::parseRoute(sg_platf_route_cbarg_t route)
 451 {
 452   char *src = (char*)(route->src);
 453   char *dst = (char*)(route->dst);
 454
 455   int as_route = 0;
 456   if(!route->gw_dst && !route->gw_src)
 457     XBT_DEBUG("Load Route from \"%s\" to \"%s\"", src, dst);
 458   else{
 459     XBT_DEBUG("Load ASroute from \"%s(%s)\" to \"%s(%s)\"", src,
 460         route->gw_src->getName(), dst, route->gw_dst->getName());
 461     as_route = 1;
 462     if(route->gw_dst->getRcType() == SURF_NETWORK_ELEMENT_NULL)
 463       surf_parse_error("The gw_dst '%s' does not exist!",route->gw_dst->getName());
 464     if(route->gw_src->getRcType() == SURF_NETWORK_ELEMENT_NULL)
 465       surf_parse_error("The gw_src '%s' does not exist!",route->gw_src->getName());
 466   }
 467
 468   NetCard *src_net_elm, *dst_net_elm;
 469
 470   src_net_elm = sg_netcard_by_name_or_null(src);
 471   dst_net_elm = sg_netcard_by_name_or_null(dst);
 472
 473   xbt_assert(src_net_elm, "Network elements %s not found", src);
 474   xbt_assert(dst_net_elm, "Network elements %s not found", dst);
 475
 476   /* Create the topology graph */
 477   if(!p_routeGraph)
 478     p_routeGraph = xbt_graph_new_graph(1, NULL);
 479   if(!p_graphNodeMap)
 480     p_graphNodeMap = xbt_dict_new_homogeneous(&graph_node_map_elem_free);
 481
 482   if (m_cached && !p_routeCache)
 483     p_routeCache = xbt_dict_new_homogeneous(&route_cache_elem_free);
 484
 485   sg_platf_route_cbarg_t e_route = newExtendedRoute(hierarchy_, route, 1);
 486   newRoute(src_net_elm->getId(), dst_net_elm->getId(), e_route);
 487
 488   // Symmetrical YES
 489   if ( (route->symmetrical == TRUE && as_route == 0)
 490       || (route->symmetrical == TRUE && as_route == 1)
 491   )
 492   {
 493     if(!route->gw_dst && !route->gw_src)
 494       XBT_DEBUG("Load Route from \"%s\" to \"%s\"", dst, src);
 495     else
 496       XBT_DEBUG("Load ASroute from \"%s(%s)\" to \"%s(%s)\"", dst,
 497           route->gw_dst->getName(), src, route->gw_src->getName());
 498
 499     xbt_dynar_t nodes = xbt_graph_get_nodes(p_routeGraph);
 500     xbt_node_t node_s_v = xbt_dynar_get_as(nodes, src_net_elm->getId(), xbt_node_t);
 501     xbt_node_t node_e_v = xbt_dynar_get_as(nodes, dst_net_elm->getId(), xbt_node_t);
 502     xbt_edge_t edge =
 503         xbt_graph_get_edge(p_routeGraph, node_e_v, node_s_v);
 504
 505     if (edge)
 506       THROWF(arg_error,0,"(AS)Route from '%s' to '%s' already exists",src,dst);
 507
 508     if (route->gw_dst && route->gw_src) {
 509       NetCard *gw_tmp;
 510       gw_tmp = route->gw_src;
 511       route->gw_src = route->gw_dst;
 512       route->gw_dst = gw_tmp;
 513     }
 514     sg_platf_route_cbarg_t link_route_back = newExtendedRoute(hierarchy_, route, 0);
 515     newRoute(dst_net_elm->getId(), src_net_elm->getId(), link_route_back);
 516   }
 517   xbt_dynar_free(&route->link_list);
 518 }
 519
 520 }
 521 }