问题 E: 迷宫问题[bfs 寻找从起点到终点的最短路 图中有障碍]

题目描述

小明置身于一个迷宫，请你帮小明找出从起点到终点的最短路程。
小明只能向上下左右四个方向移动。

输入

输入包含多组测试数据。输入的第一行是一个整数T，表示有T组测试数据。
每组输入的第一行是两个整数N和M（1<=N,M<=100）。
接下来N行，每行输入M个字符，每个字符表示迷宫中的一个小方格。
字符的含义如下：
‘S’：起点
‘E’：终点
‘-’：空地，可以通过
‘#’：障碍，无法通过
输入数据保证有且仅有一个起点和终点。

输出

对于每组输入，输出从起点到终点的最短路程，如果不存在从起点到终点的路，则输出-1。

样例输入

1
5 5
S-###
-----
##---
E#---
---##

样例输出

9

提示

#include<iostream>
#include<cstring>
#include<utility>
#include<queue>
using namespace std;
char map[110][110];
int count[110][110];
//bool visited[110][110];
int col,len;
typedef pair<int,int>P; 
int dx[4]={1,0,-1,0};
int dy[4]={0,1,0,-1};
void bfs(int s1,int s2)
{
    queue<P>q;
    q.push(P(s1,s2));
    while(q.size())
    {
        P p=q.front();
        q.pop();
        if(map[p.first][p.second]=='E')
        {
            break;
        }
        for(int i=0;i<4;i++)
        {
            int nx=p.first+dx[i];
            int ny=p.second+dy[i];
            if(map[nx][ny]!='#'&&nx<col&&ny<len&&nx>=0&&ny>=0&&!count[nx][ny])
            {
                q.push(P(nx,ny));
                count[nx][ny]=count[p.first][p.second]+1;
            }
        }
    }
}
int main()
{
    int T;
    cin>>T;
    while(T>0)
    {
        int N,M;
        cin>>N>>M;
        col=N;
        len=M;
        memset(map,0,sizeof(map));
        memset(count,0,sizeof(count));
        //memset(visited,false,sizeof(visited));
        for(int i=0;i<N;i++)
        {
            for(int j=0;j<M;j++)
            {
                cin>>map[i][j];
            }
        }
        int s1,s2,e1,e2;
        for(int i=0;i<N;i++)
        for(int j=0;j<M;j++)
        {
            if(map[i][j]=='S')
            {
                s1=i;
                s2=j;
            }
            if(map[i][j]=='E')
            {
                e1=i;
                e2=j;
            }
        }
        bfs(s1,s2);
        if(count[e1][e2]!=0)
        printf("%d\n",count[e1][e2]);
        int h=-1;
        if(count[e1][e2]==0)
        printf("%d\n",h);
        T--;
     } 
 }