Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
guidance_indi_hybrid.c File Reference

A guidance mode based on Incremental Nonlinear Dynamic Inversion Come to IROS2016 to learn more! More...

Include dependency graph for guidance_indi_hybrid.c:

Go to the source code of this file.

Macros

#define GUIDANCE_INDI_SPEED_GAIN   1.8
#define GUIDANCE_INDI_SPEED_GAINZ   1.8
#define GUIDANCE_INDI_POS_GAIN   0.5
#define GUIDANCE_INDI_POS_GAINZ   0.5
#define GUIDANCE_INDI_LIFTD_ASQ   0.20
#define GUIDANCE_INDI_MAX_PUSHER_INCREMENT   MAX_PPRZ
#define GUIDANCE_INDI_LIFTD_P80   (GUIDANCE_INDI_LIFTD_ASQ*12*12)
#define GUIDANCE_INDI_LIFTD_P50   (GUIDANCE_INDI_LIFTD_P80/2)
#define GUIDANCE_INDI_MIN_AIRSPEED   -10.f
#define GUIDANCE_INDI_FWD_CLIMB_SPEED   4.0
 Climb speed when navigation is making turns instead of direct lines.
#define GUIDANCE_INDI_FWD_DESCEND_SPEED   -4.0
 Descend speed when navigation is making turns instead of direct lines.
#define GUIDANCE_INDI_QUAD_CLIMB_SPEED   2.0
 Climb speed when navigation is doing direct lines.
#define GUIDANCE_INDI_QUAD_DESCEND_SPEED   -2.0
 Descend speed when navigation is doing direct lines.
#define GUIDANCE_INDI_WLS_PRIORITIES   { 100.f, 100.f, 1.f }
#define GUIDANCE_INDI_WLS_WU   {[0 ... GUIDANCE_INDI_HYBRID_U - 1] = 1.0}
#define GUIDANCE_INDI_ZERO_AIRSPEED   FALSE
#define TURN_AIRSPEED_TH   13.0
#define GUIDANCE_INDI_FILTER_CUTOFF   3.0
#define GUIDANCE_INDI_AIRSPEED_FILT_CUTOFF   0.5
#define GUIDANCE_INDI_MAX_LAT_ACCEL   9.81
#define GUIDANCE_INDI_COORDINATED_TURN_MIN_AIRSPEED   10.0
#define GUIDANCE_INDI_COORDINATED_TURN_MAX_AIRSPEED   30.0
#define GUIDANCE_INDI_COORDINATED_TURN_AIRSPEED_MARGIN   0.0
#define GUIDANCE_INDI_VEL_SP_ID   ABI_BROADCAST

Functions

static void vel_sp_cb (uint8_t sender_id, struct FloatVect3 *vel_sp)
 ABI callback that obtains the velocity setpoint from a module.
static void guidance_indi_init_filters (struct FloatEulers *eulers)
 Initialized low pass filters.
static void guidance_indi_propagate_filters (void)
 Low pass the accelerometer measurements to remove noise from vibrations.
static void send_eff_mat_guid_indi_hybrid (struct transport_tx *trans, struct link_device *dev)
static void send_guidance_indi_hybrid (struct transport_tx *trans, struct link_device *dev)
void guidance_indi_init (void)
 Init function.
void guidance_indi_enter (void)
 Call upon entering indi guidance.
void guidance_set_min_max_airspeed (float min_airspeed, float max_airspeed)
void guidance_set_max_bank_angle (float max_bank)
void guidance_set_max_climb_speed (float max_climb_speed_quad, float max_climb_speed_fwd)
void guidance_set_max_descend_speed (float max_descend_speed_quad, float max_descend_speed_fwd)
struct StabilizationSetpoint guidance_indi_run (struct FloatVect3 *accel_sp, float heading_sp)
static struct FloatVect3 compute_accel_from_speed_sp (struct FloatVect3 *speed_sp)
static float bound_vz_sp (float vz_sp)
struct FloatVect3 WEAK guidance_indi_controller (bool in_flight UNUSED, struct HorizontalGuidance *gh, struct VerticalGuidance *gv, enum GuidanceIndiHybrid_HMode h_mode, enum GuidanceIndiHybrid_VMode v_mode)
struct StabilizationSetpoint guidance_indi_run_mode (bool in_flight UNUSED, struct HorizontalGuidance *gh, struct VerticalGuidance *gv, enum GuidanceIndiHybrid_HMode h_mode, enum GuidanceIndiHybrid_VMode v_mode)
float WEAK guidance_indi_get_liftd (float airspeed, float theta)
 Get the derivative of lift w.r.t.

