ZJNU1450 迷宫 广度优先搜索BFS

Description

小C最近在研究机器人，他想看看自己的机器人够不够智能，于是他将机器人放在一个n*m的迷宫中，看看机器人能不能在最短的时间内到达目的地，可是小C不知道最短的时间是多少，现在请你帮他算算机器人到达目的地的最短时间是多少？

Input

输入数据第一行两个整数n和m。
接下来n行，每行m个元素，表示迷宫的每个方格。
'S'表示机器人的出发点,
'T'表示目的地，
'#'表示该方格不能通过
'.'表示可以通过

Output

输出一个整数表示机器人到达目的地的最短时间，如果机器人不能到达目的地，输出-1。

Sample Input

3 3

S..

##.

.T.

Sample Output

5

代码区：

#include <cstdlib>
#include <cstdio>
#include <iostream>
#include <algorithm>
#include <queue>
#include <string.h>
using namespace std;
struct node//定义结构体
{
	int x,y,step;//step为步数
}s;
int vis[1005][1005];
char mp[1005][1005];
int n,m;
int dis[4][2]={1,0,-1,0,0,1,0,-1};//判断该坐标上下左右的点坐标
int bfs() //广度优先搜索
{
	queue<node>q;//定义队列 （队列为先入先出）
	node next,p,t;
	p.x=s.x;
	p.y=s.y;
	p.step=0;
	vis[p.x][p.y]=1;//标记走过了
	q.push(p);//进入队列
	while(!q.empty())
	{
		t=q.front();//读取队头
		q.pop();//退出队列
		if(mp[t.x][t.y]=='T')//当抵达目的地返回步数
			return t.step;
		for(int i=0;i<4;i++)
		{
			next.x=t.x+dis[i][0];
			next.y=t.y+dis[i][1];
			/*
			当i=0向右，i=1向左，i=2向上，i=3向下
			*/
			if(mp[next.x][next.y]=='T')//当下一个坐标为目的地时，返回步数加1
				return t.step+1;
			if(mp[next.x][next.y]=='.'&&vis[next.x][next.y]==0&&next.x>0&&next.x<=n&&next.y>0&&next.y<=m)//当可以通过且没有走过这点，坐标合理时
			{
				vis[next.x][next.y]=1;//标记改点已经走过
				next.step=t.step+1;
				q.push(next);//进入队列递归
			}
		}
	}
	return 0;
}
int main()
{
	while(~scanf("%d%d%*c",&n,&m))//*c为防止读入回车键
	{
		memset(vis,0,sizeof(vis));//初始化数组
		memset(mp,0,sizeof(mp));//初始化数组
		for(int i=1;i<=n;i++)
		{
			scanf("%s",mp[i]+1);//此处+1是为了使读取的mp[i]从mp[i][1]开始储存
			for(int j=1;j<=m;j++)
			{
				if(mp[i][j]=='S')//当遇到出发点赋值
				{
					s.x=i;s.y=j;
				}
			}
		}
		int ans;
		ans=bfs();//调用函数进行广度优先搜索
		if(ans==0)//当ans=0时不能到达目的地
			cout << "-1" << endl;
		else
			cout << ans << endl;
	}
	return 0;
}

新手上路，有错请指正