机器人按照相反的顺序跟随网格

时间:2010-09-18 21:11:38

标签: c path-finding

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

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

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

如何到达(0,0),即起点,遍历同一条路径?如何使用C代码反转方向并给出适当的转向指令?

1 个答案:

答案 0 :(得分: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;
}

要反复使用机器人,您可能必须在回溯后重置所有旅行历史记录,这应该有点微不足道。我故意避免malloc和其他令人困惑的方面,使程序实际上有用,为了冗长和简单。希望它有所帮助。

我还假设你不想要一个真正的路径寻找算法(例如A *),因为这是一个完全不同的球赛。