迷宫的最短路径

/*
虽然在网上找不到题目，但这题实在是太经典了，好多搜索题目都是从它变形来的

从S走到G，'#'不能走
测试数据

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

*/
#include<stdio.h>
#include<iostream>
#include<queue>
using namespace std;
const int INF=100000000;
#define MAX_N 105
#define MAX_M 105
//使用pair表示状态时，使用typedef会更加方便一些
typedef pair<int,int> P;

char maze[MAX_N][MAX_M+1];	//表示迷宫的数组   M+1存储'\0'
int N,M;
int sx,sy;	//起点坐标
int gx,gy;	//终点坐标

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

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

//求从(sx,sy)到(gx,gy)的最短距离
//如果无法到达，则是INF
int bfs() {
	queue<P> que;
	//把所有位置都初始化为INF
	int i,j;
	for(i=0;i<N;i++) {
		for(j=0;j<M;j++) d[i][j]=INF;
	}
	//将起点加入队列，并把这一地点的距离设置为0
	que.push(P(sx,sy));
	d[sx][sy]=0;

	//不断循环直到队列的长度为0
	while(que.size()) {
		//从队列的最前端取出元素
		P p=que.front();que.pop();
		//如果取出的状态已经是终点，则结束搜索
		if (p.first==gx && p.second ==gy) break;

		//四个方向的循环
		for(i=0;i<4;i++) {
			//移动之后位置记为nx,ny
			int nx=p.first + dx[i],ny = p.second+dy[i];
			//判断是否可以移动以及是否已经访问过(d[nx][ny]!=INF即为已经访问过)
			if (0<=nx && nx<N && 0 <= ny && ny <M && maze[nx][ny]!='#' && d[nx][ny]==INF) {
				//可以移动的话，则加入到队列，并且到该位置的距离确定为到p的距离为+1
				que.push(P(nx,ny));
				d[nx][ny]=d[p.first][p.second]+1;
			}
		}
	}
	return d[gx][gy];
}

void solve() {
	int res=bfs();
	printf("%d\n",res);
}
int main() {
#ifndef ONLINE_JUDGE
	freopen("in.txt","r",stdin);
#endif
	while(scanf("%d%d",&N,&M)!=EOF) {
		int i,j;
		for(i=0;i<N;i++) {
			scanf("%s",maze[i]);
		}
		for(i=0;i<N;i++) {
			for(j=0;j<M;j++) {
				if (maze[i][j]=='S') sx=i,sy=j;
				if (maze[i][j]=='G') gx=i,gy=j;
			}
		}
		solve();
	}
	return 0;
}