0

我应该只用C编写一个程序。这是网格追随者的代码。

我已经定义了网格的坐标系(0-5,0-5)。还定义了机器人方向(+y、-y、+x、-x)和位置。(我欢迎有关如何为此编写好的代码的提示。)

现在,当我的机器人穿过网格并通过某个路径到达网格中的某个坐标 (x,y) 时。只允许 90 度和 180 度转弯。

我怎样才能到达(0,0),即起点,穿越相同的路径?如何使用 C 代码反转方向并给出适当的转动指令?

4

1 回答 1

2

这可以清理很多,但它应该是一个很好的框架来理解这些概念。我们基本上所做的只是保存每一步,然后简单地回溯它。

#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;
}

要一遍又一遍地使用机器人,您可能必须在回溯后重置所有旅行历史,这应该有点微不足道。为了冗长和简单,我特意避免了mallocs 和其他使程序真正有用的令人困惑的方面。希望它有所帮助。

我还假设您不想要真正的寻路算法(例如 A*),因为那是完全不同的球赛。

于 2010-09-18T22:29:05.657 回答