题目描述：
转载自：https://blog.csdn.net/h1021456873/article/details/54572767
题意：
给你一个转轮，有5种颜色，为了5中颜色的位置是确定的，为了方便处理我们用01234来表示绿，黑，红，蓝，白。轮子可以沿着它的方向滚动（只能是它当前的方向不能相反方向），每滚动一次会到达另一个格子，着地的颜色会改变，变了之前颜色的下一个，例如当前是绿色着地下一次就是黑色，依次是红蓝白。也可以原地转动（顺逆时针都可以），原地转动其实就是改变了轮子的滚动方向，原地转动每次能转90度。原地转动一次和滚动一次时间都是1秒。另外轮子有4个方向，上北下南左西又东。
思路: 开一个四维数组标记状态 f【x】【y】【d】【c】 在（x，y）点，方向为d，车轮的颜色为c的状态是否被标记过， 这个数组其实就是用来剪枝，避免陷入死循环！！！！
1 #include<iostream> 2 #include<cstdio> 3 #include<cstring> 4 #include<algorithm> 5 #include<cmath> 6 #include<queue> 7 using namespace std; 8 const int N = 33; 9 char s[N][N]; 10 struct node 11 { 12 int x,y,d,c,time; 13 }; 14 queue<node>que; 15 int f[N][N][10][10]; 16 int n,m; 17 int dx[4]={0,-1,0,1},dy[4]={-1,0,1,0}; 18 node e; 19 int bfs() 20 { 21 int i,j,x,y,d,c; 22 while(!que.empty()){ 23 node t = que.front(); 24 que.pop(); 25 if(t.x==e.x && t.y==e.y && t.c==0) return t.time; 26 ////////先考虑转向///////////////////// 27 c=t.c; 28 d=(t.d+1)%4; 29 if(!f[t.x][t.y][d][c]){ 30 f[t.x][t.y][d][c]++; 31 que.push((node){t.x,t.y,d,c,t.time+1}); 32 // printf("%d %d %d %d %d\n",t.x,t.y,d,c,t.time+1); 33 } 34 d=(t.d-1+4)%4; 35 if(!f[t.x][t.y][d][c]) { 36 f[t.x][t.y][d][c]++; 37 que.push((node){t.x,t.y,d,c,t.time+1}); 38 // printf("%d %d %d %d %d\n",t.x,t.y,d,c,t.time+1); 39 } 40 ////////考虑向前走//////////////////// 41 c=(t.c+1)%5; 42 x=t.x+dx[t.d],y=t.y+dy[t.d],d=t.d; 43 if(x<0||x>=n||y<0||y>=m||s[x][y]=='#') continue; 44 if(f[x][y][d][c]) continue; 45 f[x][y][d][c]++; 46 que.push((node){x,y,d,c,t.time+1}); 47 // printf("%d %d %d %d %d\n",x,y,d,c,t.time+1); 48 } 49 return -1; 50 } 51 52 int main() 53 { 54 node start; 55 int i,j,T=0; 56 while(scanf("%d%d",&n,&m)!=EOF) { 57 if(n==0 && m==0) break; 58 if(T) printf("\n"); 59 T++; 60 while(!que.empty()) que.pop(); 61 memset(f,0,sizeof(f)); 62 for(i=0;i<n;i++) { 63 scanf("%s",s[i]); 64 for(j=0;j<m;j++) { 65 if(s[i][j]=='S') start.x=i,start.y=j; 66 if(s[i][j]=='T') e.x=i,e.y=j; 67 } 68 } 69 start.d=1,start.c=0,start.time=0; 70 f[start.x][start.y][start.d][start.c]=1; 71 que.push(start); 72 int ans=bfs(); 73 printf("Case #%d\n",T); 74 if(ans<0) printf("destination not reachable\n"); 75 else printf("minimum time = %d sec\n",ans); 76 } 77 return 0; 78 }