AcWing 1127. Sweet butter solution (shortest path SPFA)

AcWing 1127. Sweet butter
Or use it spfa Algorithm for the shortest path , The idea is to find each pasture as the central point to place sugar , Find all cows moving distance and the smallest pasture as a result , Minimum value of output moving sum

#include<bits/stdc++.h>

using namespace std;

const int N = 810, M = 4000, INF = 0x3f3f3f3f;

int h[N], e[M], ne[M], w[M], idx;
int d[N], q[N];
bool st[N];
int n, p, m;
int id[N];  // Record the number of each farm  

void add(int a, int b, int c){
    
	e[idx] = b;
	w[idx] = c;
	ne[idx] = h[a];
	h[a] = idx ++ ;
}

int spfa(int start){
    
	memset(d, 0x3f, sizeof d);
	d[start] = 0;
	
	int hh = 0, tt = 1;
	q[0] = start;
	st[start] = true;
	
	while(hh != tt){
    
		int t = q[hh ++ ];
		if(hh == N) hh = 0;
		st[t] = false;
		
		for(int i = h[t]; ~i; i = ne[i]){
    
			int j = e[i];
			if(d[j] > d[t] + w[i]){
    
				d[j] = d[t] + w[i];
				if(!st[j]){
    
					q[tt ++ ] = j;
					if(tt == N) tt = 0;
					st[j] = true;
				}
			}
		}
	}
	
	int res = 0;
	for(int i = 0; i < n; i ++ ){
    
		int j = id[i];
		if(d[j] == INF) return INF;
		res += d[j]; 
	}
	return res;
}

int main()
{
    
	cin>>n>>p>>m;
	for(int i = 0; i < n; i ++ ){
    
		cin>>id[i];
	}
	memset(h, -1, sizeof h);
	for(int i = 0; i < m; i ++ ){
    
		int a, b, c;
		cin>>a>>b>>c;
		add(a, b, c);
		add(b, a, c);
	}
	
	int minv = INF;
	for(int i = 1; i <= p; i ++ ){
    
		minv = min(minv, spfa(i));
	}
	cout<<minv<<endl;
	return 0;
}