//迷宮問題---廣度優先搜尋-----佇列
#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表示

要求從左上角入口進入迷宮，從右下角的出口走出迷宮，本題模擬出了尋找出口的過程，以後我會改進此程式，使其輸出所有可行的路徑

有些題目還要求只能向右或者向下走，那麼只需要撤去本題中的向左和向上兩種條件選擇就行了。