2

特定の方向で特定の座標に移動するように、差動駆動移動ロボット (e-puck) をプログラミングしています。ロボットは座標に問題なく到達しますが、座標に到達すると、特定の方向に落ち着くことができず、方向を探してその場で「回転」し続けます。これについて以前に経験したことのある人はいますか? 私はこの問題で非常に長い間立ち往生しており、誰かがその理由を知っていることを本当に願っています. コードの関連部分を以下に貼り付けます。

static void step() {
    if (wb_robot_step(TIME_STEP)==-1) {
        wb_robot_cleanup();
        exit(EXIT_SUCCESS);
    }
} 
.
.
.
.
.
static void set_speed(int l, int r)
{
    speed[LEFT] = l;
    speed[RIGHT] = r;

    if (pspeed[LEFT] != speed[LEFT] || pspeed[RIGHT] != speed[RIGHT]) {
        wb_differential_wheels_set_speed(speed[LEFT], speed[RIGHT]);
    }
}
.
.
.
.
static void goto_position1(float x, float y, float theta)
{
    if (VERBOSE > 0) printf("Going to (%f, %f, %f)\n",x,y,theta);

    // Set a target position
    odometry_goto_set_goal(&og, x, y, theta);

    // Move until the robot is close enough to the target position
    while (og.result.atgoal == 0) {
        // Update position and calculate new speeds
        odometry_track_step(og.track);
        odometry_goto_step(&og);

        // Set the wheel speed
        set_speed(og.result.speed_left, og.result.speed_right);

        printf("%f",ot.result.theta);
        print_position();

        step();
    } //after exiting while loop speed will be zero

    og.result.speed_left = 0;
    og.result.speed_right = 0;
    if (((og.result.speed_left == 0) && (og.result.speed_right == 0)) )  
        og.result.atgoal = 1;

    return;
}
.
.
.
int main(){
    //initialisation

    while (wb_robot_step(TIME_STEP) != -1) {
        goto_position1(0.0000000001,0.00000000001,PI/4);
    }
    return 0;
}
4

2 に答える 2

0

私は最終的に何が間違っているのかを突き止めました。これは、while ループから抜け出せず、ロボットが向きの検索を停止できないためです。インスピレーションをありがとう。

于 2013-11-04T17:50:59.563 に答える
0

私はあなたの構造体の内容が何であるかを知るog利点がないので、現在の位置情報を提供するメンバーがあると仮定すると (私はそれらがposx&であると仮定しposyます)、最新のものを読んだ直後にテストステートメントを持つべきです位置、次のようなもの:

[編集] set_speed() の再配置

while (og.result.atgoal == 0) 
{
    // Update position and calculate new speeds
    odometry_track_step(og.track);
    odometry_goto_step(&og);

    if(((og.result.posx - x) > 3) || (og.result.posy - y) > 3)    //(distance assumed in mm)
    {
       //then report position, continue to make adjustments and navigate
        printf("%f",ot.result.theta);
        print_position();
        // Set the wheel speed
        set_speed(og.result.speed_left, og.result.speed_right);
        step();

    }
    else
    {
            //set all speeds to 0
            //report position.          
            //clear appropriate struct members and leave loop
    }

} //after exiting while loop speed will be zero
于 2013-11-04T15:21:03.580 に答える