bfs求最短路，递归打印最短路的具体路径；
难点：
当前状态和转弯方式很复杂，要仔细处理；
递归打印：用一个数组存储路径中结点的前一个节点，递归查找 （bfs无法确定下一个结点，但对于没一个结点，它的上一个结点是确定的！）
ps：输出因为太懒不想处理所以按书上打的；递归打印理解有点麻烦。。。
1 #include <iostream> 2 #include <cstring> 3 #include <algorithm> 4 #include <queue> 5 #include <vector> 6 #include <cstdio> 7 using namespace std; 8 9 struct node { 10 int x,y; 11 int w; 12 void init (int nx,int ny,int nw){ 13 x=nx; 14 y=ny; 15 w=nw; 16 } 17 }p[10][10][5]; 18 19 int visit[10][10][5]; 20 int map[10][10][4]; 21 int dir[4][3][2]={{-1,0,0,-1,0,1}, 22 {0,1,-1,0,1,0}, 23 {1,0,0,1,0,-1}, 24 {0,-1,1,0,-1,0} 25 }; 26 27 int id (char c){ 28 if (c=='N'||c=='F') 29 return 0; 30 else if (c=='E'||c=='L') 31 return 1; 32 else if (c=='S'||c=='R') 33 return 2; 34 else return 3; 35 } 36 node ans[1000]; 37 int tot; 38 int x0,y0,x1,y1,w1,sx,sy; 39 40 void print (int x,int y,int w); 41 42 int bfs (int x,int y,int w){ 43 queue<node> q; 44 while (!q.empty ()) 45 q.pop (); 46 node a,b; 47 a.init (x,y,w); 48 visit[a.x][a.y][a.w]=0; 49 q.push (a); 50 while (!q.empty ()){ 51 a=q.front ();//cout<<a.x<<" "<<a.y<<" "<<a.w<<endl; 52 q.pop (); 53 if (a.x==sx&&a.y==sy){ 54 print (a.x,a.y,a.w); 55 return 1; 56 } 57 int xx,yy,ww; 58 for (int i=0;i<3;i++){ 59 xx=a.x;yy=a.y;ww=a.w; 60 xx+=dir[a.w][i][0]; 61 yy+=dir[a.w][i][1]; 62 if (i==1) 63 ww=(ww+3)%4; 64 else if (i==2) 65 ww=(ww+1)%4; 66 b.init (xx,yy,ww); 67 if ((map[a.x][a.y][a.w]&(1<<i))){ 68 if (xx<1||xx>9||yy<1||yy>9) 69 continue ; 70 if (visit[xx][yy][ww]>=0) 71 continue ; 72 visit[xx][yy][ww]=visit[a.x][a.y][a.w]+1; 73 p[xx][yy][ww]=a; //存储路径中的父结点 74 q.push (b); 75 } 76 77 } 78 } 79 return 0; 80 } 81 82 void print (int x,int y,int w){ 83 vector<node> v; 84 node a,b; 85 a.init (x,y,w); 86 v.push_back (a); 87 while (visit[a.x][a.y][a.w]){ 88 a=p[a.x][a.y][a.w]; 89 v.push_back (a); 90 } 91 a.init (x0,y0,w1); 92 v.push_back (a); 93 94 int cnt=0; 95 for (int i=v.size()-1;i>=0;i--){ 96 if (cnt%10==0) cout<<" "; 97 cout<<" ("<<v[i].x<<","<<v[i].y<<")"; 98 if (++cnt%10==0) cout<<endl; 99 } 100 if (v.size()%10!=0) cout<<endl; 101 } 102 103 int main (){ 104 char s[30]; 105 while (cin>>s){ 106 if (strcmp (s,"END")==0) 107 break ; 108 tot=0; 109 memset (map,0,sizeof map); 110 memset (visit,-1,sizeof visit); 111 cout<<s<<endl; 112 char c; 113 cin>>x1>>y1>>c>>sx>>sy; 114 x0=x1;y0=y1; 115 w1=id (c); 116 x1+=dir[w1][0][0]; 117 y1+=dir[w1][0][1]; 118 int xx,yy; 119 while (cin>>xx&&xx){ 120 cin>>yy; 121 gets (s); 122 int i=1; 123 int j=id (s[1]); 124 while (s[i++]!='*'){//cout<<i<<" "<<s[i]; 125 if (s[i]==' '){ 126 j=id (s[++i]); 127 continue ; 128 } 129 map[xx][yy][j]^=(1<<id (s[i])); 130 } 131 //for (j=0;j<4;j++) 132 // cout<<map[xx][yy][j]<<endl; 133 }//cout<<xx<<endl; 134 if (!bfs (x1,y1,w1)) 135 cout<<" No Solution Possible"<<endl; 136 } 137 return 0; 138 }