コード例 #1
0
ファイル: control_guided.cpp プロジェクト: xrj3000/ardupilot
// guided_set_velocity - sets guided mode's target velocity
void Sub::guided_set_velocity(const Vector3f& velocity)
{
    // check we are in velocity control mode
    if (guided_mode != Guided_Velocity) {
        guided_vel_control_start();
    }

    vel_update_time_ms = AP_HAL::millis();

    // set position controller velocity target
    pos_control.set_desired_velocity(velocity);
}
コード例 #2
0
ファイル: control_guided.cpp プロジェクト: ArmaJo/ardupilot
// guided_set_velocity - sets guided mode's target velocity
void Copter::guided_set_velocity(const Vector3f& velocity)
{
    // check we are in velocity control mode
    if (guided_mode != Guided_Velocity) {
        guided_vel_control_start();
    }

    // record velocity target
    guided_vel_target_cms = velocity;
    vel_update_time_ms = millis();

    // log target
    Log_Write_GuidedTarget(guided_mode, Vector3f(), velocity);
}
コード例 #3
0
ファイル: control_guided.cpp プロジェクト: 10man/ardupilot
// guided_set_velocity - sets guided mode's target velocity
void Copter::guided_set_velocity(const Vector3f& velocity)
{
    // check we are in velocity control mode
    if (guided_mode != Guided_Velocity) {
        guided_vel_control_start();
    }

    vel_update_time_ms = millis();

    // set position controller velocity target
    pos_control.set_desired_velocity(velocity);

    // log target
    Log_Write_GuidedTarget(guided_mode, Vector3f(), velocity);
}