变量实在弄的太乱了!!!
用vis记录状态,坐标,颜色,方向。
然后就是研究一下方向,直接bfs过去。(UVA的格式错误提示WA,操蛋)
#include<stdio.h>
#include<queue>
#include<string.h>
using namespace std;
char g[30][30];
int vis[30][30][6][6];
int n,m;
int sx,sy,ex,ey;
struct node{
int x,y,dir,se,step;
friend bool operator<(node a,node b){
return a.step>b.step;
}
};
//0 1 2 3 北 南 西 东
int dx[4]={-1,1,0,0};
int dy[4]={0,0,-1,1};
void bfs()
{
priority_queue<node> q;
while(!q.empty()) q.pop();
node t;
t.x=sx,t.y=sy,t.step=0,t.se=0,t.dir=0;
q.push(t);
vis[sx][sy][0][0]=1;//x y dir se
bool flag=false;
while(!q.empty()){
node u=q.top();
q.pop();
if(u.x==ex&&u.y==ey&&u.se==0){
printf("minimum time = %d sec\n",u.step);
flag=true;
break;
}
node v=u;
for(int i=0;i<4;i++){
if(u.dir==i)//同向
{
v.x=u.x+dx[i];
v.y=u.y+dy[i];
v.dir=u.dir;
v.se=(u.se+1)%5;
v.step=u.step+1;
if(g[v.x][v.y]!='#'&&v.x>=0&&v.x<n&&v.y>=0&&v.y<m)
if(!vis[v.x][v.y][v.dir][v.se]){
vis[v.x][v.y][v.dir][v.se]=1;
q.push(v);
}
}
else{//不同向
if(u.dir==0&&i==1) v.step=u.step+2;
else if(u.dir==1&&i==0) v.step=u.step+2;
else if(u.dir==2&&i==3) v.step=u.step+2;
else if(u.dir==3&&i==2) v.step=u.step+2;
else v.step=u.step+1;
v.dir=i;
v.x=u.x;
v.y=u.y;
v.se=u.se;
if(!vis[v.x][v.y][v.dir][v.se]){
vis[v.x][v.y][v.dir][v.se]=1;
q.push(v);
}
}
}
}
if(!flag) printf("destination not reachable\n");
}
int main()
{
int cas=1,ca=0;
while(scanf("%d%d",&n,&m)&&n&&m){
for(int i=0;i<n;i++)
scanf("%s",g[i]);
memset(vis,0,sizeof vis);
for(int i=0;i<n;i++)
for(int j=0;j<m;j++){
if(g[i][j]=='S'){
sx=i,sy=j;
}
if(g[i][j]=='T'){
ex=i,ey=j;
}
}
if(ca) printf("\n");
ca=1;
printf("Case #%d\n",cas++);
bfs();
}
return 0;
}