UVa 816 (BFS求最短路)

/*816 - Abbott's Revenge
---代码完全参考刘汝佳算法入门经典
---strchr() 用来查找某字符在字符串中首次出现的位置，其原型为：char * strchr (const char *str, int c)
---BFS求最短路
--*/
#define _CRT_SECURE_NO_DEPRECATE
#include<iostream>
#include<string.h>
#include<queue>
#include<algorithm>
using namespace std;
const int maxn = 10;
struct Node{
int r, c, dir;
Node(int a=0, int b=0, int c=0) :r(a), c(b), dir(c){}
};

int dis[maxn][maxn][4];//dis[r][c][dir]保存状态(r,c,dir)到初始状态的距离
int id[256];
Node path[maxn][maxn][4]; //path[r][c][dir]保存了状态(r,c,dir)在BFS树中的父节点
int has[maxn][maxn][4][3];//has[r][c][dir][turn]，表示当前处在(r,c,dir)状态是否可以向turn转弯
int r0, c0, r1, c1, r2, c2, dir;

const int dr[] = { -1, 0, 1, 0 };
const int dc[] = { 0, 1, 0, -1 };

//计算出下一个节点
Node walk(Node&u, int turn){
//首先计算出下一步的朝向
int dir = u.dir;
if (turn == 1)dir = (dir + 3) % 4; //左转，逆时针
if (turn == 2)dir = (dir + 1) % 4;//右转，顺时针
return Node(u.r + dr[dir], u.c + dc[dir], dir);
}
bool insid(int r, int c){
return r >= 1 && c >= 1 && r <= 9 && c <= 9;
}

void print_ans(Node u){
vector<Node>vec;
while (dis[u.r][u.c][u.dir] != 0){
vec.push_back(u);
u = path[u.r][u.c][u.dir];
}
vec.push_back(u);
vec.push_back(Node(r0, c0, dir));
int cnt = 0;
printf("  ");
for (int i = vec.size() - 1; i >= 0; i--,cnt++){
if (cnt){
if (cnt% 10 == 0)printf("\n  ");
else printf(" ");
}
printf("(%d,%d)", vec[i].r, vec[i].c);
}
printf("\n");
}

void bfs(){
queue<Node>Q;
Node u(r1, c1, dir);
Q.push(u);
memset(dis, -1, sizeof(dis));
dis[r1][c1][dir] = 0;
while (!Q.empty()){
u = Q.front(); Q.pop();
if (u.r == r2&&u.c == c2){ print_ans(u); return; }
for (int i = 0; i < 3; i++){
Node v = walk(u, i);
if (has[u.r][u.c][u.dir][i] && insid(v.r, v.c) && dis[v.r][v.c][v.dir] < 0){
path[v.r][v.c][v.dir] = u;
dis[v.r][v.c][v.dir] = dis[u.r][u.c][u.dir] + 1;
Q.push(v);
}
}
}
printf("  No Solution Possible\n");
}
int main(){
//01234代表NESW，顺时针方向
id['N'] = 0;
id['E'] = 1;
id['S'] = 2;
id['W'] = 3;
//012代表转向
id['F'] = 0;
id['L'] = 1;
id['R'] = 2;
char s1[21], s2[21];
while (scanf("%s", s1)&&strcmp(s1,"END")){
printf("%s\n", s1);
scanf("%d%d%s%d%d", &r0, &c0, s2, &r2, &c2);
dir = id[s2[0]];
r1 = r0 + dr[dir];
c1 = c0 + dc[dir];
memset(has, 0, sizeof(has));
int r, c;
while (scanf("%d", &r) && r){
scanf("%d", &c);
while (scanf("%s", s1) && strcmp(s1, "*")){
for (int i = 1; i < strlen(s1); i++){
has[r][c][id[s1[0]]][id[s1[i]]] = 1;
}
}
}
bfs();
}
return 0;
}