最短路径·三：SPFA算法 HihoCoder - 1093 (spfa无向图）

描述
万圣节的晚上，小Hi和小Ho在吃过晚饭之后，来到了一个巨大的鬼屋！
鬼屋中一共有N个地点，分别编号为1..N，这N个地点之间互相有一些道路连通，两个地点之间可能有多条道路连通，但是并不存在一条两端都是同一个地点的道路。
不过这个鬼屋虽然很大，但是其中的道路并不算多，所以小Hi还是希望能够知道从入口到出口的最短距离是多少？
输入
每个测试点（输入文件）有且仅有一组测试数据。
在一组测试数据中：
第1行为4个整数N、M、S、T，分别表示鬼屋中地点的个数和道路的条数，入口（也是一个地点）的编号，出口（同样也是一个地点）的编号。
接下来的M行，每行描述一条道路：其中的第i行为三个整数u_i, v_i, length_i，表明在编号为u_i的地点和编号为v_i的地点之间有一条长度为length_i的道路。
对于100%的数据，满足N<=10^5，M<=10^6, 1 <= length_i <= 10^3, 1 <= S, T <= N, 且S不等于T。
对于100%的数据，满足小Hi和小Ho总是有办法从入口通过地图上标注出来的道路到达出口。
输出
对于每组测试数据，输出一个整数Ans，表示那么小Hi和小Ho为了走出鬼屋至少要走的路程。
Sample Input
5 10 3 5
1 2 997
2 3 505
3 4 118
4 5 54
3 5 480
3 4 796
5 2 794
2 5 146
5 4 604
2 5 63
output

172

#include <cstring>
#include <cstdio>
#define maxn  1000010
#define INF 0x7fffffff
using namespace std;
struct node
{
    int to,next,weight;

}edge1[maxn];
int n,m;
int idx1;
int first1[maxn];
long long sum;
int dist[maxn],vis[maxn],q[maxn*2];
void add(int u,int v,int w)
{
    edge1[idx1].to=v;
    edge1[idx1].weight=w;
    edge1[idx1].next=first1[u];
    first1[u]=idx1;
    idx1++;
}

void spfa(int start,node *Edge,int *first)
{
    int head=0,tail=1;
    memset(q,0,sizeof(q));
    for(int i=0;i<=n;++i)
    {
        dist[i]=INF;
        vis[i]=0;
    }
    dist[start]=0;
    vis[start]=1;
    q[1]=start;
    while(head<tail)
    {
        head++;
        int x=q[head];
                vis[x]=0;
        for(int i=first[x];i!=0;i=Edge[i].next)
        {
            int y=Edge[i].to;
            if(dist[y]>dist[x]+Edge[i].weight)
            {
                dist[y]=dist[x]+Edge[i].weight;
                if(!vis[y])
                {
                    q[++tail]=y;
                    vis[y]=1;
                }
            }
        }
    }

}
int main()
{
    int c,u,v,w,start,end;
        while(cin>>n>>m>>start>>end)
        {
            memset(first1,0,sizeof(first1));
            idx1=1;
        for(int i=0;i<m;++i)
        {
            scanf("%d%d%d",&u,&v,&w);//cin>>u>>v>>w;
            add(u,v,w);
            add(v,u,w);//无向图要搞两次
        }
        sum=0;
      //  int start,end;
       // cin>>start>>end;
        spfa(start,edge1,first1);//spfa(start,edge1,first1);
        cout<<dist[end]<<endl;
        }
    return 0;
}