我应该只用C编写一个程序。这是网格追随者的代码。
我已经定义了网格的坐标系(0-5,0-5)。还定义了机器人方向(+y、-y、+x、-x)和位置。(我欢迎有关如何为此编写好的代码的提示。)
现在,当我的机器人穿过网格并通过某个路径到达网格中的某个坐标 (x,y) 时。只允许 90 度和 180 度转弯。
我怎样才能到达(0,0),即起点,穿越相同的路径?如何使用 C 代码反转方向并给出适当的转动指令?
我应该只用C编写一个程序。这是网格追随者的代码。
我已经定义了网格的坐标系(0-5,0-5)。还定义了机器人方向(+y、-y、+x、-x)和位置。(我欢迎有关如何为此编写好的代码的提示。)
现在,当我的机器人穿过网格并通过某个路径到达网格中的某个坐标 (x,y) 时。只允许 90 度和 180 度转弯。
我怎样才能到达(0,0),即起点,穿越相同的路径?如何使用 C 代码反转方向并给出适当的转动指令?
这可以清理很多,但它应该是一个很好的框架来理解这些概念。我们基本上所做的只是保存每一步,然后简单地回溯它。
#include <stdio.h>
#define MAX_STEPS 256
enum CARDINAL_DIRECTIONS { N = 0, W, S, E };
struct _s_robot {
int x;
int y;
int orientation;
int step;
int x_history[MAX_STEPS];
int y_history[MAX_STEPS];
int turn_history[MAX_STEPS];
} MY_LITTLE_ROBOT = {0, 0, 0, 0, {0}, {0}, {0}};
void robot_go() {
switch(MY_LITTLE_ROBOT.orientation) {
case N:
++MY_LITTLE_ROBOT.y;
break;
case W:
--MY_LITTLE_ROBOT.x;
break;
case S:
--MY_LITTLE_ROBOT.y;
break;
case E:
++MY_LITTLE_ROBOT.x;
break;
}
MY_LITTLE_ROBOT.x_history[MY_LITTLE_ROBOT.step] = MY_LITTLE_ROBOT.x;
MY_LITTLE_ROBOT.y_history[MY_LITTLE_ROBOT.step] = MY_LITTLE_ROBOT.y;
MY_LITTLE_ROBOT.turn_history[MY_LITTLE_ROBOT.step] = MY_LITTLE_ROBOT.orientation;
++MY_LITTLE_ROBOT.step;
}
void robot_change_orientation(int _orientation) {
MY_LITTLE_ROBOT.orientation = _orientation;
}
void robot_reverse_orientation(int _orientation) {
if (_orientation == N) MY_LITTLE_ROBOT.orientation = S;
else if (_orientation == W) MY_LITTLE_ROBOT.orientation = E;
else if (_orientation == S) MY_LITTLE_ROBOT.orientation = N;
else if (_orientation == E) MY_LITTLE_ROBOT.orientation = W;
}
void robot_backtrack() {
int i;
printf("MY_LITTLE_ROBOT wants to turn around, currently at: %i, %i\n", MY_LITTLE_ROBOT.x, MY_LITTLE_ROBOT.y);
robot_reverse_orientation(MY_LITTLE_ROBOT.orientation);
for (i = MY_LITTLE_ROBOT.step-1; i >= 0; --i) {
printf("Robot is @ %i, %i, with an orientation of: %i \n", MY_LITTLE_ROBOT.x, MY_LITTLE_ROBOT.y, MY_LITTLE_ROBOT.orientation );
robot_reverse_orientation(MY_LITTLE_ROBOT.turn_history[i]);
robot_go();
}
}
void dump_history() {
int i;
for (i = MY_LITTLE_ROBOT.step-1; i >= 0; --i) {
printf("Robot is @ %i, %i, with an orientation of: %i \n", MY_LITTLE_ROBOT.x_history[i], MY_LITTLE_ROBOT.y_history[i], MY_LITTLE_ROBOT.turn_history[i] );
}
}
int main() {
printf("***START: Robot is @ %i, %i\n", MY_LITTLE_ROBOT.x, MY_LITTLE_ROBOT.y);
robot_go();
robot_go();
robot_go();
robot_change_orientation(S);
robot_go();
robot_go();
robot_change_orientation(W);
robot_go();
robot_go();
robot_go();
robot_change_orientation(N);
robot_go();
dump_history();
robot_backtrack();
printf("***FINISH: Robot is @ %i, %i\n", MY_LITTLE_ROBOT.x, MY_LITTLE_ROBOT.y);
return 0;
}
要一遍又一遍地使用机器人,您可能必须在回溯后重置所有旅行历史,这应该有点微不足道。为了冗长和简单,我特意避免了malloc
s 和其他使程序真正有用的令人困惑的方面。希望它有所帮助。
我还假设您不想要真正的寻路算法(例如 A*),因为那是完全不同的球赛。