Variables

struct guidance_indi_hybrid_params gih_params
float guidance_indi_pitch_pref_deg = 0
bool take_heading_control = false
bool force_forward = false
 forward flight for hybrid nav
bool guidance_indi_airspeed_filtering = false
struct FloatVect3 sp_accel = {0.0,0.0,0.0}
float inv_eff [4]
float guidance_indi_max_bank = GUIDANCE_H_MAX_BANK
float guidance_indi_min_pitch = GUIDANCE_INDI_MIN_PITCH
float gih_coordinated_turn_min_airspeed = GUIDANCE_INDI_COORDINATED_TURN_MIN_AIRSPEED
float gih_coordinated_turn_max_airspeed = GUIDANCE_INDI_COORDINATED_TURN_MAX_AIRSPEED + GUIDANCE_INDI_COORDINATED_TURN_AIRSPEED_MARGIN
bool coordinated_turn_use_accel = false
struct FloatEulers eulers_zxy
 state eulers in zxy order
struct Butterworth2LowPassVect3 filt_accel_ned
Butterworth2LowPass accely_filt
Butterworth2LowPass guidance_indi_airspeed_filt
QuatButterworthLowPass quat_filt
struct FloatVect2 desired_airspeed
float gi_unbounded_airspeed_sp = 0.f
float Ga [GUIDANCE_INDI_HYBRID_V][GUIDANCE_INDI_HYBRID_U]
struct FloatVect3 euler_cmd
float du_gih [GUIDANCE_INDI_HYBRID_U]
float v_gih [3]
float filter_cutoff = GUIDANCE_INDI_FILTER_CUTOFF
float guidance_indi_airspeed_filt_cutoff = GUIDANCE_INDI_AIRSPEED_FILT_CUTOFF
float guidance_indi_hybrid_heading_sp = 0.f
struct FloatEulers guidance_euler_cmd
struct ThrustSetpoint thrust_sp
float thrust_in
struct FloatVect3 gi_speed_sp = {0.0, 0.0, 0.0}
abi_event vel_sp_ev
struct FloatVect3 indi_vel_sp = {0.0, 0.0, 0.0}
float time_of_vel_sp = 0.0

Detailed Description

A guidance mode based on Incremental Nonlinear Dynamic Inversion Come to IROS2016 to learn more!

Definition in file guidance_indi_hybrid.c.

Macro Definition Documentation

◆ GUIDANCE_INDI_AIRSPEED_FILT_CUTOFF

#define GUIDANCE_INDI_AIRSPEED_FILT_CUTOFF   0.5

Definition at line 187 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_COORDINATED_TURN_AIRSPEED_MARGIN

#define GUIDANCE_INDI_COORDINATED_TURN_AIRSPEED_MARGIN   0.0

Definition at line 203 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_COORDINATED_TURN_MAX_AIRSPEED

#define GUIDANCE_INDI_COORDINATED_TURN_MAX_AIRSPEED   30.0

Definition at line 199 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_COORDINATED_TURN_MIN_AIRSPEED

#define GUIDANCE_INDI_COORDINATED_TURN_MIN_AIRSPEED   10.0

Definition at line 195 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_FILTER_CUTOFF

#define GUIDANCE_INDI_FILTER_CUTOFF   3.0

Definition at line 182 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_FWD_CLIMB_SPEED

#define GUIDANCE_INDI_FWD_CLIMB_SPEED   4.0

Climb speed when navigation is making turns instead of direct lines.

Definition at line 88 of file guidance_indi_hybrid.c.

Referenced by rotwing_state_periodic().

◆ GUIDANCE_INDI_FWD_DESCEND_SPEED

#define GUIDANCE_INDI_FWD_DESCEND_SPEED   -4.0

Descend speed when navigation is making turns instead of direct lines.

Definition at line 95 of file guidance_indi_hybrid.c.

Referenced by rotwing_state_periodic().

◆ GUIDANCE_INDI_LIFTD_ASQ

#define GUIDANCE_INDI_LIFTD_ASQ   0.20

