广度优先搜索（C语言实例）

我们得到一个二维数组，这个为维数组就像当一个坐标一样，它的上边有障碍物（在有障碍物的地方我们用1来表示，没障碍物的地方用0来表示），使用广度优先搜索，我们就要用到队列，具体的思路就是如下伪代码

伪代码：
void BFS（Vertex V）{    //从V这个顶点开始遍历
    visited[V]=true;    //先对V进行确认
    Enqueue(V,Q);    //将V压入队列中
    while（！IsEmpty）{    
        V=Dequeue(Q);   //将队列中的弹出
        for(V的每一个邻接点W）{
            if(!visted[w]){
 	            visted[w]=true;
                Enqueue(V,Q);   //将V压入队列中	
            }
       }
    }
}

这里使用实例来描述

#include<stdio.h>

struct note{
	int x;//横坐标 
	int y;//纵坐标 
	int f;//父在队列中的编号 
	int s;//步数 
};


int main(){
	struct note que[2501];//创建队列
	int a[51][51]={0},book[51][51]={0};
	//定义方向的数组
	int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};
	int head,tail;
	int i,j,m,n,startx,starty,p,q,tx,ty,flag;
	scanf("%d %d",&n,&m);
	for(i=1;i<=n;i++){
		for(j=1;j<=m;j++){
			scanf("%d",&a[i][j]);
		}
	}
	
	//输入出发点和要到达的点 
	scanf("%d %d %d %d",&startx,&starty,&p,&q); 
	
	//初始化队列
	head=1;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;//用来标记是否到达
	
	//判断队列 
	while(head<tail){
		
		//向着四个方向出发 
		for(i=0;i<4;i++){
			
			tx=que[head].x+next[i][0];
			ty=que[head].y+next[i][1];
			
			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;
				que[tail].s=que[head].s+1;
				tail++;		
			}
			if(tx==p&&ty==q){
				flag=1;
				break;
			}
		}
		if(flag==1){
			break;
		}
		head++;
	} 
	 
	 printf("%d",que[tail-1].s);
}