杭电1874最短路径问题

#include<stdio.h>
#include<string.h>
int arc[200][200];
int cost[200];
int INF=100000;
int n,s,t;
void spfa()
{
int x,i;
int q[200];
int visited[200];
int front=0;
int rear=0;
memset(q,0,sizeof(q));//模拟队列 
memset(visited,0,sizeof(visited));//开始所有的点都没有访问 
cost[s]=0;//开始点权值为0 
q[++rear]=s;//入队 
visited[s]=1;//开始点访问 
while(front!=rear)
{//
  front=(front+1)%(n+1);//出队 
  x=q[front];
  visited[x]=0;//
  for(i=0;i<n;i++)
    if(cost[x]+arc[x][i]<cost[i])//更新最短路 
{
cost[i]=arc[x][i]+cost[x];//
if(!visited[i])
{
rear=(rear+1)%(n+1);
q[rear]=i;
visited[i]=1;
}
} 
}
}
int main()
{
int m;
while(scanf("%d%d",&n,&m)!=EOF)
{
int i,j,k,d;
for(i=0;i<n;i++)
for(j=0;j<n;j++)
 arc[i][j]=INF;
for(k=0;k<m;k++)
{
scanf("%d%d%d",&i,&j,&d);
if(arc[i][j]>d)
  arc[i][j]=arc[j][i]=d;
}
scanf("%d%d",&s,&t);
for(i=0;i<n;i++)
cost[i]=INF;
spfa();
if(cost[t]<INF)
  printf("%d\n",cost[t]);
else
  printf("-1\n");
}
return 0;
}