BFS广度优先搜索

迷宫问题

/*
2
5 5
S-###
----- 
##--- 
E#---
---##
*/ 

#include<iostream>
#include<queue>
using namespace std;

int v[100][100]/*访问*/;
char  a[100][100]/*地图*/;

struct point{
	int x;
	int y;
	int step;
};

queue<point> r;//申请队列 
int dx[4]={0,1,0,-1};//四个方向，右，下，左，上 
int dy[4]={1,0,-1,0};// 
int main(){
	//输入
	int t,n,m,startx,starty,p,q;
	cin>>t;
	while(t!=0){
		cin>>n>>m;
		for(int i=1;i<=n;i++){
			for(int j=1;j<=m;j++){
				cin>>a[i][j];
			}	
		}
		for(int i=1;i<=n;i++){
			for(int j=1;j<=m;j++){
				if(a[i][j]=='S'){
					startx=i;
					starty=j;
				}
				if(a[i][j]=='E'){
					p=i;
					q=j;
				}
			}	
		}
		//cout<<startx<<starty<<p<<q;
		//BFS 
		point start;
		start.x=startx;
		start.y=starty;
		start.step=0;
		
		r.push(start);//将点start进行入队
		
		v[startx][starty]=1;
		int flag=0;
		
		while(!r.empty()){
			int x=r.front().x,y=r.front().y;
			if(x==p&&y==q){
				flag=1;
				cout<<r.front().step; 
				break;
			}
			for(int k=0;k<=3;k++){
				int tx,ty;
				tx=x+dx[k];
				ty=y+dy[k];
				if((a[tx][ty]=='-'||a[tx][ty]=='E')&&v[tx][ty]==0){
					point temp;
					temp.x=tx;
					temp.y=ty;
					temp.step=r.front().step+1;
					r.push(temp);
					v[tx][ty]=1;
				}
			}
			r.pop();//拓展完了，需要将队首元素出队	
		}
		if(flag==0)
			cout<<-1<<endl;
		t--;
	}
	return 0; 
}