// 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); }
// 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); }
// 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); }