POJ 3259/USACO 2006 December Gold:Wormholes

#include<stdio.h>  
#include<math.h>  
#include<string.h>  
#include<stdlib.h>  
const int maxn=510,inf=1000000000;    
int e,to[maxn*12],ne[maxn*12],be[maxn],w[maxn*12];    
int d[maxn],p[maxn],ti[maxn],q[maxn*maxn];    
int m,n,wx,f,l,fl;    
void add(int x,int y,int z){  
    to[++e]=y;  
    ne[e]=be[x];  
    be[x]=e;  
    w[e]=z;  
}  
void aha(){  
    int i,j,k,x,y,z;  
    scanf("%d%d%d",&n,&m,&wx);  
    e=0;    
     for(i=1;i<=n;i++)be[i]=0;         
     for(i=1;i<=m;i++){    
         scanf("%d%d%d",&x,&y,&z);                      
         add(x,y,z);    
         add(y,x,z);    
     }  
   for(i=1;i<=wx;i++){    
         scanf("%d%d%d",&x,&y,&z);                      
         add(x,y,-z);    
     }        
     for(i=1;i<=n;i++){    
         d[i]=inf;    
         p[i]=0;    
         ti[i]=0;    
     }        
     f=0;l=1;    
     d[1]=0;q[1]=1;p[1]=1;ti[1]=1;    
     fl=0;         
}  
int main(){  
    int i,j,k,t;  
    scanf("%d",&t);    
    while(t--){                    
        aha();    
        while(f<l){    
            f++;    
            k=q[f];p[k]=0;                
            for(i=be[k]; i ; i=ne[i])    
                if(d[to[i]]>d[k]+w[i]){    
                    d[to[i]]=d[k]+w[i];    
                    if(!p[to[i]]){    
                        q[++l]=to[i];    
                        p[to[i]]=1;    
                        ti[to[i]]++;                            
                        if(ti[to[i]]>=n){    
                            fl=1;                                
                            break;                        
                        }                  
                    }                           
                }                
            if(fl)break;               
        }    
        if(fl)    
            printf("YES\n");    
        else    
            printf("NO\n");    
            
    }        
    return 0;  
}