独轮车广搜解法

独轮车的轮子上有红、黄、蓝、白、绿（依顺时针序）5种颜色，在一个如下图所示的20*20的迷宫内每走一个格子，轮子上的颜色变化一次。独轮车只能向前推或在原地转向。每走一格或原地转向90度均消耗一个单位时间。现给定一个起点（S）和一个终点（T），求独轮车以轮子上的指定颜色到达终点所需的最短时间。

输入：

本题包含一个测例。测例中分别用一个大写字母表示方向和轮子的颜色，其对应关系为：E-东、S-南、W-西、N-北；R-红、Y-黄、B-蓝、W-白、G-绿。在测试数据的第一行有以空格分隔的两个整数和两个大写字母，分别表示起点的坐标S（x,y）、轮子的颜色和开始的方向，第二行有以空格分隔的两个整数和一个大写字母，表示终点的坐标T（x,y）和到达终点时轮子的颜色，从第三行开始的20行每行内包含20个字符，表示迷宫的状态。其中'X'表示建筑物，'.'表示路.

输出：

在单独的一行内输出一个整数，即满足题目要求的最短时间。

代码

#include<iostream>
#include<queue>
using namespace std;
void init();
void input();
void bfs();
void move(int row,int col,int dire,int color);
queue<int> q1;
queue<int> q2;
queue<int> q3;
queue<int> q4;

char map1[20][20];
int map2[20][20][5][4];
int qx,qy,cx,cy;
char qcol,qdire;
char ccol;
int color1,color2,dire1;
int dr[4]={0,1,0,-1};
int dc[4]={1,0,-1,0};
int main()
{
 cin>>qx>>qy>>qcol>>qdire;
 cin>>cx>>cy>>ccol;
 input();
 init();
 bfs();
 return 0;
}
void init()
{
 if(qcol=='R')
 {
  color1=0;
 }
 if(qcol=='Y')
{
color1=1;
}
if(qcol=='B')
{
color1=2;
}
if(qcol=='W')
{
color1=3;
}
if(qcol=='G')
{
color1=4;
}
if(ccol=='R')
{
color2=0;
}
if(ccol=='Y')
{
color2=1;
}
if(ccol=='B')
{
color2=2;
}
if(ccol=='W')
{
color2=3;
}
if(ccol=='G')
{
color2=4;
}
if(qdire=='E')
{
dire1=0;
}
if(qdire=='S')
{
dire1=1;
}
if(qdire=='W')
{
dire1=2;
}
if(qdire=='N')
{
dire1=3;
}
qx--;
qy--;
cx--;
cy--;
q1.push(qx);
q2.push(qy);
q3.push(color1);
q4.push(dire1);
map2[qx][qy][color1][dire1]=0;
}
void bfs()
{
int row,col,dire,color;
while(!q1.empty())
{
row=q1.front();
q1.pop();
col=q2.front();
q2.pop();
color=q3.front();
q3.pop();
dire=q4.front();
q4.pop();
if(row==cx&&col==cy&&color==color2)
{
for(int i=0;i<4;i++)
{
if(map2[cx][cy][color2][i]!=0)
{
cout<<map2[cx][cy][color2][i]<<endl;
return;
}
}
}
else
{
move(row,col,dire,color);
}
}
}
void input()
{
for(int i=0;i<20;i++)
{
for(int j=0;j<20;j++)
{
cin>>map1[i][j];
}
}
}
void move(int row,int col,int dire,int color)
{
int row1,col1;
int dire2,dire3;
dire2=(dire+1)%4;
dire3=(dire+3)%4;
row1=row+dr[dire];
col1=col+dc[dire];
if(map2[row1][col1][(color+1)%5][dire]==0&&map1[row1][col1]=='.')
{
map2[row1][col1][(color+1)%5][dire]=map2[row][col][color][dire]+1;
q1.push(row1);
q2.push(col1);
q3.push((color+1)%5);
q4.push(dire);
}
if(map2[row][col][color][dire2]==0)
{
map2[row][col][color][dire2]=map2[row][col][color][dire]+1;
q1.push(row);
q2.push(col);
q3.push(color);
q4.push(dire2);
}
if(map2[row][col][color][dire3]==0)
{
map2[row][col][color][dire3]=map2[row][col][color][dire]+1;
q1.push(row);
q2.push(col);
q3.push(color);
q4.push(dire3);
}
}