| 1 | /* $Id$ $Revision$ */ |
| 2 | /* vim:set shiftwidth=4 ts=8: */ |
| 3 | |
| 4 | /************************************************************************* |
| 5 | * Copyright (c) 2011 AT&T Intellectual Property |
| 6 | * All rights reserved. This program and the accompanying materials |
| 7 | * are made available under the terms of the Eclipse Public License v1.0 |
| 8 | * which accompanies this distribution, and is available at |
| 9 | * http://www.eclipse.org/legal/epl-v10.html |
| 10 | * |
| 11 | * Contributors: See CVS logs. Details at http://www.graphviz.org/ |
| 12 | *************************************************************************/ |
| 13 | |
| 14 | #include "config.h" |
| 15 | |
| 16 | #include <stdio.h> |
| 17 | #include <stdlib.h> |
| 18 | #include <math.h> |
| 19 | #include "cgraph.h" |
| 20 | #include "ingraphs.h" |
| 21 | #include <getopt.h> |
| 22 | |
| 23 | #ifndef HUGE |
| 24 | /* HUGE is not defined on 64bit HP-UX */ |
| 25 | #define HUGE HUGE_VAL |
| 26 | #endif |
| 27 | |
| 28 | static char *CmdName; |
| 29 | static char **Files; |
| 30 | static char **Nodes; |
| 31 | static int setall = 0; /* if false, don't set dist attribute for |
| 32 | * nodes in different components. |
| 33 | */ |
| 34 | static int doPath = 0; /* if 1, record shortest paths */ |
| 35 | static int doDirected; /* if 1, use directed paths */ |
| 36 | static Agsym_t *len_sym; |
| 37 | |
| 38 | typedef struct nodedata_s { |
| 39 | Agrec_t hdr; |
| 40 | double dist; /* always positive for scanned nodes */ |
| 41 | Agnode_t* prev; |
| 42 | int done; /* > 0 if finished */ |
| 43 | } nodedata_t; |
| 44 | |
| 45 | #if 0 |
| 46 | typedef struct edgedata_s { |
| 47 | Agrec_t hdr; |
| 48 | double length; /* non-negative */ |
| 49 | int init; /* non-zero if length is set */ |
| 50 | } edgedata_t; |
| 51 | #endif |
| 52 | |
| 53 | static double getlength(Agedge_t * e) |
| 54 | { |
| 55 | double len; |
| 56 | char* lens; |
| 57 | char* p; |
| 58 | |
| 59 | if (len_sym && (*(lens = agxget(e, len_sym)))) { |
| 60 | len = strtod (lens, &p); |
| 61 | if ((len < 0) || (p == lens)) |
| 62 | len = 1; |
| 63 | } |
| 64 | else |
| 65 | len = 1; |
| 66 | return len; |
| 67 | } |
| 68 | |
| 69 | #ifdef USE_FNS |
| 70 | static double getdist(Agnode_t * n) |
| 71 | { |
| 72 | nodedata_t *data; |
| 73 | data = (nodedata_t *) (n->base.data); |
| 74 | return data->dist; |
| 75 | } |
| 76 | |
| 77 | static void setdist(Agnode_t * n, double dist) |
| 78 | { |
| 79 | nodedata_t *data; |
| 80 | data = (nodedata_t *) (n->base.data); |
| 81 | data->dist = dist; |
| 82 | } |
| 83 | #else |
| 84 | #define getdist(n) (((nodedata_t*)((n)->base.data))->dist) |
| 85 | #define setdist(n,d) (((nodedata_t*)((n)->base.data))->dist = (d)) |
| 86 | #define getprev(n) (((nodedata_t*)((n)->base.data))->prev) |
| 87 | #define setprev(n,p) (((nodedata_t*)((n)->base.data))->prev = (p)) |
| 88 | #define isDone(n) (((nodedata_t*)((n)->base.data))->done) |
| 89 | #define setDone(n) (((nodedata_t*)((n)->base.data))->done = 1) |
| 90 | #endif |
| 91 | |
| 92 | static int cmpf(Dt_t * d, void *key1, void *key2, Dtdisc_t * disc) |
| 93 | { |
| 94 | double t; |
| 95 | t = getdist((Agnode_t *) key1) - getdist((Agnode_t *) key2); |
| 96 | if (t < 0) |
| 97 | return -1; |
| 98 | if (t > 0) |
| 99 | return 1; |
| 100 | if (key1 < key2) |
| 101 | return -1; |
| 102 | if (key1 > key2) |
| 103 | return 1; |
| 104 | return 0; |
| 105 | } |
| 106 | |
| 107 | static Dtdisc_t MyDisc = { |
| 108 | 0, /* int key */ |
| 109 | 0, /* int size */ |
| 110 | -1, /* int link */ |
| 111 | 0, /* Dtmake_f makef */ |
| 112 | 0, /* Dtfree_f freef */ |
| 113 | cmpf, /* Dtcompar_f comparf */ |
| 114 | 0, /* Dthash_f hashf */ |
| 115 | 0, /* Dtmemory_f memoryf */ |
| 116 | 0 /* Dtevent_f eventf */ |
| 117 | }; |
| 118 | |
| 119 | static Agnode_t *(Dict_t * Q) |
| 120 | { |
| 121 | Agnode_t *rv; |
| 122 | rv = dtfirst(Q); |
| 123 | dtdelete(Q, rv); |
| 124 | return rv; |
| 125 | } |
| 126 | |
| 127 | static void update(Dict_t * Q, Agnode_t * dest, Agnode_t * src, double len) |
| 128 | { |
| 129 | double newlen = getdist(src) + len; |
| 130 | double oldlen = getdist(dest); |
| 131 | |
| 132 | if (oldlen == 0) { /* first time to see dest */ |
| 133 | setdist(dest, newlen); |
| 134 | if (doPath) setprev(dest, src); |
| 135 | dtinsert(Q, dest); |
| 136 | } else if (newlen < oldlen) { |
| 137 | dtdelete(Q, dest); |
| 138 | setdist(dest, newlen); |
| 139 | if (doPath) setprev(dest, src); |
| 140 | dtinsert(Q, dest); |
| 141 | } |
| 142 | } |
| 143 | |
| 144 | static void pre(Agraph_t * g) |
| 145 | { |
| 146 | len_sym = agattr(g, AGEDGE, "len" , NULL); |
| 147 | aginit(g, AGNODE, "dijkstra" , sizeof(nodedata_t), 1); |
| 148 | #if 0 |
| 149 | aginit(g, AGEDGE, "dijkstra" , sizeof(edgedata_t), 1); |
| 150 | #endif |
| 151 | } |
| 152 | |
| 153 | static void post(Agraph_t * g) |
| 154 | { |
| 155 | Agnode_t *v; |
| 156 | Agnode_t *prev; |
| 157 | char buf[256]; |
| 158 | char dflt[256]; |
| 159 | Agsym_t *sym; |
| 160 | Agsym_t *psym = NULL; |
| 161 | double dist, oldmax; |
| 162 | double maxdist = 0.0; /* maximum "finite" distance */ |
| 163 | |
| 164 | sym = agattr(g, AGNODE, "dist" , "" ); |
| 165 | if (doPath) |
| 166 | psym = agattr(g, AGNODE, "prev" , "" ); |
| 167 | |
| 168 | if (setall) |
| 169 | sprintf(dflt, "%.3lf" , HUGE); |
| 170 | |
| 171 | for (v = agfstnode(g); v; v = agnxtnode(g, v)) { |
| 172 | dist = getdist(v); |
| 173 | if (dist) { |
| 174 | dist--; |
| 175 | sprintf(buf, "%.3lf" , dist); |
| 176 | agxset(v, sym, buf); |
| 177 | if (doPath && (prev = getprev(v))) |
| 178 | agxset(v, psym, agnameof(prev)); |
| 179 | if (maxdist < dist) |
| 180 | maxdist = dist; |
| 181 | } else if (setall) |
| 182 | agxset(v, sym, dflt); |
| 183 | } |
| 184 | |
| 185 | sym = agattrsym(g, "maxdist" ); |
| 186 | if (sym) { |
| 187 | if (!setall) { |
| 188 | /* if we are preserving distances in other components, |
| 189 | * check previous value of maxdist. |
| 190 | */ |
| 191 | oldmax = atof(agxget(g, sym)); |
| 192 | if (oldmax > maxdist) |
| 193 | maxdist = oldmax; |
| 194 | } |
| 195 | sprintf(buf, "%.3lf" , maxdist); |
| 196 | agxset(g, sym, buf); |
| 197 | } else { |
| 198 | sprintf(buf, "%.3lf" , maxdist); |
| 199 | agattr(g, AGRAPH, "maxdist" , buf); |
| 200 | } |
| 201 | |
| 202 | agclean(g, AGNODE, "dijkstra" ); |
| 203 | agclean(g, AGEDGE, "dijkstra" ); |
| 204 | } |
| 205 | |
| 206 | void dijkstra(Dict_t * Q, Agraph_t * G, Agnode_t * n) |
| 207 | { |
| 208 | Agnode_t *u; |
| 209 | Agedge_t *e; |
| 210 | |
| 211 | pre(G); |
| 212 | setdist(n, 1); |
| 213 | dtinsert(Q, n); |
| 214 | if (doDirected) { |
| 215 | while ((u = extract_min(Q))) { |
| 216 | setDone (u); |
| 217 | for (e = agfstout(G, u); e; e = agnxtout(G, e)) { |
| 218 | if (!isDone(e->node)) update(Q, e->node, u, getlength(e)); |
| 219 | } |
| 220 | } |
| 221 | } else { |
| 222 | while ((u = extract_min(Q))) { |
| 223 | setDone (u); |
| 224 | for (e = agfstedge(G, u); e; e = agnxtedge(G, e, u)) { |
| 225 | if (!isDone(e->node)) update(Q, e->node, u, getlength(e)); |
| 226 | } |
| 227 | } |
| 228 | } |
| 229 | post(G); |
| 230 | } |
| 231 | |
| 232 | static char *useString = |
| 233 | "Usage: dijkstra [-ap?] <node> [<file> <node> <file>]\n\ |
| 234 | -a - for nodes in a different component, set dist very large\n\ |
| 235 | -d - use forward directed edges\n\ |
| 236 | -p - attach shortest path info\n\ |
| 237 | -? - print usage\n\ |
| 238 | If no files are specified, stdin is used\n" ; |
| 239 | |
| 240 | static void usage(int v) |
| 241 | { |
| 242 | printf("%s" ,useString); |
| 243 | exit(v); |
| 244 | } |
| 245 | |
| 246 | static void init(int argc, char *argv[]) |
| 247 | { |
| 248 | int i, j, c; |
| 249 | |
| 250 | CmdName = argv[0]; |
| 251 | opterr = 0; |
| 252 | while ((c = getopt(argc, argv, "adp" )) != -1) { |
| 253 | switch (c) { |
| 254 | case 'a': |
| 255 | setall = 1; |
| 256 | break; |
| 257 | case 'd': |
| 258 | doDirected = 1; |
| 259 | break; |
| 260 | case 'p': |
| 261 | doPath = 1; |
| 262 | break; |
| 263 | case '?': |
| 264 | if (optopt == '?') |
| 265 | usage(0); |
| 266 | else |
| 267 | fprintf(stderr, "%s: option -%c unrecognized - ignored\n" , |
| 268 | CmdName, optopt); |
| 269 | break; |
| 270 | } |
| 271 | } |
| 272 | argv += optind; |
| 273 | argc -= optind; |
| 274 | |
| 275 | if (argc == 0) { |
| 276 | fprintf(stderr, "%s: no node specified\n" , CmdName); |
| 277 | usage(1); |
| 278 | } |
| 279 | Files = malloc(sizeof(char *) * (argc / 2 + 2)); |
| 280 | Nodes = malloc(sizeof(char *) * (argc / 2 + 2)); |
| 281 | for (j = i = 0; i < argc; i++) { |
| 282 | Nodes[j] = argv[i++]; |
| 283 | Files[j] = (argv[i] ? argv[i] : "-" ); |
| 284 | j++; |
| 285 | } |
| 286 | Nodes[j] = Files[j] = 0; |
| 287 | } |
| 288 | |
| 289 | static Agraph_t *gread(FILE * fp) |
| 290 | { |
| 291 | return agread(fp, (Agdisc_t *) 0); |
| 292 | } |
| 293 | |
| 294 | int main(int argc, char **argv) |
| 295 | { |
| 296 | Agraph_t *g; |
| 297 | Agnode_t *n; |
| 298 | ingraph_state ig; |
| 299 | int i = 0; |
| 300 | int code = 0; |
| 301 | Dict_t *Q; |
| 302 | |
| 303 | init(argc, argv); |
| 304 | newIngraph(&ig, Files, gread); |
| 305 | |
| 306 | Q = dtopen(&MyDisc, Dtoset); |
| 307 | while ((g = nextGraph(&ig)) != 0) { |
| 308 | dtclear(Q); |
| 309 | if ((n = agnode(g, Nodes[i], 0))) |
| 310 | dijkstra(Q, g, n); |
| 311 | else { |
| 312 | fprintf(stderr, "%s: no node %s in graph %s in %s\n" , |
| 313 | CmdName, Nodes[i], agnameof(g), fileName(&ig)); |
| 314 | code = 1; |
| 315 | } |
| 316 | agwrite(g, stdout); |
| 317 | fflush(stdout); |
| 318 | agclose(g); |
| 319 | i++; |
| 320 | } |
| 321 | exit(code); |
| 322 | } |
| 323 | |