[NOIP2013]华容道

题目描述 Description
小 B 最近迷上了华容道，可是他总是要花很长的时间才能完成一次。于是，他想到用编程来完成华容道：给定一种局面，华容道是否根本就无法完成，如果能完成，最少需要多少时间。
小 B 玩的华容道与经典的华容道游戏略有不同，游戏规则是这样的：

在一个 n*m 棋盘上有 n*m 个格子，其中有且只有一个格子是空白的，其余 n*m-1个格子上每个格子上有一个棋子，每个棋子的大小都是 1*1 的；
有些棋子是固定的，有些棋子则是可以移动的；
任何与空白的格子相邻（有公共的边）的格子上的棋子都可以移动到空白格子上。 游戏的目的是把某个指定位置可以活动的棋子移动到目标位置。
给定一个棋盘，游戏可以玩 q 次，当然，每次棋盘上固定的格子是不会变的，但是棋盘上空白的格子的初始位置、指定的可移动的棋子的初始位置和目标位置却可能不同。第 i 次玩的时候，空白的格子在第 EX_i 行第 EY_i 列，指定的可移动棋子的初始位置为第 SX_i 行第 SY_i 列，目标位置为第 TX_i 行第 TY_i 列。
假设小 B 每秒钟能进行一次移动棋子的操作，而其他操作的时间都可以忽略不计。请你告诉小 B 每一次游戏所需要的最少时间，或者告诉他不可能完成游戏。

输入描述 Input Description
第一行有 3 个整数，每两个整数之间用一个空格隔开，依次表示 n、m 和 q；
接下来的 n 行描述一个 n*m 的棋盘，每行有 m 个整数，每两个整数之间用一个空格隔开，每个整数描述棋盘上一个格子的状态，0 表示该格子上的棋子是固定的，1 表示该格子上的棋子可以移动或者该格子是空白的。
接下来的 q 行，每行包含 6 个整数依次是 EX_i、EY_i、SX_i、SY_i、TX_i、TY_i，每两个整数之间用一个空格隔开，表示每次游戏空白格子的位置，指定棋子的初始位置和目标位置。

输出描述 Output Description
输出有 q 行，每行包含 1 个整数，表示每次游戏所需要的最少时间，如果某次游戏无法完成目标则输出-1。

样例输入 Sample Input
3 4 2
0 1 1 1
0 1 1 0
0 1 0 0
3 2 1 2 2 2
1 2 2 2 3 2

样例输出 Sample Output
2
-1

bfs加spfa

#include<cstdio>
#include<cstring>
#include<iostream>
#include<algorithm>
using namespace std;
const int INF = 100000007;
const int N = 4000+5;
const int W = 35;
int n,m,qq;
int last[N],cnt=0,ans;
int q[N][2],dis[W][W],req[N];
int vis[N],redis[N];
int map[W][W],dx[4] = {-1,1,0,0},dy[4] = {0,0,-1,1};
struct Node{
    int v,to,next;
}e[N];
void insert( int u, int v, int w ){
    e[++cnt].to = v; e[cnt].next = last[u]; e[cnt].v = w; last[u] = cnt;
}
void bfs(int si,int sj,int bi,int bj,int id)
{
    int i,head,tail,j,k,ii,jj;
    memset(dis,0,sizeof(dis));
    head = 1; tail = 2;
    q[1][0] = si; q[1][1] = sj; dis[si][sj] = 1;
    while(head != tail)
    {
        i = q[head][0]; j = q[head++][1];
        for(k=0;k<4;k++)
        {
            ii = i+dx[k]; jj = j+dy[k];
            if(!map[ii][jj] || (ii==bi&&jj==bj) || dis[ii][jj]) continue;
            dis[ii][jj] = dis[i][j]+1;
            q[tail][0] = ii; q[tail++][1] = jj;
        }
    }
    if(id == 4) return;
    for(k=0;k<4;k++)
    {
        i = bi+dx[k]; j = bj+dy[k];
        if((i == si && j == sj) || !dis[i][j]) continue;
        insert(bi*30*4+bj*4+id,bi*30*4+bj*4+k,dis[i][j]-1);
    }
    insert(bi*30*4+bj*4+id,si*30*4+sj*4+(id^1),1);
}
void spfa( int si, int sj ){
    memset(redis,63,sizeof(redis));
    int head = 1; int tail = 1;
    for( int i = 0; i < 4; i++ ){
        int xx = si+dx[i], yy = sj+dy[i];
        if( dis[xx][yy] ) {
            int nn = si*30*4 + sj*4 + i;
            req[tail++] = nn; redis[nn] = dis[xx][yy]-1; vis[nn] = 1;
        }
    }int v,u,val;
    while( head != tail ){
       u = req[head++];
        for( int i = last[u]; i; i = e[i].next ){
            v = e[i].to; val = e[i].v;
            if( redis[v] <= redis[u]+val ) continue;
            redis[v] = redis[u]+val;
            if( vis[v] ) continue;
            vis[v] = 1; req[tail++] = v;
            if( tail > 4005 ) tail = 1;
        }
        vis[u] = 0;
        if( head > 4005 ) head = 1;
    }
}
int bi,bj,si,sj,ti,tj;
int main(){
    scanf("%d%d%d", &n, &m, &qq); 
    for( int i = 1; i <= n; i++ ) for( int j = 1; j <= m; j++ ) scanf("%d", &map[i][j]);
    for( int i = 1; i <= n; i++ ) for( int j = 1; j <= m; j++ )
        if( map[i][j] ){
            if( map[i-1][j] ) bfs( i-1, j, i, j, 0 );
            if( map[i+1][j] ) bfs( i+1, j, i, j, 1 );
            if( map[i][j-1] ) bfs( i, j-1, i, j, 2 );
            if( map[i][j+1] ) bfs( i, j+1, i, j, 3 );
        }
    while( qq-- ){
        scanf("%d%d%d%d%d%d", &bi, &bj, &si, &sj, &ti, &tj );
        if( si == ti && sj == tj ){ printf("0\n"); continue; }
        ans = INF; bfs( bi, bj, si, sj, 4 ); spfa( si, sj );
        for( int i = 0; i < 4; i++ ) ans = min( ans, redis[ ti*30*4 + tj*4 + i ] );
        int yu = (ans >= INF) ? -1 : ans;
        printf("%d\n", yu);
    }
    return 0;
}