我不知道我是不是对了，没数据真是忧伤，我是传统的A*+SPFA算法，
原题是求次短路，我借此学了一下这种神奇的东西。
1 #include <iostream> 2 #include <fstream> 3 #include <cstdlib> 4 #include <cstring> 5 /* run this program using the console pauser or add your own getch, system("pause") or input loop */ 6 using namespace std; 7 ifstream fin("secondpath.in"); 8 ofstream fout("secondpath.out"); 9 10 int places=0,rodes=0; 11 int qi=0,zhong=0; 12 int head[1005],cnt=0; 13 struct id{ 14 int nxt; 15 int to; 16 int quan; 17 }; 18 id lian[200005]; 19 int dui[1003],jv[1003]; 20 int jv2[1003]; 21 bool used[1003]; 22 int you_dui[200005][2],gs_cnt=0; 23 //int zhan[200003]; 24 25 26 void add(int co,int dao,int bian); 27 void spfa( ); 28 void a_xin( ); 29 int na(int sze); 30 void fang(int sze,int zhi); 31 32 33 void add(int co,int dao,int bian){ 34 lian[++cnt].nxt=head[co]; 35 lian[cnt].to=dao; 36 lian[cnt].quan=bian; 37 head[co]=cnt; 38 return; 39 } 40 41 42 void spfa( ){ 43 memset(jv,127/2,sizeof(jv)); 44 int tou=0,wei=1; 45 dui[1]=zhong;jv[zhong]=0; 46 used[zhong]=1; 47 while(tou!=wei){ 48 tou++;if(tou>1001)tou=1; 49 int cong=dui[tou]; 50 for(int x=head[cong];x!=-1;x=lian[x].nxt){ 51 int dao=lian[x].to; 52 if(jv[dao]>jv[cong]+lian[x].quan){ 53 jv[dao]=jv[cong]+lian[x].quan; 54 if(used[dao]==0){ 55 wei++;if(wei>1001)wei=1; 56 dui[wei]=dao;used[dao]=1; 57 } 58 } 59 } 60 used[cong]=0; 61 } 62 return; 63 } 64 65 66 void a_xin( ){ 67 memset(you_dui,127/2,sizeof(you_dui)); 68 memset(jv2,127/2,sizeof(jv2)); 69 jv2[qi]=0;you_dui[1][0]=0; 70 you_dui[1][1]=qi;gs_cnt=1; 71 int pd=0,shang=-1; 72 while(pd<2&&gs_cnt!=0){ 73 int sze=you_dui[1][1]; 74 int jvli=na(1); 75 //for(int x=1;x<=gs_cnt;x++)cout<<you_dui[x][0]<<" "; 76 // cout<<endl; 77 // system ("pause"); 78 if(sze==zhong&&shang!=jvli){pd++;shang=jvli;continue;} 79 for(int hao=head[sze];hao!=-1;hao=lian[hao].nxt){ 80 int dao=lian[hao].to; 81 if(jv2[sze]+lian[hao].quan!=jv2[dao])fang(dao,jv2[sze]+lian[hao].quan+jv[dao]); 82 if(jv2[sze]+lian[hao].quan<jv2[dao]){jv2[dao]=jv2[sze]+lian[hao].quan;} 83 } 84 // for(int x=1;x<=gs_cnt;x++)cout<<you_dui[x][0]<<" "; 85 // cout<<endl; 86 // system ("pause"); 87 } 88 if(pd<2){cout<<"-1";fout<<"-1";return;} 89 cout<<shang;fout<<shang; 90 return; 91 } 92 93 94 int na(int sze){ 95 int a=you_dui[sze][1]; 96 you_dui[sze][1]=you_dui[gs_cnt][1]; 97 you_dui[gs_cnt][1]=a; 98 a=you_dui[sze][0];you_dui[sze][0]=you_dui[gs_cnt][0]; 99 you_dui[gs_cnt][0]=a;gs_cnt--; 100 int now=1,zi=0; 101 while(now*2<=gs_cnt){ 102 zi=now*2; 103 if(now*2<gs_cnt&&you_dui[zi+1][0]<you_dui[zi][0])zi++; 104 if(you_dui[zi][0]>you_dui[now][0])return a; 105 int b=you_dui[zi][0];you_dui[zi][0]=you_dui[now][0]; 106 you_dui[now][0]=b;b=you_dui[zi][1]; 107 you_dui[zi][1]=you_dui[now][1];you_dui[now][1]=b; 108 now=zi; 109 } 110 return a; 111 } 112 113 114 void fang(int sze,int zhi){ 115 you_dui[++gs_cnt][1]=sze; 116 you_dui[gs_cnt][0]=zhi; 117 int now=gs_cnt,fu=0; 118 while(now/2>0){ 119 fu=now/2; 120 if(you_dui[fu][0]<you_dui[now][0])return; 121 int a=you_dui[now][0];you_dui[now][0]=you_dui[fu][0]; 122 you_dui[fu][0]=a;a=you_dui[now][1];you_dui[now][1]=you_dui[fu][1]; 123 you_dui[fu][1]=a;now=fu; 124 } 125 return; 126 } 127 128 129 int main(int argc, char** argv) { 130 fin>>places>>rodes; 131 memset(head,-1,sizeof(head)); 132 for(int x=1;x<=rodes;x++){ 133 int a,b,c; 134 fin>>a>>b>>c; 135 add(a,b,c); 136 add(b,a,c); 137 } 138 fin>>qi>>zhong; 139 spfa( ); 140 a_xin( ); 141 142 return 0; 143 }