csp 最优配餐

多起点

bfs时直接一开始将所有起点塞进去即可（起点到起点之间距离为0）

#include<bits/stdc++.h>
using namespace std;
#define maxn 1010
typedef long long ll;
struct node
{
    int x;
    int y;
    int dep;
};
int dx[4]={1,0,-1,0};
int dy[4]={0,1,0,-1};
int mp[maxn][maxn];
bool vis[maxn][maxn];
ll cost[maxn][maxn];
int n,m,k,d;
ll ans;
int cnt;

void bfs()
{
    queue<node> q;
    for(int i=1;i<=m;i++)
    {
        node a;
        int x,y;
        cin>>x>>y;
        a.x=x;
        a.y=y;
        a.dep=0;
        q.push(a);
        vis[x][y]=true;
    }
    for(int i=1;i<=k;i++)
    {
        int x,y,c;
        cin>>x>>y>>c;
        mp[x][y]=1;
        cost[x][y]+=c;
    }
    for(int i=1;i<=d;i++)
    {
        int x,y;
        cin>>x>>y;
        mp[x][y]=2;
    }
    node t;
    while(!q.empty())
    {
        if(cnt==k)
            return;
        t=q.front();
        q.pop();
        int sx=t.x;
        int sy=t.y;
        int d=t.dep;
        for(int i=0;i<4;i++)
        for(int j=0;j<4;j++)
        {
            if(cnt==k)
                return;
            int ex=sx+dx[i];
            int ey=sy+dy[i];
            if(!vis[ex][ey]&&ex>=1&&ex<=n&&ey>=1&&ey<=n&&mp[ex][ey]!=2)
            {
                vis[ex][ey]=true;
                node tmp;
                tmp.x=ex;
                tmp.y=ey;
                tmp.dep=d+1;
                q.push(tmp);
                if(mp[ex][ey]==1)
                {
                    ans+=tmp.dep*cost[ex][ey];
                    cnt++;
                }
            }
        }
    }
}

int main()
{
  cin>>n>>m>>k>>d;
  bfs();
  cout<<ans<<endl;
}