Toj 1116 Poj 1324（A*搜索） Holedox Moving

/*
题意 ： 
          给定一个 n*m (n,m<=20) 的地图，和一条长为 k (k<=8) 的贪吃蛇 ，地图上有些点是障碍物 ， 求蛇头移动到 （1,1） 的最短路径 。

分析 ：
         由于是求最短路径，所以大致可以用三种搜索方法求解 。
         表示状态时，可以记录蛇头坐标， 与蛇身形状，因为蛇身体是相邻的，可以采用方向记录 ，共 （1<<(2*(l-1)) ）*400 个 状态 。
         评估函数可以采用从（1,1）BFS 的距离 。
         1： 广搜 
                这题广搜虽然可行，但是比较费时，因为可能会搜索到大量的状态 。
                若当前代价+当前位置不考虑身体到达目的地的最短距离 > 目前最优解 。
                        剪枝。
         2：IDA* 
               尝试过，但是 TLE 到死，可能是我写的不好吧，希望谁知道的指教下 ～
         3：A*
               此题A*的优势就体现出来了，因为评估函数还算理想，状态也不多，所以跑得挺快的 （32ms ）。
               等以后有时间再回来想想优化吧 。
*/

#include<cstdio>
#include<map>
#include<string>
#include<cstring>
#include<iostream>
#include<cmath>
#include<vector>
#include<algorithm>
#include<queue>
using namespace std;

const int size=64*64*4*21*21;
int dis[22][22],vis[22][22],q[1000],qin,qout;
int n,m,l;
int X[10],Y[10],dx[4]={1,-1,0,0},dy[4]={0,0,1,-1};

struct node{
	int x,y,k,ans;
	bool operator<(const node &a)const{return ans+dis[x][y]>a.ans+dis[a.x][a.y];}
}tmp,a;
int res[64*64*4][21*21]={0},tag,hash[21][21],bigt;  //记录信息
priority_queue<node> Q;

int ida_s(node tmp){
	while(!Q.empty())Q.pop();
	Q.push(tmp);
	while(!Q.empty()){
		tmp=Q.top();Q.pop();
		if(res[tmp.k][(tmp.x-1)*20+tmp.y-1]==tag)continue;

		++bigt;
		res[tmp.k][(tmp.x-1)*20+tmp.y-1]=tag;

		if(tmp.x+tmp.y==2)return tmp.ans;

		int x=tmp.x,y=tmp.y,k=tmp.k;
		int nx,ny,xx,yy;
			xx=x;yy=y;
			for(int i=0;i<l-1;i++){
				xx+=dx[k%4];yy+=dy[k%4];k/=4;
				hash[xx][yy]=bigt;
			}
		for(int i=0;i<4;i++){
			nx=x-dx[i];ny=y-dy[i];//cout<<nx<<' '<<ny<<endl;
			if(nx<1||nx>n||ny<1||ny>m||vis[nx][ny])continue;
			if(hash[nx][ny]==bigt)continue;
			k=tmp.k;
			k%=(1<<(2*(l-2)));
			k=(4*k+i);
			a.k=k;a.x=nx;a.y=ny;a.ans=tmp.ans+1;
			if(res[a.k][(a.x-1)*(20)+a.y-1]!=tag)
			Q.push(a);
		}
	}
	return -1;
}

void bfs(){
	memset(dis,-1,sizeof(dis));
	qin=qout=0;
	q[qin++]=1;q[qin++]=1;dis[1][1]=0;
	while(qin!=qout){
		int x=q[qout++],y=q[qout++];
		for(int i=0;i<4;i++){
			int nx=x+dx[i],ny=y+dy[i];
			if(nx<1||nx>n||ny<1||ny>m||dis[nx][ny]!=-1||vis[nx][ny])continue;
			dis[nx][ny]=dis[x][y]+1;
			q[qin++]=nx;q[qin++]=ny;
		}
	}
}

int main(){
	int ca=1;bigt=1;
	while(~scanf("%d%d%d",&n,&m,&l),n){
		tag=ca;
		int k,x,y;
		memset(vis,0,sizeof(vis));
		for(int i=0;i<l;i++)scanf("%d%d",&X[i],&Y[i]);
		scanf("%d",&k);
		while(k--){
			scanf("%d%d",&x,&y);
			vis[x][y]=1;
		}
		k=0;
		for(int i=l-1;i;i--){
			for(int j=0;j<4;j++)
			if(X[i]-dx[j]==X[i-1]&&Y[i]-dy[j]==Y[i-1])
				k=(4*k+j);
		}
		bfs();
		printf("Case %d: ",ca++);
		if(X[0]+Y[0]==2)printf("0\n");
		else if(dis[X[0]][Y[0]]==-1){
			printf("-1\n");
		}
		else{
			tmp.x=X[0];tmp.y=Y[0];tmp.k=k;tmp.ans=0;
			printf("%d\n",ida_s(tmp));
		}
	}
}