Definition at line 60 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_LIFTD_P50

#define GUIDANCE_INDI_LIFTD_P50   (GUIDANCE_INDI_LIFTD_P80/2)

Definition at line 73 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_LIFTD_P80

#define GUIDANCE_INDI_LIFTD_P80   (GUIDANCE_INDI_LIFTD_ASQ*12*12)

Definition at line 72 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_MAX_LAT_ACCEL

#define GUIDANCE_INDI_MAX_LAT_ACCEL   9.81

Definition at line 191 of file guidance_indi_hybrid.c.

Referenced by compute_accel_from_speed_sp().

◆ GUIDANCE_INDI_MAX_PUSHER_INCREMENT

#define GUIDANCE_INDI_MAX_PUSHER_INCREMENT   MAX_PPRZ

Definition at line 64 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run().

◆ GUIDANCE_INDI_MIN_AIRSPEED

#define GUIDANCE_INDI_MIN_AIRSPEED   -10.f

Definition at line 81 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_POS_GAIN

#define GUIDANCE_INDI_POS_GAIN   0.5

Definition at line 55 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_POS_GAINZ

#define GUIDANCE_INDI_POS_GAINZ   0.5

Definition at line 56 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_QUAD_CLIMB_SPEED

#define GUIDANCE_INDI_QUAD_CLIMB_SPEED   2.0

Climb speed when navigation is doing direct lines.

Definition at line 102 of file guidance_indi_hybrid.c.

Referenced by rotwing_state_periodic().

◆ GUIDANCE_INDI_QUAD_DESCEND_SPEED

#define GUIDANCE_INDI_QUAD_DESCEND_SPEED   -2.0

Descend speed when navigation is doing direct lines.

Definition at line 109 of file guidance_indi_hybrid.c.

Referenced by rotwing_state_periodic().

◆ GUIDANCE_INDI_SPEED_GAIN

#define GUIDANCE_INDI_SPEED_GAIN   1.8

Definition at line 50 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_SPEED_GAINZ

#define GUIDANCE_INDI_SPEED_GAINZ   1.8

Definition at line 51 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_VEL_SP_ID

#define GUIDANCE_INDI_VEL_SP_ID   ABI_BROADCAST

Definition at line 288 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_init().

◆ GUIDANCE_INDI_WLS_PRIORITIES

#define GUIDANCE_INDI_WLS_PRIORITIES   { 100.f, 100.f, 1.f }

Definition at line 149 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_hybrid_set_wls_settings().

◆ GUIDANCE_INDI_WLS_WU

#define GUIDANCE_INDI_WLS_WU   {[0 ... GUIDANCE_INDI_HYBRID_U - 1] = 1.0}

Definition at line 154 of file guidance_indi_hybrid.c.

◆ GUIDANCE_INDI_ZERO_AIRSPEED

#define GUIDANCE_INDI_ZERO_AIRSPEED   FALSE

Definition at line 160 of file guidance_indi_hybrid.c.

◆ TURN_AIRSPEED_TH

#define TURN_AIRSPEED_TH   13.0

Definition at line 165 of file guidance_indi_hybrid.c.

Referenced by bound_vz_sp(), and compute_accel_from_speed_sp().

Function Documentation

◆ bound_vz_sp()

float bound_vz_sp ( float vz_sp)
static

Definition at line 712 of file guidance_indi_hybrid.c.

References gih_params, stateGetAirspeed_f(), and TURN_AIRSPEED_TH.

Referenced by guidance_indi_controller().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ compute_accel_from_speed_sp()

◆ guidance_indi_controller()

◆ guidance_indi_enter()

void guidance_indi_enter ( void )

Call upon entering indi guidance.

Definition at line 373 of file guidance_indi_hybrid.c.

References eulers_zxy, guidance_indi_hybrid_heading_sp, guidance_indi_init_filters(), nav, and stateGetNedToBodyEulersZxy_f().

Here is the call graph for this function:

◆ guidance_indi_get_liftd()

float WEAK guidance_indi_get_liftd ( float airspeed,
float theta )

Get the derivative of lift w.r.t.

pitch.

Parameters
airspeedThe airspeed says most about the flight condition
Returns
The derivative of lift w.r.t. pitch

Definition at line 871 of file guidance_indi_hybrid.c.

References gih_params.

Referenced by guidance_indi_calcg_wing(), and guidance_indi_calcg_wing().

