经典迷宫最短路问题

’#‘是墙，’S‘起点，’G‘终点，’.‘可走

input

 10 10
#S######.# 
......#..# 
.#.##.##.# 
.#........ 
##.##.#### 
....#....# 
.#######.# 
....#..... 
.####.###. 
....#...G# 

output 

22

#include <cstdio>
#include <utility>
#include <queue>
#include <cstring>
#define maxn 505
using namespace std;
const int INF = 10000000;
typedef pair<int,int> PA; 

//输入
char maze[maxn][maxn+1];	//迷宫字符串 
int n,m;				//行列 
int sx,sy;				//起点 
int gx,gy; 				//终点 

int d[maxn][maxn];		//到各个位置的最短距离数组

//4个方向移动的向量
int dx[4]={1,0,-1,0},dy[4]={0,1,0,-1};

//求从{sx,sy}到{gx,gy}的最短距离
//如果无法到达，则是INF
int bfs(){
	queue<PA> que;
	//memset(d,INF,sizeof(d));			//位置初始化为INF
	//不能用memset 
	 for (int i = 0; i < n; i++) 
    	for (int j = 0; j <m; j++) d[i][j] = INF;
	
	//将起点加入队列 ，并将这一地点的距离设置为0 
	que.push(PA(sx,sy));
	d[sx][sy]=0;
	
	//不断循环直到队列的长度为0
	while(que.size()){
		PA p=que.front();
		que.pop();
		//如果取出的状态已经是终点，则结束搜索
		if(p.first==gx&&p.second==gy) break; 
		
		//四个方向循环
		for(int i=0;i<4;i++){
			//移动之后的位置为(nx,ny)
			int nx=p.first+dx[i];
			int ny=p.second+dy[i];		
			
			//判断是否可以移动以及是否已经访问过（d=INF访问过） 
			if(nx>=0&&nx<n&&ny>=0&&ny<m&&maze[nx][ny]!='#'&&d[nx][ny]==INF){
				//可以移动的话加入到队列，并且到该位置的距离确定为到p的距离+1
				que.push(PA(nx,ny));
				d[nx][ny]=d[p.first][p.second]+1; 
			} 
		}
	}
	return d[gx][gy];	
} 
 
int main(){
	freopen("migong.txt","r",stdin);
	scanf("%d%d",&n,&m);
	for(int i=0;i<n;i++){
		scanf("%s",maze[i]);
	}
	for(int i=0;i<n;i++){
		for(int j=0;j<m;j++)
			if(maze[i][j]=='S'){
				sx=i,sy=j;
			}
			else if(maze[i][j]=='G'){
				gx=i;gy=j;
			}
	}
	printf("%d\n",bfs());
}