这个题被stl的queue坑了2小时,一直re,换成手写的队列就ac了
#include<cstdio>
#include<stdlib.h>
#include<queue>
#include<cstring>
using namespace std;
int n,m,l,k;
int map[25][25];
bool visit[25][25][16400];
int h[4]={1,-1,0,0};
int g[4]={0,0,1,-1};
struct point{
int x[10],y[10];
int dir[10];
int step;
}que[50010];
int front,rear;
int pre_dir(int px,int py,int x,int y){//计算蛇的每一节身体相对前一节方向
if(x>px)
return 0;
else if(x<px)
return 3;
else if(y>py)
return 2;
else
return 1;
}
int calhash(struct point & now){//用位运算压缩存储状态
int i,sum;
sum=0;
for(i=2;i<=l;i++)
sum=sum*4+now.dir[i];
return sum;
}
int bfs(){
int i,j,xx,yy,addr;
while(front !=rear){
front=(front+1)%50000;
struct point tem;
tem=que[front];
if(tem.x[1]==1 && tem.y[1]==1){
return tem.step;
}
for(i=2;i<=l;i++)
map[tem.x[i]][tem.y[i]]=-1;
for(i=0;i<=3;i++){
xx=tem.x[1]+h[i];
yy=tem.y[1]+g[i];
if(xx<=0 || xx>n || yy<=0 || yy>m)
continue;
if(map[xx][yy]==0){
struct point temp;
temp.step=tem.step+1;
temp.x[1]=xx;
temp.y[1]=yy;
temp.dir[2]=pre_dir(xx,yy,tem.x[1],tem.y[1]);
for(j=2;j<=l;j++){
temp.x[j]=tem.x[j-1];
temp.y[j]=tem.y[j-1];
if(j!=2)
temp.dir[j]=tem.dir[j-1];
}
addr=calhash(temp);
if(visit[xx][yy][addr])
continue;
visit[xx][yy][addr]=true;
rear=(rear+1)%50000;
que[rear]=temp;
}
}
for(i=2;i<=l;i++)
map[tem.x[i]][tem.y[i]]=0;
}
return -1;
}
int main(){
int i,j,x,y,C=0,res;
while(scanf("%d %d %d",&n,&m,&l)==3 && !(n==0 && m==0 && l==0)){
memset(map,0,sizeof(map));
memset(visit,0,sizeof(visit));
front=-1;
rear=0;
struct point sta;
for(i=1;i<=l;i++){
scanf("%d %d",&sta.x[i],&sta.y[i]);
if(i!=1)
sta.dir[i]=pre_dir(sta.x[i-1],sta.y[i-1],sta.x[i],sta.y[i]);
}
sta.step=0;
que[0]=sta;
scanf("%d",&k);
for(i=1;i<=k;i++){
scanf("%d %d",&x,&y);
map[x][y]=-1;
}
int addr=calhash(sta);
visit[sta.x[1]][sta.y[1]][addr]=true;
printf("Case %d: %d\n",++C,bfs());
}
}