最短路径BFS算法matlab,迷宫的最短路径 bfs算法

题目描述：

给定一个大小为N*M的迷宫，由通道(.)和墙壁(#)组成，其中通道S表示起点，通道G表示终点，每一次移动可以到达上下左右中不是墙壁的位置。试求出起点到终点的最小步数。

样例输入输出：

思路：

这个例题很好的表现了广度优先搜索bfs和队列先进先出的思想，

在这个问题中，找到从起点到终点的最短路径其实就是一个建立队列的过程：

1，从起点开始，先将起点加入队列，设置数组中记录距离为0

2，从队列首端取出元素，将从这个位置开始，能达到的位置 加入队列中，并且让这些位置的距离为上一个位置的距离加上一

3，循环第二个步骤，直到将终点添加到队列中

注意：

在这个过程中，每次处理的位置所对应的距离是严格递增的，因此，一旦找到终点，当前的距离就是最短距离，

搜索可移动到的位置中，判断条件不仅仅是不碰壁不超边界，还有一个条件就是没有到达过。因为，如果已经到达了这个位置，这说明已经有更短的路径到达了这个位置，这次到达这个位置的路径是更远的，不可能达到最优解。

代码：

#include #include using namespace std;

const int MAX=100;

const int INF=0x3f3f3f3f;

typedef pairP;

char shuru[MAX+5][MAX+5];

int n,m;

int sx,sy;//记录起点的位置

int gx,gy;//记录终点的位置

int d[MAX+5][MAX+5];//用数组存储起点到某一点的距离

int dx[4]={1,0,-1,0},dy[4]={0,1,0,-1};//表明每次x和y方向的位移

void bfs()

{

queue

que;//queue>que;

//初始化所有点为INF

for(int i=0;i=0 && nx=0 && ny>n>>m;

//一行一行的输ru

for(int i=0;i>shuru[i];

for(int i=0;i