最短路径Dijkstra c实现

Code:

1. int Pnum;   
2. int P[MAX_PC] = {0};   
3. int S[MAX_PC];   
4. float D[MAX_PC];   
5.   
6. void ShortPath(float C[][MAX_PC], int v)   
7. {   
8.     int i;   
9.     int j;   
10.     int k;   
11.     int v1;   
12.     int pre;   
13.     int min;   
14.     v1 = v -1;   
15.   
16.     // initialize distance value   
17.     for (i=0; i<Pnum; i++)   
18.     {   
19.         D[i] = C[v1][i];   
20.         if (i != v-1)   
21.         P[i] = v;   
22.     }   
23.   
24.     // the red set is null   
25.     for (i=0; i<Pnum; i++)   
26.         S[i] = 0;   
27.     S[v1] = 1;   
28.     D[v1] = 0;   
29.     // extend the red set   
30.     for (i=0; i<Pnum - 1; i++)   
31.     {   
32.         min = 1000000;   
33.         // add the shortest distance of node to the red set   
34.         for (j=0; j<Pnum; j++)   
35.         {   
36.            
37.                 
38.             if ( (!S[j]) && (D[j] <min) )   
39.             {   
40.                 min = D[j];   
41.                 k = j;   
42.             }   
43.   
44.             //printf("k")   
45.         }   
46.         // add "k+1" to the red set    
47.         S[k] = 1;   
48.            
49.         for (j=0; j<Pnum; j++)   
50.         {   
51.             // Blue distance adjustment   
52.             if ( (!S[j]) && ( D[j] > D[k] + C[k][j] ) )   
53.             {   
54.                 D[j] = D[k] + C[k][j];   
55.                 P[j] = k + 1;   
56.             }   
57.         }   
58.     }   
59.   
60.     for (i=0; i<Pnum; i++)   
61.     {   
62.         printf("%f/n%d", D[i], i+1);   
63.         pre = P[i];   
64.         while (pre != 0)   
65.         {   
66.             printf("<--%d", pre);   
67.             pre = P[pre-1];   
68.         }   
69.         printf("/n");   
70.     }   
71.   
72. }