gb_dijk.w
上传用户:rrhhcc
上传日期:2015-12-11
资源大小:54129k
文件大小:16k
源码类别:

通讯编程

开发平台:

Visual C++

  1. % This file is part of the Stanford GraphBase (c) Stanford University 1993
  2. @i boilerplate.w %<< legal stuff: PLEASE READ IT BEFORE MAKING ANY CHANGES!
  3. @i gb_types.w
  4. deftitle{GB_,DIJK}
  5. prerequisite{GB_,GRAPH}
  6. @* Introduction. The GraphBase demonstration routine |dijkstra(uu,vv,gg,hh)|
  7. finds a shortest path from vertex~|uu| to vertex~|vv| in graph~|gg|, with the
  8. aid of an optional heuristic function~|hh|. This function implements a
  9. version of Dijkstra's algorithm, a general procedure for determining
  10. shortest paths in a directed graph that has nonnegative arc lengths
  11. [E.~W. Dijkstra, ``A note on two problems in connexion with graphs,''
  12. {sl Numerische Mathematik/ bf1} (1959), 269--271].
  13. @^Dijkstra, Edsger Wijbe@>
  14. If |hh| is null, the length of
  15. every arc in |gg| must be nonnegative. If |hh| is non-null, |hh| should be
  16. a function defined on the vertices of the graph such that the
  17. length |d| of an arc from |u| to~|v| always satisfies the condition
  18. $$ d ge |hh|(u)-|hh|(v),. $$
  19. In such a case, we can effectively replace each arc length |d| by
  20. |d-hh(u)+hh(v)|, obtaining a graph with nonnegative arc lengths.
  21. The shortest paths between vertices in this modified graph
  22. are the same as they were in the original graph.
  23. The basic idea of Dijkstra's algorithm is to explore the vertices of
  24. the graph in order of their distance from the starting vertex~|uu|,
  25. proceeding until |vv| is encountered. If the distances have been
  26. modified by a heuristic function |hh| such that |hh(u)| happens to equal
  27. the true distance from |u| to~|vv|, for all~|u|,
  28. then all of the modified distances on
  29. shortest paths to |vv| will be zero. This means that the algorithm
  30. will explore all of the most useful arcs first, without
  31. wandering off in unfruitful directions. In practice we usually
  32. don't know the exact distances to |vv| in advance, but we can often
  33. compute an approximate value |hh(u)| that will help focus the search.
  34. If the external variable |verbose| is nonzero, |dijkstra| will record
  35. its activities on the standard output file by printing the distances
  36. from |uu| to all vertices it visits.
  37. After |dijkstra| has found a shortest path, it returns the length of
  38. that path. If no path from |uu| to~|vv| exists (in particular, if
  39. |vv| is~|NULL|), it returns |-1|; in such a case, the shortest distances from
  40. |uu| to all vertices reachable from~|uu| will have been computed and
  41. stored in the graph.
  42. An auxiliary function, |print_dijkstra_result(vv)|, can be used
  43. to display the actual path found, if one exists.
  44. Examples of the use of |dijkstra| appear in the {sc LADDERS}
  45. demonstration module.
  46. @ This CEE/ module is meant to be loaded as part of another program.
  47. It has the following simple structure:
  48. @p
  49. #include "gb_graph.h" /* define the standard GraphBase data structures */
  50. @h@#
  51. @<Priority queue procedures@>@;
  52. @<Global declarations@>@;
  53. @<The |dijkstra| procedure@>@;
  54. @<The |print_dijkstra_result| procedure@>@;
  55. @ Users of {sc GB_,DIJK} should include the header file .{gb_dijk.h}:
  56. @(gb_dijk.h@>=
  57. extern long dijkstra(); /* procedure to calculate shortest paths */
  58. #define print_dijkstra_result p_dijkstra_result /* shorthand for linker */
  59. extern void print_dijkstra_result(); /* procedure to display the answer */
  60. @* The main algorithm.
  61. As Dijkstra's algorithm proceeds, it ``knows'' shortest paths from |uu|
  62. to more and more vertices; we will call these vertices ``known.''
  63. Initially only |uu| itself is known. The procedure terminates when |vv|
  64. becomes known, or when all vertices reachable from~|uu| are known.
  65. Dijkstra's algorithm looks at all vertices adjacent to known vertices.
  66. A vertex is said to have been ``seen'' if it is either known or
  67. adjacent to a vertex that's known.
  68. The algorithm proceeds by learning to know all vertices in a greater
  69. and greater radius from the starting point. Thus, if |v|~is a known
  70. vertex at distance~|d| from~|uu|, every vertex at distance less than~|d| from
  71. |uu| will also be known.  (Throughout this discussion the word
  72. ``distance'' actually means ``distance modified by the heuristic
  73. function''; we omit mentioning the heuristic because we can assume that
  74. the algorithm is operating on a graph with modified distances.)
  75. The algorithm maintains an auxiliary list of all vertices that have been
  76. seen but aren't yet known. For every such vertex~|v|, it remembers
  77. the shortest distance~|d| from |uu| to~|v| by a path that passes entirely
  78. through known vertices except for the very last arc.
  79. This auxiliary list is actually a priority queue, ordered by the |d| values.
  80. If |v|~is a vertex of the priority queue having the smallest |d|, we can
  81. remove |v| from the queue and consider it known, because there cannot be
  82. a path of length less than~|d| from |uu| to~|v|. (This is where the
  83. assumption of nonnegative arc length is crucial to the algorithm's validity.)
  84. @ To implement the ideas just sketched, we use several of the utility
  85. fields in vertex records. Each vertex~|v| has a |dist| field |v->dist|,
  86. which represents its true distance from |uu| if |v| is known; otherwise
  87. |v->dist| represents the shortest distance from |uu| discovered so far.
  88. Each vertex |v| also has a |backlink| field |v->backlink|, which is non-|NULL|
  89. if and only if |v| has been seen. In that case |v->backlink| is a vertex one
  90. step ``closer'' to |uu|, on a path from |uu| to |v| that achieves the
  91. current distance |v->dist|. (Exception:
  92. Vertex~|uu| has a backlink pointing to itself.) The backlink
  93. fields thereby allow us to construct shortest paths from |uu| to all the
  94. known vertices, if desired.
  95. @d dist z.I /* distance from |uu|, modified by |hh|,
  96.                  appears in vertex utility field |z| */
  97. @d backlink y.V /* pointer to previous vertex appears in utility field |y| */
  98. @(gb_dijk.h@>=
  99. #define dist @[z.I@]
  100. #define backlink @[y.V@]
  101. @ The priority queue is implemented by four procedures:
  102. begingroup
  103. def]#1 {smallskiphangindent2parindent hangafter1 indent #1 }
  104. ]|init_queue(d)| makes the queue empty and prepares for subsequent keys |>=d|.
  105. ]|enqueue(v,d)| puts vertex |v| in the queue and assigns it the key
  106. value |v->dist=d|.
  107. ]|requeue(v,d)| takes vertex |v| out of the queue and enters it again
  108. with the smaller key value |v->dist=d|.
  109. ]|del_min()| removes a vertex with minimum key from the queue and
  110. returns a pointer to that vertex. If the queue is empty, |NULL| is returned.
  111. endgroupsmallskipnoindent
  112. These procedures are accessed via external pointers, so that the user
  113. of {sc GB_,DIJK} can supply alternate queueing methods if desired.
  114. @(gb_dijk.h@>=
  115. extern void @[@] (*init_queue)();
  116.  /* create an empty priority queue for |dijkstra| */
  117. extern void @[@] (*enqueue)(); /* insert a new element in the priority queue */
  118. extern void @[@] (*requeue)(); /* decrease the key of an element in the queue */
  119. extern Vertex *(*del_min)(); /* remove an element with smallest key */
  120. @ The heuristic function might take a while to compute, so we avoid
  121. recomputation by storing |hh(v)| in another utility field |v->hh_val|
  122. once we've evaluated it. 
  123. @d hh_val x.I /* computed value of |hh(v)| */
  124. @(gb_dijk.h@>=
  125. #define hh_val @[x.I@]
  126. @ If no heuristic function is supplied by the user, we replace it by a
  127. dummy function that simply returns 0 in all cases.
  128. @<Global...@>=
  129. long dummy(v)
  130.   Vertex *v;
  131. {@+return 0;@+}
  132. @ Here now is |dijkstra|:
  133. @<The |dijkstra| procedure@>=
  134. long dijkstra(uu,vv,gg,hh)
  135.   Vertex *uu; /* the starting point */
  136.   Vertex *vv; /* the ending point */
  137.   Graph *gg; /* the graph they belong to */
  138.   long @[@] (*hh)(); /* heuristic function */
  139. {@+register Vertex *t; /* current vertex of interest */
  140.   if (!hh) hh=dummy; /* change to default heuristic */
  141.   @<Make |uu| the only vertex seen; also make it known@>;
  142.   t=uu;
  143.   if (verbose) @<Print initial message@>;
  144.   while (t!=vv) {
  145.     @<Put all unseen vertices adjacent to |t| into the queue,
  146.        and update the distances of other vertices adjacent to~|t|@>;
  147.     t=(*del_min)();
  148.     if (t==NULL)
  149.       return -1; /* if the queue becomes empty,
  150.                       there's no way to get to |vv| */
  151.     if (verbose) @<Print the distance to |t|@>;
  152.   }
  153.   return vv->dist-vv->hh_val+uu->hh_val; /* true distance from |uu| to |vv| */
  154. }
  155. @ As stated above, a vertex is considered seen only when its backlink
  156. isn't null, and known only when it is seen but not in the queue.
  157. @<Make |uu| the only...@>=
  158. for (t=gg->vertices+gg->n-1; t>=gg->vertices; t--) t->backlink=NULL;
  159. uu->backlink=uu;
  160. uu->dist=0;
  161. uu->hh_val=(*hh)(uu);
  162. (*init_queue)(0L); /* make the priority queue empty */
  163. @ Here we help the CEE/ compiler in case it hasn't got a great optimizer.
  164. @<Put all unseen vertices adjacent to |t| into the queue...@>=
  165. {@+register Arc *a; /* an arc leading from |t| */
  166.   register long d = t->dist - t->hh_val;
  167.   for (a=t->arcs; a; a=a->next) {
  168.     register Vertex *v = a->tip; /* a vertex adjacent to |t| */
  169.     if (v->backlink) { /* |v| has already been seen */
  170.       register long dd = d + a->len + v->hh_val;
  171.       if (dd< v->dist) {
  172.         v->backlink = t;
  173.         (*requeue)(v,dd); /* we found a better way to get there */
  174.       }
  175.     }@+else { /* |v| hasn't been seen before */
  176.       v->hh_val = (*hh)(v);
  177.       v->backlink = t;
  178.       (*enqueue)(v, d + a->len + v->hh_val);
  179.     }
  180.   }
  181. }
  182. @ The |dist| fields don't contain true distances in the graph; they
  183. represent distances modified by the heuristic function. The true distance
  184. from |uu| to vertex |v| is |v->dist - v->hh_val + uu->hh_val|.
  185. When printing the results, we show true distances. Also, if a nontrivial
  186. heuristic is being used, we give the |hh| value in brackets; the user can then
  187. observe that vertices are becoming known in order of true distance
  188. plus |hh| value.
  189. @<Print initial message@>=
  190. {@+printf("Distances from %s", uu->name);
  191.   if (hh!=dummy) printf(" [%ld]", uu->hh_val);
  192.   printf(":n");
  193. }
  194. @ @<Print the distance to |t|@>=
  195. {@+printf(" %ld to %s", t->dist - t->hh_val + uu->hh_val, t->name);
  196.   if (hh!=dummy) printf(" [%ld]", t->hh_val);
  197.   printf(" via %sn", t->backlink->name);
  198. }
  199. @ After |dijkstra| has found a shortest path, the backlinks from~|vv|
  200. specify the steps of that path. We want to print the path in the forward
  201. direction, so we reverse the links.
  202. We also unreverse them again, just in case the user didn't want the backlinks
  203. to be trashed. Indeed, this procedure can be used for any vertex |vv| whose
  204. backlink is non-null, not only the |vv| that was a parameter to |dijkstra|.
  205. List reversal is conveniently regarded as a process of popping off one stack
  206. and pushing onto another.
  207. @d print_dijkstra_result p_dijkstra_result /* shorthand for linker */
  208. @<The |print_dijkstra_result| procedure@>=
  209. void print_dijkstra_result(vv)
  210.   Vertex *vv; /* ending vertex */
  211. {@+register Vertex *t, *p, *q; /* registers for reversing links */
  212.   t=NULL, p=vv;
  213.   if (!p->backlink) {
  214.     printf("Sorry, %s is unreachable.n",p->name);
  215.     return;
  216.   }
  217.   do@+{ /* pop an item from |p| to |t| */
  218.     q=p->backlink;
  219.     p->backlink=t;
  220.     t=p;
  221.     p=q;
  222.   }@+while (t!=p); /* the loop stops with |t==p==uu| */
  223.   do@+{
  224.     printf("%10ld %sn", t->dist-t->hh_val+p->hh_val, t->name);
  225.     t=t->backlink;
  226.   }@+while (t);
  227.   t=p;
  228.   do@+{ /* pop an item from |t| to |p| */
  229.     q=t->backlink;
  230.     t->backlink=p;
  231.     p=t;
  232.     t=q;
  233.   }@+while (p!=vv);
  234. }
  235. @* Priority queues. Here we provide a simple doubly linked list
  236. for queueing; this is a convenient default, good enough for applications
  237. that aren't too large. (See {sc MILES_,SPAN} for implementations of
  238. other schemes that are more efficient when the queue gets large.)
  239. The two queue links occupy two of a vertex's remaining utility fields.
  240. @d llink v.V /* |llink| is stored in utility field |v| of a vertex */
  241. @d rlink w.V /* |rlink| is stored in utility field |w| of a vertex */
  242. @<Glob...@>=
  243. void @[@] (*init_queue)() = init_dlist; /* create an empty dlist */
  244. void @[@] (*enqueue)() = enlist; /* insert a new element in dlist */
  245. void @[@] (*requeue)() = reenlist ;
  246.   /* decrease the key of an element in dlist */
  247. Vertex *(*del_min)() = del_first; /* remove element with smallest key */
  248. @ There's a special list head, from which we get to everything else in the
  249. queue in decreasing order of keys by following |llink| fields.
  250. The following declaration actually provides for 128 list heads. Only the first
  251. of these is used here, but we'll find something to do with the
  252. other 127 later.
  253. @<Prior...@>=
  254. Vertex head[128]; /* list-head elements that are always present */
  255. @#
  256. void init_dlist(d)
  257.   long d;
  258. {
  259.   head->llink=head->rlink=head;
  260.   head->dist=d-1; /* a value guaranteed to be smaller than any actual key */
  261. }
  262. @ It seems reasonable to assume that an element entering the queue for the
  263. first time will tend to have a larger key than the other elements.
  264. Indeed, in the special case that all arcs in the graph have the same
  265. length, this strategy turns out to be quite fast. For in that case,
  266. every vertex is added to the end of the queue and deleted from the
  267. front, without any requeueing; the algorithm produces a strict
  268. first-in-first-out queueing discipline and performs a breadth-first search.
  269. @<Prior...@>=
  270. void enlist(v,d)
  271.   Vertex *v;
  272.   long d;
  273. {@+register Vertex *t=head->llink;
  274.   v->dist=d;
  275.   while (d<t->dist) t=t->llink;
  276.   v->llink=t;
  277.   (v->rlink=t->rlink)->llink=v;
  278.   t->rlink=v;
  279. }
  280. @ @<Prior...@>=
  281. void reenlist(v,d)
  282.   Vertex *v;
  283.   long d;
  284. {@+register Vertex *t=v->llink;
  285.   (t->rlink=v->rlink)->llink=v->llink; /* remove |v| */
  286.   v->dist=d; /* we assume that the new |dist| is smaller than it was before */
  287.   while (d<t->dist) t=t->llink;
  288.   v->llink=t;
  289.   (v->rlink=t->rlink)->llink=v;
  290.   t->rlink=v;
  291. }
  292. @ @<Prior...@>=
  293. Vertex *del_first()
  294. {@+Vertex *t;
  295.   t=head->rlink;
  296.   if (t==head) return NULL;
  297.   (head->rlink=t->rlink)->llink=head;
  298.   return t;
  299. }
  300. @* A special case. When the arc lengths in the graph are all fairly small,
  301. we can substitute another queueing discipline that does each operation
  302. quickly. Suppose the only lengths are 0, 1, dots,~|k-1|; then we can
  303. prove easily that the priority queue will never contain more than |k|
  304. different values at once. Moreover, we can implement it by maintaining
  305. |k| doubly linked lists, one for each key value mod~|k|.
  306. For example, let |k=128|.  Here is an alternate set of queue commands,
  307. to be used when the arc lengths are known to be less than~128.
  308. @ @<Prior...@>=
  309. long master_key; /* smallest key that may be present in the priority queue */
  310. @#
  311. void init_128(d)
  312.   long d;
  313. {@+register Vertex *u;
  314.   master_key=d;
  315.   for (u=head; u<head+128; u++)
  316.     u->llink=u->rlink=u;
  317. }
  318. @ If the number of lists were not a power of 2, we would calculate a remainder
  319. by division instead of by logical-anding.
  320. @<Prior...@>=
  321. Vertex *del_128()
  322. {@+long d;
  323.   register Vertex *u, *t;
  324.   for (d=master_key; d<master_key+128; d++) {
  325.     u=head+(d&0x7f); /* that's |d%128| */
  326.     t=u->rlink;
  327.     if (t!=u) { /* we found a nonempty list with minimum key */
  328.       master_key=d;
  329.       (u->rlink = t->rlink)->llink = u;
  330.       return t; /* incidentally, |t->dist = d| */
  331.     }
  332.   }
  333.   return NULL; /* all 128 lists are empty */
  334. }
  335. @ @<Prior...@>=
  336. void enq_128(v,d)
  337.   Vertex *v; /* new vertex for the queue */
  338.   long d; /* its |dist| */
  339. {@+register Vertex *u=head+(d&0x7f);
  340.   v->dist = d;
  341.   (v->llink = u->llink)->rlink = v;
  342.   v->rlink = u;
  343.   u->llink = v;
  344. }
  345. @ All of these operations have been so simple, one wonders why the lists
  346. should be doubly linked. Single linking would indeed be plenty---if we
  347. didn't have to support the |requeue| operation.
  348. But requeueing involves deleting an arbitrary element from the middle of
  349. its list. And we do seem to need two links for that.
  350. In the application to Dijkstra's algorithm, the new |d| will always
  351. be |master_key| or more. But we want to implement requeueing in general,
  352. so that this procedure can be used also for other algorithms
  353. such as the calculation of minimum spanning trees (see {sc MILES_,SPAN}).
  354. @<Prior...@>=
  355. void req_128(v,d)
  356.   Vertex *v; /* vertex to be moved to another list */
  357.   long d; /* its new |dist| */
  358. {@+register Vertex *u=head+(d&0x7f);
  359.   (v->llink->rlink=v->rlink)->llink=v->llink; /* remove |v| */  
  360.   v->dist=d; /* the new |dist| is smaller than it was before */
  361.   (v->llink=u->llink)->rlink = v;
  362.   v->rlink = u;
  363.   u->llink = v;
  364.   if (d<master_key) master_key=d; /* not needed for Dijkstra's algorithm */
  365. }
  366. @ The user of {sc GB_,DIJK} needs to know the names of these
  367. queueing procedures if changes to the defaults are made, so we'd
  368. better put the necessary info into the header file.
  369. @(gb_dijk.h@>=
  370. extern void init_dlist();
  371. extern void enlist();
  372. extern void reenlist();
  373. extern Vertex *del_first();
  374. extern void init_128();
  375. extern Vertex *del_128();
  376. extern void enq_128();
  377. extern void req_128();
  378. @* Index. Here is a list that shows where the identifiers of this program are
  379. defined and used.