//迷宫问题---广度优先搜索-----队列
#include <stdio.h>
#include <queue>
#include <iostream>
using namespace std;
#define MAX_ROW 5
#define MAX_COL 5

struct point
{
	int row;
	int col;
};

queue<point> s;

int maze[MAX_ROW][MAX_COL] = 
{
	0,0,0,0,0,
	0,0,0,1,0,
	0,1,0,0,0,
	0,0,0,0,0,
	0,0,0,1,0
};

void print_maze()
{
	for(int i=0; i<MAX_ROW; ++i)
	{
		for(int j=0; j<MAX_COL; ++j)
		{
			printf("%d ",maze[i][j]);
		}
		printf("\n");
	}
	printf("************************\n");
}

struct point predecessor[MAX_ROW][MAX_COL] = 
{
	{{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
	{{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
	{{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
	{{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}},
	{{-1,-1},{-1,-1},{-1,-1},{-1,-1},{-1,-1}}
};

void visit(int row,int col,struct point pre)
{
	point visit_point = {row,col};
	maze[row][col] = 2;
	predecessor[row][col] = pre;
	s.push(visit_point);
}

int main()
{
	point p = {0,0};
	maze[p.row][p.col] = 2;
	s.push(p);
	while(!s.empty())
	{
		p = s.front();
		s.pop();
		//抵达目的地
		if(p.row == MAX_ROW-1 && p.col == MAX_COL-1)
		{
			break;
		}

		//向下移动
		if(p.row+1 < MAX_ROW && maze[p.row+1][p.col]==0)
		{
			visit(p.row+1,p.col,p);
		}

		//向右移动
		if(p.col+1 < MAX_COL && maze[p.row][p.col+1]==0)
		{
			visit(p.row,p.col+1,p);
		}

		//向上移动
		if(p.col-1 >= 0 && maze[p.row][p.col-1]==0)
		{
			visit(p.row,p.col-1,p);
		}
		//向左移动
		if(p.row-1>=0 && maze[p.row-1][p.col]==0)
		{
			visit(p.row-1,p.col,p);
		}
		print_maze();
	}
	if(p.row == MAX_ROW-1 && p.col == MAX_COL-1)
	{
		printf("(%d,%d)\n",p.row,p.col);
		while(predecessor[p.row][p.col].row != -1)
		{
			p = predecessor[p.row][p.col];
			printf("(%d,%d)\n",p.row,p.col);
		}
	}
	else
	{
		cout <<"NO Path"<<endl;
	}
	return 0;
}

运行结果：

2 2 0 0 0
2 0 0 1 0
0 1 0 0 0
0 0 0 0 0
0 0 0 1 0
************************
2 2 0 0 0
2 2 0 1 0
2 1 0 0 0
0 0 0 0 0
0 0 0 1 0
************************
2 2 2 0 0
2 2 0 1 0
2 1 0 0 0
0 0 0 0 0
0 0 0 1 0
************************
2 2 2 0 0
2 2 0 1 0
2 1 0 0 0
2 0 0 0 0
0 0 0 1 0
************************
2 2 2 0 0
2 2 2 1 0
2 1 0 0 0
2 0 0 0 0
0 0 0 1 0
************************
2 2 2 2 0
2 2 2 1 0
2 1 0 0 0
2 0 0 0 0
0 0 0 1 0
************************
2 2 2 2 0
2 2 2 1 0
2 1 0 0 0
2 2 0 0 0
2 0 0 1 0
************************
2 2 2 2 0
2 2 2 1 0
2 1 2 0 0
2 2 0 0 0
2 0 0 1 0
************************
2 2 2 2 2
2 2 2 1 0
2 1 2 0 0
2 2 0 0 0
2 0 0 1 0
************************
2 2 2 2 2
2 2 2 1 0
2 1 2 0 0
2 2 0 0 0
2 2 0 1 0
************************
2 2 2 2 2
2 2 2 1 0
2 1 2 0 0
2 2 2 0 0
2 2 0 1 0
************************
2 2 2 2 2
2 2 2 1 0
2 1 2 2 0
2 2 2 0 0
2 2 0 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 0
2 2 2 0 0
2 2 0 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 0
2 2 2 0 0
2 2 2 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 0
2 2 2 2 0
2 2 2 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 2
2 2 2 2 0
2 2 2 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 2
2 2 2 2 0
2 2 2 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 2
2 2 2 2 0
2 2 2 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 2
2 2 2 2 2
2 2 2 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 2
2 2 2 2 2
2 2 2 1 0
************************
2 2 2 2 2
2 2 2 1 2
2 1 2 2 2
2 2 2 2 2
2 2 2 1 2
************************
(4,4)
(3,4)
(3,3)
(3,2)
(3,1)
(3,0)
(2,0)
(1,0)
(0,0)
请按任意键继续. . .

使用一个0-1矩阵来模拟一个迷宫，1表示障碍物，0表示通道。访问过的用2表示

要求从左上角入口进入迷宫，从右下角的出口走出迷宫，本题模拟出了寻找出口的过程，以后我会改进此程序，使其输出所有可行的路径

有些题目还要求只能向右或者向下走，那么只需要撤去本题中的向左和向上两种条件选择就行了。