Here is the caller graph for this function:

◆ guidance_indi_init()

void guidance_indi_init ( void )

◆ guidance_indi_init_filters()

void guidance_indi_init_filters ( struct FloatEulers * eulers)
static

◆ guidance_indi_propagate_filters()

void guidance_indi_propagate_filters ( void )
static

Low pass the accelerometer measurements to remove noise from vibrations.

The orientation needs to be filtered to synchronize with the acceleration. Called as a periodic function with PERIODIC_FREQ

Definition at line 835 of file guidance_indi_hybrid.c.

References ACCEL_FLOAT_OF_BFP, accely_filt, filt_accel_ned, guidance_indi_airspeed_filt, quat_filt, stateGetAccelBody_i(), stateGetAccelNed_f(), stateGetAirspeed_f(), stateGetNedToBodyQuat_f(), update_butterworth_2_low_pass(), update_butterworth_2_low_pass_vect3(), update_quat_butterworth_low_pass(), and FloatVect3::y.

Referenced by guidance_indi_run().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ guidance_indi_run()

struct StabilizationSetpoint guidance_indi_run ( struct FloatVect3 * accel_sp,
float heading_sp )
Parameters
accel_spaccel setpoint in NED frame [m/s^2]
heading_spthe desired heading [rad]
Returns
stabilization setpoint structure

main indi guidance function

Definition at line 409 of file guidance_indi_hybrid.c.

References accely_filt, du_gih, euler_cmd, eulers_zxy, filt_accel_ned, FLOAT_ANGLE_NORMALIZE, float_eulers_of_quat_zxy(), float_mat3_mult(), float_mat_inv_3d(), float_quat_normalize(), float_quat_of_eulers_zxy(), g1g2, Ga, Ga_inv, get_butterworth_2_low_pass_vect3(), gih_coordinated_turn_max_airspeed, gih_coordinated_turn_min_airspeed, guidance_euler_cmd, guidance_indi_calcg_wing(), guidance_indi_hybrid_heading_sp, guidance_indi_hybrid_set_wls_settings(), guidance_indi_max_bank, GUIDANCE_INDI_MAX_PITCH, GUIDANCE_INDI_MAX_PUSHER_INCREMENT, guidance_indi_min_pitch, guidance_indi_propagate_filters(), guidance_indi_run(), guidance_indi_specific_force_gain, heading, max_phi, MAX_PPRZ, FloatRates::p, FloatEulers::phi, FloatRates::q, quat_filt, FloatRates::r, sp_accel, stab_sp_from_quat_ff_rates_f(), stabilization, stabilization_attitude_get_heading_f(), stateGetAirspeed_f(), stateGetNedToBodyEulers_f(), stateGetNedToBodyEulersZxy_f(), take_heading_control, th_sp_from_incr_vect_f(), th_sp_from_thrust_i(), FloatEulers::theta, THRUST_AXIS_Z, thrust_filt, thrust_in, thrust_sp, thrust_vect, WLS_t::u, WLS_t::v, v_gih, VECT3_DIFF, wls_alloc(), FloatVect3::x, FloatVect3::y, and FloatVect3::z.

Referenced by guidance_indi_run_mode().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ guidance_indi_run_mode()

struct StabilizationSetpoint guidance_indi_run_mode ( bool in_flight UNUSED,
struct HorizontalGuidance * gh,
struct VerticalGuidance * gv,
enum GuidanceIndiHybrid_HMode h_mode,
enum GuidanceIndiHybrid_VMode v_mode )

◆ guidance_set_max_bank_angle()

void guidance_set_max_bank_angle ( float max_bank)

Definition at line 388 of file guidance_indi_hybrid.c.

References guidance_indi_max_bank, and max_bank.

Referenced by rotwing_state_periodic().

Here is the caller graph for this function:

◆ guidance_set_max_climb_speed()

void guidance_set_max_climb_speed ( float max_climb_speed_quad,
float max_climb_speed_fwd )

Definition at line 392 of file guidance_indi_hybrid.c.

References gih_params.

Referenced by rotwing_state_periodic().

Here is the caller graph for this function:

◆ guidance_set_max_descend_speed()

void guidance_set_max_descend_speed ( float max_descend_speed_quad,
float max_descend_speed_fwd )

Definition at line 397 of file guidance_indi_hybrid.c.

