OJ题-营救公主

题目描述如下：

题面：
500年前，Jesse是我国最卓越的剑客。他英俊潇洒，而且机智过人^_^。
突然有一天，Jesse心爱的公主被魔王困在了一个巨大的迷宫中。Jesse听说这个消息已经是两天以后了，他知道公主在迷宫中还能坚持T天，他急忙赶到迷宫，开始到处寻找公主的下落。
时间一点一点的过去，Jesse还是无法找到公主。最后当他找到公主的时候，美丽的公主已经死了。从此Jesse郁郁寡欢，茶饭不思，一年后追随公主而去了。T_T
500年后的今天，Jesse托梦给你，希望你帮他判断一下当年他是否有机会在给定的时间内找到公主。

他会为你提供迷宫的地图以及所剩的时间T。请你判断他是否能救出心爱的公主。

Input
题目包括多组测试数据。
每组测试数据以三个整数N,M,T(0 < N,M <= 20)开头，
分别代表迷宫的长和高，以及公主能坚持的天数。
紧接着有M行，N列字符，由”.”，”*”，”P”，”S”组成。其中
“.” 代表能够行走的空地。
“*” 代表墙壁，Jesse不能从此通过。
“P” 是公主所在的位置。
“S” 是Jesse的起始位置。
每个时间段里Jesse只能选择“上、下、左、右”任意一方向走一步。
输入以0 0 0结束。

Output
如果能在规定时间内救出公主输出“YES”，否则输出“NO”。

Sample Input
4 4 10
....
....
....
S**P

Sample Output
YES

求解思路：采用广度优先搜索算法

代码如下：

#include "stdafx.h"
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#define MAXSIZE 20
typedef struct {
	int x;
	int y;
	int time;
}st_pos;

static int dir[][2] = { { 0, 1 }, { 1, 0 }, { -1, 0 }, { 0, -1 } };

/*
	广度优先搜索，用一个固定长度的数组实现队列的功能
*/
static int bfs(char *visited, st_pos start_pos, st_pos end_pos, int n, int m)
{
	int i = 0;
	int queue_length = 0;
	int queue_point_pos = 0;
	st_pos temp1_pos;
	st_pos temp2_pos;

	st_pos queue_pos[MAXSIZE * MAXSIZE];

	memset(&temp1_pos, 0, sizeof(st_pos));
	memset(&temp2_pos, 0, sizeof(st_pos));
	memset(queue_pos, 0, MAXSIZE * MAXSIZE *sizeof(st_pos));

	//加入队列
	queue_pos[0].x = start_pos.x;
	queue_pos[0].y = start_pos.y;
	queue_length++;
	while (queue_point_pos < queue_length)
	{
		//出队
		temp1_pos.x = queue_pos[queue_point_pos].x;
		temp1_pos.y = queue_pos[queue_point_pos].y;
		temp1_pos.time = queue_pos[queue_point_pos].time;
		queue_point_pos++;
		if (temp1_pos.x == end_pos.x && temp1_pos.y == end_pos.y)
			return temp1_pos.time;

		for (i = 0; i < 4; i++)
		{
			temp2_pos.x = temp1_pos.x + dir[i][0];
			temp2_pos.y = temp1_pos.y + dir[i][1];
			temp2_pos.time = temp1_pos.time;

			if (temp2_pos.x >= 0 && temp2_pos.x < m && temp2_pos.y >= 0 && temp2_pos.y < n
				&& visited[temp2_pos.x * n + temp2_pos.y] != '*'
				&& visited[temp2_pos.x * n + temp2_pos.y] != 'S')
			{
				visited[temp2_pos.x * n + temp2_pos.y] = '*';
				temp2_pos.time++;
				queue_pos[queue_length].x = temp2_pos.x;
				queue_pos[queue_length].y = temp2_pos.y;
				queue_pos[queue_length].time = temp2_pos.time;
				queue_length++;
			}

		}

	}
	return -1;
}
int _tmain(int argc, _TCHAR* argv[])
{
	char map[4][4] = { { '.', '.', '.', '.' }, { '.', '.', '.', '.' }, { '.', '.', '.', '.' }, { 'S', '*', '*', 'P' } };
	int m = 4;
	int n = 4;
	int t = 10;
	char *p = &map[0][0];
	st_pos start_pos;
	st_pos end_pos;
	int i = 0;
	int j = 0;
	memset(&start_pos, 0, sizeof(st_pos));
	memset(&end_pos, 0, sizeof(st_pos));

	for (i = 0; i < m; i++)
	{
		for (j = 0; j < n; j++)
		{
			if (map[i][j] == 'S')
			{
				start_pos.x = i;
				start_pos.y = j;
			}
			if (map[i][j] == 'P')
			{
				end_pos.x = i;
				end_pos.y = j;
			}
				
		}
	}
	printf("(%d,%d)-->(%d,%d)\n", start_pos.x, start_pos.y, end_pos.x, end_pos.y);
	int ret = bfs(p, start_pos, end_pos, n, m);
	printf("%d\n", ret);
	if (ret == -1 || ret > t)
		printf("NO");
	else
		printf("yes");
	system("pause");
	return 0;
}