这个题目真的很有意思啊
要求用最少的时间按从起点到终点
每走一步 车轮的颜色变一次 假设初始为0 一共五种颜色 最终的颜色必须要是0;
到达终点的朝向不要求
这个状态要四维的 x y d c
d表示朝向
c表示当前的颜色
那么更新的时候 要么朝着朝向d走一步
要么左转或右转
一共三种更新方法
用四维vis数组记录是否访问过
然后用优选队列 时间最少的先弹出
这样如果可以到达 那么最先弹出的是时间最少的。
#include<iostream>
#include<cstdio>
#include<cstring>
#include<queue>
using namespace std;
const int maxn=25;
bool map[maxn][maxn];
bool vis[maxn][maxn][4][5];
int sx,sy,ex,ey,n,m;
char str[maxn];
int dir[4][2]={-1,0,0,1,1,0,0,-1};
struct Node
{
int x,y,d,c,t;
bool operator < (const Node & n)const
{
return t>n.t;
}
};
int bfs()
{
priority_queue<Node> pq;
Node node,no;
node.x=sx;node.y=sy;
node.d=node.c=node.t=0;
pq.push(node);
vis[node.x][node.y][node.d][node.c]=1;
while(!pq.empty())
{
node=pq.top();
pq.pop();
if(node.x==ex && node.y==ey && node.c==0)
return node.t;
no.t=node.t+1;
//共有三种更新选择 第一种走一步
no.x=node.x+dir[node.d][0];
no.y=node.y+dir[node.d][1];
no.d=node.d;
no.c=(node.c+1)%5;
if(!vis[no.x][no.y][no.d][no.c] && no.x>=0 && no.x<n && no.y>=0 && no.y<m &&!map[no.x][no.y])
{
vis[no.x][no.y][no.d][no.c]=1;
pq.push(no);
}
//第二种左转 xyc不变 d变化
no.x=node.x;
no.y=node.y;
no.c=node.c;
if(node.d==0)
no.d=3;
else
no.d=node.d-1;
if(!vis[no.x][no.y][no.d][no.c])
{
vis[no.x][no.y][no.d][no.c]=1;
pq.push(no);
}
no.d=(node.d+1)%4;
if(!vis[no.x][no.y][no.d][no.c])
{
vis[no.x][no.y][no.d][no.c]=1;
pq.push(no);
}
}
return -1;
}
int main()
{
int i,j,ca=1;
char ch;
while(scanf("%d %d ",&n,&m),n+m)
{
for(i=0;i<n;++i)
{
scanf("%s",str);
for(j=0;j<m;++j)
{
if(str[j]=='#')
map[i][j]=1;
else
map[i][j]=0;
if(str[j]=='S')
{
sx=i;sy=j;
}
if(str[j]=='T')
{
ex=i;ey=j;
}
}
}
memset(vis,0,sizeof(vis));
int ans=bfs();
if(ca!=1)
printf("\n");
printf("Case #%d\n",ca++);
if(ans<0)
printf("destination not reachable\n");
else
printf("minimum time = %d sec\n",ans);
}
return 0;
}