题意:已知一张图,一个起点,求到某些已知点的最短路程。
思路:由于最多要求到4个点的距离,所以依次bfs求出起点到所求点的距离、所求点1到其他所求点的距离、所求点2到其他所求点距离,,,,,,然后全排列每一种情况,找出最小值。
#include<cstdio>
#include<cstring>
#include<queue>
#include<cstdlib>
#include<iostream>
#include<algorithm>
#define INF 1000000
using namespace std;
typedef struct point
{
int x,y;
} point;
point p[5];
int n,m,k,start,dis[5][102*100],vis[102*100],ok;
int use[5];
char g[103][103];
int v[102*100];
int move[4][2]= {{0,1},{0,-1},{-1,0},{1,0}};
bool check(int x,int y)
{
if(x>=0&&x<n&&y>=0&&y<m)
return true;
return false;
}
bool bfs(int cur,int f)
{
int num=0;
memset(v,0,sizeof(v));
queue<int>q;
q.push(cur);
dis[f][cur]=0;
while(!q.empty())
{
int u=q.front();
q.pop();
int x=u/m;
int y=u%m;
if(v[u]) continue;
v[u]=1;
for(int i=0; i<4; i++)
{
int dx=x+move[i][0];
int dy=y+move[i][1];
if(!v[dx*m+dy]&&g[dx][dy]=='.'&&check(dx,dy))
{
dis[f][dx*m+dy]=dis[f][u]+1;
q.push(dx*m+dy);
if(vis[dx*m+dy]==2) num++;
if(num==k&&f==0) return true;
if(num==k-1&&f) return true;
}
}
}
return false;
}
int main()
{
// freopen("in.txt","r",stdin);
while(scanf("%d%d",&n,&m)!=EOF&&(n+m))
{
memset(vis,0,sizeof(vis));
for(int i=0; i<n; i++)
{
getchar();
for(int j=0; j<m; j++)
{
scanf("%c",&g[i][j]);
if(g[i][j]=='@')
start=i*m+j;
}
}
scanf("%d",&k);
ok=1;
for(int i=1; i<=k; i++)
{
use[i-1]=i;
int a,b;
scanf("%d%d",&a,&b);
if(g[a-1][b-1]=='#')
ok=0;
p[i].x=a-1,p[i].y=b-1;
vis[(a-1)*m+b-1]=2;
}
if(!ok)
{
printf("-1\n");
continue;
}
for(int i=0; i<=k; i++)
{
for(int j=0; j<n*m; j++)
dis[i][j]=INF;
}
if(!bfs(start,0))
{
printf("-1\n");
continue;
}
for(int i=1; i<=k; i++)
bfs(p[i].x*m+p[i].y,i);
int maxx=INF,d=0;
do
{
for(int i=0; i<k; i++)
{
int v=use[0];
d=dis[0][p[v].x*m+p[v].y];
for(int i=1; i<k; i++)
{
v=use[i];
d+=dis[use[i-1]][p[v].x*m+p[v].y];
}
maxx=min(maxx,d);
}
}
while( next_permutation(use,use+k));
if(maxx<INF)
printf("%d\n",maxx);
else printf("-1\n");
}
return 0;
}