1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104
| #include <iostream> #include <vector> #include <limits.h> #include <algorithm> using namespace std;
vector<vector<int>> adj = { {0,1,6,3,0}, {1,0,7,1,2}, {6,7,0,2,0}, {3,1,2,0,7}, {0,2,0,7,0} };
int dijkstra(vector<vector<int>> adj, int& start, int& end, vector<int>&path) { int n = adj.size(); if(start >= n || start < 0 || end >= n || end < 0) return -1; vector<int> dis(n, INT_MAX); vector<bool> visited(n, false); vector<int> pre(n, -1);
dis[start] = 0; pre[start] = start;
for(;;) { int mindis = INT_MAX; int minpos = -1;
for(int i = 0; i < n; ++i) { if(!visited[i] && dis[i] < mindis) { mindis = dis[i]; minpos = i; } } if(minpos == -1) break; visited[minpos] = true; if(visited[end]) { int tmp = end; path.push_back(end); while(pre[tmp] != start && pre[tmp] != -1) { path.push_back(pre[tmp]); tmp = pre[tmp]; } path.push_back(start); reverse(path.begin(), path.end()); break; } for(int j = 0; j < n; ++j) { if(!visited[j] && adj[minpos][j] > 0) { if(dis[j] > dis[minpos] + adj[minpos][j]) { dis[j] = dis[minpos] + adj[minpos][j]; pre[j] = minpos; } } } }
return dis[end]; }
void printpath(vector<int>&path) { for(int i = 0; i < path.size(); ++i) { if(i != path.size()-1) { cout << path[i]+1 <<"->"; } else { cout << path[i]+1; } } cout << endl; } int main() { int start, end; cin >> start >> end; vector<int> path; int mindis = dijkstra(adj, start, end, path); cout << mindis << endl; printpath(path); return 0; }
|