POJ 1324 Holedox Moving（A*+状态压缩）

//
//  main.cpp
//  Richard
//
//  Created by 邵金杰 on 16/8/25.
//  Copyright © 2016年 邵金杰. All rights reserved.
//



#include<iostream>
#include<cstdio>
#include<cstring>
#include<queue>
using namespace std;
struct node{
    int x,y,s,t,f;
    bool operator < (const node &e) const {
        return f>e.f;
    }
};
struct Point{
    int x[10],y[10];
}state;
int vis[22][22][1<<15];
int n,m,l,k;
int map[25][25];
int dx[4]={-1,0,1,0};
int dy[4]={0,1,0,-1};
int encode()
{
    int s=0;
    for(int i=l-1;i>0;i--)
    {
        int dir=0;
        int dirx=state.x[i]-state.x[i-1];
        int diry=state.y[i]-state.y[i-1];
        if(dirx==1&&diry==0) dir=2;
        else if(dirx==0&&diry==1) dir=1;
        else if(dirx==-1&&diry==0) dir=0;
        else if(dirx==0&&diry==-1) dir=3;
        s<<=2;s|=dir;//先腾出位置再放进去，反一反WA
    }
    return s;
}
node move(node a,int i)
{
    node p=a;
    int dir=0;
    p.x=a.x+dx[i];
    p.y=a.y+dy[i];
    int x=-dx[i],y=-dy[i];
    if(x==-1&&y==0) dir=0;
    else if(x==0&&y==1) dir=1;
    else if(x==1&&y==0) dir=2;
    else if(x==0&&y==-1) dir=3;
    p.s<<=2;
    p.s|=dir;
    p.s&=((1<<((l-1)*2))-1);
    return p;
}
Point decode(node s)
{
    Point p;
    p.x[0]=s.x;p.y[0]=s.y;
    for(int i=1;i<l;i++)
    {
        int dir=3;
        dir&=s.s;
        s.s>>=2;
        p.x[i]=p.x[i-1]+dx[dir];
        p.y[i]=p.y[i-1]+dy[dir];
    }
    return p;
}
bool judge(node e,node s)
{
    if(e.x<1||e.x>n||e.y<1||e.y>m) return false;
    if(map[e.x][e.y]==1) return false;
    if(vis[e.x][e.y][e.s]==1) return false;
    Point ss=decode(s);
    for(int i=0;i<l;i++)
        if(e.x==ss.x[i]&&e.y==ss.y[i]) return false;
    return true;
}
void Astar(node s)
{
    memset(vis,0,sizeof(vis));
    priority_queue<node> pq;
    pq.push(s);
    vis[s.x][s.y][s.s]=1;
    node e;
    while(!pq.empty())
    {
        s=pq.top();
        pq.pop();
        if(s.x==1&&s.y==1) {printf("%d\n",s.t);return ;}
        for(int i=0;i<4;i++)
        {
            e=move(s,i);
            if(!judge(e,s)) continue;
            vis[e.x][e.y][e.s]=1;
            e.t=s.t+1;
            e.f=e.t+e.x+e.y;
            pq.push(e);
        }
    }
    printf("-1\n");
}
int main()
{
    int kase=0;
    while(scanf("%d%d%d",&n,&m,&l)&&(n+m+l))
    {
        memset(map,0,sizeof(map));
        for(int i=0;i<l;i++)
            scanf("%d%d",&state.x[i],&state.y[i]);
        scanf("%d",&k);
        int x,y;
        for(int i=0;i<k;i++){
            scanf("%d%d",&x,&y);
            map[x][y]=1;
        }
        node s;
        s.x=state.x[0],s.y=state.y[0];
        s.t=0;
        s.f=s.t+s.x+s.y;
        s.s=encode();
        printf("Case %d: ",++kase);
        Astar(s);
    }
    return 0;
}