References gih_params.

Referenced by rotwing_state_periodic().

Here is the caller graph for this function:

◆ guidance_set_min_max_airspeed()

void guidance_set_min_max_airspeed ( float min_airspeed,
float max_airspeed )

Definition at line 383 of file guidance_indi_hybrid.c.

References gih_params, and max_airspeed.

Referenced by rotwing_state_periodic().

Here is the caller graph for this function:

◆ send_eff_mat_guid_indi_hybrid()

void send_eff_mat_guid_indi_hybrid ( struct transport_tx * trans,
struct link_device * dev )
static

Definition at line 300 of file guidance_indi_hybrid.c.

References dev, and Ga.

Referenced by guidance_indi_init().

Here is the caller graph for this function:

◆ send_guidance_indi_hybrid()

void send_guidance_indi_hybrid ( struct transport_tx * trans,
struct link_device * dev )
static

Definition at line 307 of file guidance_indi_hybrid.c.

References dev, euler_cmd, filt_accel_ned, get_butterworth_2_low_pass_vect3(), gi_speed_sp, sp_accel, FloatVect3::x, FloatVect3::y, and FloatVect3::z.

Referenced by guidance_indi_init().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ vel_sp_cb()

void vel_sp_cb ( uint8_t sender_id,
struct FloatVect3 * vel_sp )
static

ABI callback that obtains the velocity setpoint from a module.

Definition at line 903 of file guidance_indi_hybrid.c.

References get_sys_time_float(), indi_vel_sp, time_of_vel_sp, FloatVect3::x, FloatVect3::y, and FloatVect3::z.

Referenced by guidance_indi_init().

Here is the call graph for this function:
Here is the caller graph for this function:

Variable Documentation

◆ accely_filt

◆ coordinated_turn_use_accel

bool coordinated_turn_use_accel = false

Definition at line 220 of file guidance_indi_hybrid.c.

◆ desired_airspeed

struct FloatVect2 desired_airspeed

Definition at line 247 of file guidance_indi_hybrid.c.

Referenced by compute_accel_from_speed_sp().

◆ du_gih

float du_gih[GUIDANCE_INDI_HYBRID_U]

Definition at line 253 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run().

◆ euler_cmd

struct FloatVect3 euler_cmd

Definition at line 251 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run(), and send_guidance_indi_hybrid().

◆ eulers_zxy

◆ filt_accel_ned

struct Butterworth2LowPassVect3 filt_accel_ned

Definition at line 225 of file guidance_indi_hybrid.c.

◆ filter_cutoff

float filter_cutoff = GUIDANCE_INDI_FILTER_CUTOFF

Definition at line 277 of file guidance_indi_hybrid.c.

◆ force_forward

bool force_forward = false

forward flight for hybrid nav

Definition at line 171 of file guidance_indi_hybrid.c.

Referenced by compute_accel_from_speed_sp(), nav_hybrid_circle(), nav_hybrid_goto(), nav_hybrid_route(), and reshape_wind().

◆ Ga

float Ga[GUIDANCE_INDI_HYBRID_V][GUIDANCE_INDI_HYBRID_U]

Definition at line 250 of file guidance_indi_hybrid.c.

◆ gi_speed_sp

struct FloatVect3 gi_speed_sp = {0.0, 0.0, 0.0}

◆ gi_unbounded_airspeed_sp

float gi_unbounded_airspeed_sp = 0.f

◆ gih_coordinated_turn_max_airspeed

Definition at line 217 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run().

◆ gih_coordinated_turn_min_airspeed

float gih_coordinated_turn_min_airspeed = GUIDANCE_INDI_COORDINATED_TURN_MIN_AIRSPEED

Definition at line 216 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run().

◆ gih_params

