4.3层层递进——广度优先搜索

#include<iostream>
using namespace std;
struct note{
	int x;//横坐标
	int y;//纵坐标
	int f;//父亲在队列中的编号，本题不需要输出路径，可以不需要f
	int s;//步数 
};

int main(){
	struct note que[2501];//因为地图大小不超过50*50,因此队列扩展不会超过2500个
	int a[51][51]={0},book[51][51]={0};
	//定义一个用于表示走的方向的数组 
	int next[4][2]={{0,1},//向右走
					{1,0},//向下走
					{0,-1},//向左走 
				    {-1,0}//向上走	
	};//4行2列的二维数组
	/*
	也可以写成这样: 
	int next[4][2]={0,1,1,0,0,-1,-1,0};
	*/
	int head,tail;//队列 
	int i,j,k,n,m,startx,starty,p,q,tx,ty,flag;
	
	cout<<"请输入n和m,n为行,m为列："<<endl;
	cin>>n>>m;
	//读入迷宫
	cout<<"请输入迷宫矩阵："<<endl;
	for(i=1;i<=n;i++){
		for(j=1;j<=m;j++){
			cin>>a[i][j];
		}
	} 
	//读入起点和终点坐标
	cout<<"请输入起点和终点的坐标："<<endl;
	cin>>startx>>starty>>p>>q;
	
	//队列初始化
	head=tail=1; 
	//往队列插入迷宫入口坐标 
	que[tail].x=startx;
	que[tail].y=starty;
	que[tail].f=0;
	que[tail].s=0;
	tail++;
	book[startx][starty]=1;
	flag=0;//用来标记是否到达目标点，0表示暂时还没有到达，1表示到达 
	//当队列不为空时循环
	while(head<tail){
		//枚举4个方向
		for(k=0;k<=3;k++){
			//计算下一个点的坐标
			tx=que[head].x+next[k][0];
			ty=que[head].y+next[k][1];
			/*
			next二维数组 
			next[0][0]=0;	next[0][1]=1;   //向右走
			next[1][0]=1;	next[1][1]=0;   //向下走
			next[2][0]=0;	next[2][1]=-1;  //向左走 
			next[3][0]=-1;	next[3][1]=0;	//向上走  
		
			*/
			//判断是否越界
			if(tx<1||tx>n||ty<1||ty>m){
				continue;//退出此次循环 
			} 
			
			//判断该点是否为障碍物或者已经在路径中
			if(a[tx][ty]==0&&book[tx][ty]==0){
				
				book[tx][ty]=1;//标记这个点已经走过
				que[tail].x=tx;
				que[tail].y=ty;
				que[tail].f=head;//因为这个点是从head扩展出来的,所以它的父亲是head,本题目不需要求路径,因此本句可忽略
				que[tail].s=que[head].s+1;//步数是父亲的步数+1
				tail++; 
			} 
			//如果到目标点了，停止扩展，任务结束，退出循环
			if(tx==p&&ty==q){
				//注意下面两句话的位置千万不要写颠倒了
				flag=1;
				break; 
			} 
			
		} 
		if(flag==1){
			break;
		}
		head++;//注意这地方千万不要忘记，当一个点扩展结束后，head++才能对后面的点再进行扩展 

	} 
	//打印队列中末尾最后一个点(点)的步数
	//注意tail是指向队列队尾(即最后一位)的下一个位置，所以这需要-1
	cout<<"最短路径为："<<que[tail-1].s;
		
	getchar();
	return 0;
}