P1126机器人是怎么搬重物的

P1126 机器人搬重物

1.首先输入的是格子图，需要转化成点图，具体操作是
2.最坑的一个点在于，平时写宽搜的时候，遇到出边界或者不能访问的点时，都是直接进入下一层循环(continue)，但在这道题中，由于可以走1~3步，那么当路径上出现障碍时，则不能进行下一轮循环，需要break。

代码：

#include <bits/stdc++.h>
#define MAX 55
using namespace std;

int mod(int x){
return (x+4)%4;
}

struct pt{
int x, y, dir, step;
pt(){}
pt(int a, int b, int c, int d):x(a), y(b), dir(c), step(d){}
};

const int movx[] = {0,1,0,-1}, movy[] = {1,0,-1,0};
int a[MAX][MAX];
bool vis[MAX][MAX][5];
int n, m;
pt st, ed;

void bfs(){
queue<pt> q;
bool flag = false;
st.step = 0;
q.push(st);
vis[st.x][st.y][st.dir] = true;
while(!q.empty()){
pt t = q.front();
q.pop();
if(t.x == ed.x && t.y == ed.y){
cout << t.step << endl;
flag = true;
break;
}
for(int i = 1; i <= 3; i++){
int u, v;
u = t.x + i*movx[t.dir];
v = t.y + i*movy[t.dir];
if(u<=0 || u>=n || v<=0 || v>=m || a[u][v] == 1){
break;
}
if(vis[u][v][t.dir]){
continue;
}
vis[u][v][t.dir] = true;
q.push(pt(u, v, t.dir, t.step+1));
}
if(!vis[t.x][t.y][mod(t.dir+1)]){
vis[t.x][t.y][mod(t.dir+1)] = true;
q.push(pt(t.x, t.y, mod(t.dir+1), t.step+1));
}
if(!vis[t.x][t.y][mod(t.dir-1)]){
vis[t.x][t.y][mod(t.dir-1)] = true;
q.push(pt(t.x, t.y, mod(t.dir-1), t.step+1));
}
}
if(!flag){
cout << -1 << endl;
}
}

int main()
{
cin >> n >> m;
for(int i = 1; i <= n; i++){
for(int j = 1; j <= m; j++){
scanf("%d", &a[i][j]);
if(a[i][j] == 1){
a[i-1][j-1] = a[i-1][j] = a[i][j-1] = 1;
}
}
}
cin >> st.x >> st.y >> ed.x >> ed.y;
char c;
cin >> c;
switch(c){
case 'E':
st.dir = 0; break;
case 'S':
st.dir = 1; break;
case 'W':
st.dir = 2; break;
case 'N':
st.dir = 3; break;
}
bfs();

return 0;
}