[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;}