解救小Q

题意：

小Q被邪恶的大魔王困在了迷宫里，love8909决定去解救她。 迷宫里面有一些陷阱，一旦走到陷阱里，就会被困身亡:(，迷宫 里还有一些古老的传送阵，一旦走到传送阵上，会强制被传送到 传送阵的另一头。 现在请你帮助love8909算一算，他至少需要走多少步才能解 救到小Q？

思路：bfs

#include <stdio.h>
#include <string.h>
struct node
{
    int x1,y1,x2,y2;
}belt[26];
struct 
{
    int x0,y0,count;
}path[2500];
int dis[4][2]={
    0,-1,1,0,0,1,-1,0
};
int cnt[26];
bool vis[55][55];
char map[55][55];
int front;
int finalx,finaly;
int n,m;
void bfs()
{
    int rear=0,temp=0,mark=0;
    while(front<=rear&&!mark){
        while(front<=temp){
            if(path[front].x0==finalx&&path[front].y0==finaly){
                printf("%d\n",path[front].count);
                mark=1;
                break;
            }
            for(int i=0;i<4;i++){
                int nx=path[front].x0+dis[i][0];
                int ny=path[front].y0+dis[i][1];
                if(nx<0||nx>=m||ny<0||ny>=n||vis[ny][nx])
                continue;
                if(map[ny][nx]>='a'&&map[ny][nx]<='z'){
                    if(ny==belt[map[ny][nx]-'a'].y1&&nx==belt[map[ny][nx]-'a'].x1){
                        path[++rear].y0=belt[map[ny][nx]-'a'].y2;
                        path[rear].x0=belt[map[ny][nx]-'a'].x2;
                        path[rear].count=path[front].count+1;
                    }
                    else{
                        path[++rear].y0=belt[map[ny][nx]-'a'].y1;
                        path[rear].x0=belt[map[ny][nx]-'a'].x1;
                        path[rear].count=path[front].count+1;
                    }
                    vis[ny][nx]=true;
                    continue;
                }
                path[++rear].x0=nx;
                path[rear].y0=ny;
                path[rear].count=path[front].count+1;
                vis[ny][nx]=true;
            }
            front++;
        }
        temp=rear;
    }
    if(!mark)
    printf("-1\n");
}
int main()
{
    int t;
    scanf("%d",&t);
    while(t--){
        scanf("%d%d",&n,&m);
        getchar();
        memset(cnt,0,sizeof(cnt));
        memset(vis,false,sizeof(vis));
        front=-1;
        for(int i=0;i<n;i++){
            for(int j=0;j<m;j++){
                scanf("%c",&map[i][j]);
                if(map[i][j]>='a'&&map[i][j]<='z'){
                    if(cnt[map[i][j]-'a']==0){
                        cnt[map[i][j]-'a']++;
                        belt[map[i][j]-'a'].x1=j;
                        belt[map[i][j]-'a'].y1=i;
                    }
                    else{
                        belt[map[i][j]-'a'].x2=j;
                        belt[map[i][j]-'a'].y2=i;
                    }
                }
                else if(map[i][j]=='L'){
                    path[++front].x0=j;
                    path[front].y0=i;
                    path[front].count=0;
                    vis[i][j]=true;
                }
                else if(map[i][j]=='Q'){
                finalx=j;
                finaly=i;
                }
                else if(map[i][j]=='#')
                vis[i][j]=true;
            }
            getchar();
        }
        bfs();
    }    
}