struct guidance_indi_hybrid_params gih_params
Initial value:
= {
.speed_gain = GUIDANCE_INDI_SPEED_GAIN,
.speed_gainz = GUIDANCE_INDI_SPEED_GAINZ,
.heading_bank_gain = GUIDANCE_INDI_HEADING_BANK_GAIN,
.liftd_asq = GUIDANCE_INDI_LIFTD_ASQ,
.min_airspeed = GUIDANCE_INDI_MIN_AIRSPEED,
.max_airspeed = GUIDANCE_INDI_MAX_AIRSPEED,
.stall_protect_gain = 1.5,
.climb_vspeed_fwd = GUIDANCE_INDI_FWD_CLIMB_SPEED,
.descend_vspeed_fwd = GUIDANCE_INDI_FWD_DESCEND_SPEED,
.climb_vspeed_quad = GUIDANCE_INDI_QUAD_CLIMB_SPEED,
.descend_vspeed_quad = GUIDANCE_INDI_QUAD_DESCEND_SPEED,
}
#define GUIDANCE_INDI_QUAD_DESCEND_SPEED
Descend speed when navigation is doing direct lines.
#define GUIDANCE_INDI_SPEED_GAINZ
#define GUIDANCE_INDI_MIN_AIRSPEED
#define GUIDANCE_INDI_FWD_DESCEND_SPEED
Descend speed when navigation is making turns instead of direct lines.
#define GUIDANCE_INDI_LIFTD_ASQ
#define GUIDANCE_INDI_QUAD_CLIMB_SPEED
Climb speed when navigation is doing direct lines.
#define GUIDANCE_INDI_POS_GAIN
#define GUIDANCE_INDI_FWD_CLIMB_SPEED
Climb speed when navigation is making turns instead of direct lines.
#define GUIDANCE_INDI_LIFTD_P50
#define GUIDANCE_INDI_POS_GAINZ
#define GUIDANCE_INDI_LIFTD_P80
#define GUIDANCE_INDI_SPEED_GAIN

Definition at line 112 of file guidance_indi_hybrid.c.

Referenced by bound_vz_sp(), compute_accel_from_speed_sp(), guidance_indi_controller(), guidance_indi_get_liftd(), guidance_set_max_climb_speed(), guidance_set_max_descend_speed(), and guidance_set_min_max_airspeed().

◆ guidance_euler_cmd

struct FloatEulers guidance_euler_cmd

Definition at line 281 of file guidance_indi_hybrid.c.

◆ guidance_indi_airspeed_filt

◆ guidance_indi_airspeed_filt_cutoff

float guidance_indi_airspeed_filt_cutoff = GUIDANCE_INDI_AIRSPEED_FILT_CUTOFF

Definition at line 278 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_init_filters().

◆ guidance_indi_airspeed_filtering

bool guidance_indi_airspeed_filtering = false

Definition at line 173 of file guidance_indi_hybrid.c.

Referenced by compute_accel_from_speed_sp().

◆ guidance_indi_hybrid_heading_sp

float guidance_indi_hybrid_heading_sp = 0.f

Definition at line 280 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_enter(), and guidance_indi_run().

◆ guidance_indi_max_bank

float guidance_indi_max_bank = GUIDANCE_H_MAX_BANK

Definition at line 209 of file guidance_indi_hybrid.c.

◆ guidance_indi_min_pitch

float guidance_indi_min_pitch = GUIDANCE_INDI_MIN_PITCH

Definition at line 210 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run().

◆ guidance_indi_pitch_pref_deg

float guidance_indi_pitch_pref_deg = 0

Definition at line 133 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_hybrid_set_wls_settings().

◆ indi_vel_sp

struct FloatVect3 indi_vel_sp = {0.0, 0.0, 0.0}

Definition at line 292 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run_mode(), and vel_sp_cb().

◆ inv_eff

float inv_eff[4]

Definition at line 206 of file guidance_indi_hybrid.c.

◆ quat_filt

Definition at line 228 of file guidance_indi_hybrid.c.

◆ sp_accel

struct FloatVect3 sp_accel = {0.0,0.0,0.0}

Definition at line 176 of file guidance_indi_hybrid.c.

◆ take_heading_control

bool take_heading_control = false

Definition at line 169 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run().

◆ thrust_in

float thrust_in

Definition at line 283 of file guidance_indi_hybrid.c.

◆ thrust_sp

struct ThrustSetpoint thrust_sp

Definition at line 282 of file guidance_indi_hybrid.c.

◆ time_of_vel_sp

float time_of_vel_sp = 0.0

Definition at line 293 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_run_mode(), and vel_sp_cb().

◆ v_gih

float v_gih[3]

Definition at line 274 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_calcg_wing(), and guidance_indi_run().

◆ vel_sp_ev

abi_event vel_sp_ev

Definition at line 290 of file guidance_indi_hybrid.c.

Referenced by guidance_indi_init().