|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
A guidance mode based on Incremental Nonlinear Dynamic Inversion Come to ICRA2016 to learn more! More...
#include "std.h"#include "math/pprz_algebra_int.h"#include "math/pprz_algebra_float.h"#include "filters/low_pass_filter.h"#include "filters/quaternion_filter.h"#include "firmwares/rotorcraft/guidance.h"#include "firmwares/rotorcraft/stabilization.h"Go to the source code of this file.
Data Structures | |
| struct | guidance_indi_hybrid_params |
Functions | |
| void | guidance_indi_init (void) |
| Init function. | |
| void | guidance_indi_enter (void) |
| Call upon entering indi guidance. | |
| float | guidance_indi_get_liftd (float pitch, float theta) |
| void | guidance_indi_calcg_wing (float Gmat[GUIDANCE_INDI_HYBRID_V][GUIDANCE_INDI_HYBRID_U], struct FloatVect3 a_diff, float v_body[GUIDANCE_INDI_HYBRID_V]) |
| Perform WLS. | |
| struct StabilizationSetpoint | guidance_indi_run (struct FloatVect3 *accep_sp, float heading_sp) |
| struct StabilizationSetpoint | guidance_indi_run_mode (bool in_flight, struct HorizontalGuidance *gh, struct VerticalGuidance *gv, enum GuidanceIndiHybrid_HMode h_mode, enum GuidanceIndiHybrid_VMode v_mode) |
| struct FloatVect3 | guidance_indi_controller (bool in_flight, struct HorizontalGuidance *gh, struct VerticalGuidance *gv, enum GuidanceIndiHybrid_HMode h_mode, enum GuidanceIndiHybrid_VMode v_mode) |
| void | guidance_set_min_max_airspeed (float min_airspeed, float max_airspeed) |
| void | guidance_set_max_bank_angle (float max_bank) |
| Guidance limit setters called by rotwing_state (also implemented by guidance_indi_hybrid). | |
| 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) |
Variables | |
| struct FloatVect3 | gi_speed_sp |
| struct guidance_indi_hybrid_params | gih_params |
| float | guidance_indi_pitch_pref_deg |
| float | gi_unbounded_airspeed_sp |
| float | guidance_indi_thrust_z_eff |
| float | guidance_indi_specific_force_gain |
| bool | take_heading_control |
| float | guidance_indi_max_bank |
| float | guidance_indi_min_pitch |
| bool | force_forward |
| forward flight for hybrid nav | |
| bool | guidance_indi_airspeed_filtering |
| bool | coordinated_turn_use_accel |
| QuatButterworthLowPass | quat_filt |
A guidance mode based on Incremental Nonlinear Dynamic Inversion Come to ICRA2016 to learn more!
Definition in file guidance_indi_hybrid.h.
| struct guidance_indi_hybrid_params |
Definition at line 80 of file guidance_indi_hybrid.h.
| Enumerator | |
|---|---|
| GUIDANCE_INDI_HYBRID_H_POS | |
| GUIDANCE_INDI_HYBRID_H_SPEED | |
| GUIDANCE_INDI_HYBRID_H_ACCEL | |
Definition at line 60 of file guidance_indi_hybrid.h.
| Enumerator | |
|---|---|
| GUIDANCE_INDI_HYBRID_V_POS | |
| GUIDANCE_INDI_HYBRID_V_SPEED | |
| GUIDANCE_INDI_HYBRID_V_ACCEL | |
Definition at line 66 of file guidance_indi_hybrid.h.
|
extern |
Perform WLS.
| Gmat | Dynamics matrix |
| a_diff | acceleration errors in earth frame |
| body_v | 3D vector to write the control objective v |
Perform WLS.
the NED accelerations, taking into account the lift of a wing that is horizontal at -90 degrees pitch
| Gmat | Dynamics matrix |
| a_diff | acceleration errors in earth frame |
| body_v | 3D vector to write the control objective v |
Definition at line 86 of file guidance_indi_hybrid_quadplane.c.
References accel_bodyz_filt, float_eulers_of_quat_zxy(), Gmat, guidance_indi_get_liftd(), GUIDANCE_INDI_PITCH_EFF_SCALING, FloatEulers::phi, FloatEulers::psi, quat_filt, stateGetAirspeed_f(), FloatEulers::theta, v_gih, FloatVect3::x, FloatVect3::y, and FloatVect3::z.
Referenced by guidance_indi_run().
|
extern |
Definition at line 723 of file guidance_indi_hybrid.c.
References ACCEL_FLOAT_OF_BFP, bound_vz_sp(), compute_accel_from_speed_sp(), gi_speed_sp, gih_params, guidance_indi_controller(), GUIDANCE_INDI_HYBRID_H_POS, GUIDANCE_INDI_HYBRID_H_SPEED, GUIDANCE_INDI_HYBRID_V_ACCEL, GUIDANCE_INDI_HYBRID_V_POS, GUIDANCE_INDI_HYBRID_V_SPEED, POS_FLOAT_OF_BFP, SPEED_FLOAT_OF_BFP, stateGetPositionNed_f(), stateGetSpeedNed_f(), UNUSED, FloatVect3::x, NedCoor_f::x, FloatVect3::y, NedCoor_f::y, FloatVect3::z, NedCoor_f::z, VerticalGuidance::z_ref, VerticalGuidance::zd_ref, and VerticalGuidance::zdd_ref.
Referenced by guidance_indi_run_mode().
|
extern |
Call upon entering indi guidance.
Definition at line 207 of file guidance_indi.c.
References eulers_zxy, filt_accel_ned, filter_cutoff, guidance_indi_hybrid_heading_sp, guidance_indi_init_filters(), init_butterworth_2_low_pass(), init_quat_butterworth_low_pass(), nav, FloatEulers::psi, quat_filt, stabilization, stateGetNedToBodyEulers_f(), stateGetNedToBodyEulersZxy_f(), stateGetNedToBodyQuat_f(), thrust_act, thrust_dyn, thrust_filt, and thrust_in.
|
externinline |
Definition at line 446 of file eff_scheduling_rotwing.c.
References eff_scheduling_rotwing_lift_d, and UNUSED.
|
extern |
Init function.
Definition at line 192 of file guidance_indi.c.
References accel_sp_cb(), accel_sp_ev, DefaultPeriodic, FLOAT_EULERS_ZERO, Ga, guidance_euler_cmd, GUIDANCE_INDI_ACCEL_SP_ID, guidance_indi_init_filters(), GUIDANCE_INDI_VEL_SP_ID, register_periodic_telemetry(), send_eff_mat_guid_indi_hybrid(), send_guidance_indi_hybrid(), send_indi_guidance(), thrust_dyn, thrust_sp, THRUST_SP_SET_ZERO, vel_sp_cb(), and vel_sp_ev.
|
extern |
| accel_sp | accel setpoint in NED frame [m/s^2] |
| heading_sp | the desired heading [rad] |
main indi guidance function
Definition at line 235 of file guidance_indi.c.
References accely_filt, control_increment, du_gih, euler_cmd, eulers_zxy, filt_accel_ned, FLOAT_ANGLE_NORMALIZE, float_eulers_of_quat_yxz(), float_eulers_of_quat_zxy(), float_mat3_mult(), float_mat_inv_3d(), float_quat_normalize(), float_quat_of_eulers_yxz(), 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, Gmat, guidance_euler_cmd, guidance_indi_calcG(), 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_NU, GUIDANCE_INDI_NV, guidance_indi_propagate_filters(), guidance_indi_propagate_filters(), guidance_indi_run(), guidance_indi_set_wls_settings(), guidance_indi_specific_force_gain, heading, MAT33_INV, MAT33_VECT3_MUL, max_phi, MAX_PPRZ, FloatRates::p, FloatEulers::phi, FloatEulers::psi, FloatRates::q, quat_filt, FloatRates::r, RMAT_ELMT, sp_accel, stab_sp_from_quat_f(), 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(), guidance_indi_run_mode(), and guidance_indi_run_mode().
|
extern |
Definition at line 785 of file guidance_indi_hybrid.c.
References compute_accel_from_speed_sp(), get_sys_time_float(), gi_speed_sp, guidance_indi_controller(), guidance_indi_run(), guidance_indi_run_mode(), indi_vel_sp, time_of_vel_sp, and UNUSED.
|
extern |
Guidance limit setters called by rotwing_state (also implemented by guidance_indi_hybrid).
The one loop controller uses its own limits, so these are no-ops here.
Definition at line 388 of file guidance_indi_hybrid.c.
|
extern |
Definition at line 392 of file guidance_indi_hybrid.c.
|
extern |
Definition at line 397 of file guidance_indi_hybrid.c.
|
extern |
Definition at line 383 of file guidance_indi_hybrid.c.
|
extern |
Definition at line 220 of file guidance_indi_hybrid.c.
|
extern |
forward flight for hybrid nav
Definition at line 171 of file guidance_indi_hybrid.c.
|
extern |
Definition at line 285 of file guidance_indi_hybrid.c.
Referenced by guidance_indi_controller(), guidance_indi_run_mode(), and send_guidance_indi_hybrid().
|
extern |
Definition at line 248 of file guidance_indi_hybrid.c.
|
extern |
Definition at line 112 of file guidance_indi_hybrid.c.
|
extern |
Definition at line 173 of file guidance_indi_hybrid.c.
Referenced by compute_accel_from_speed_sp().
|
extern |
Definition at line 149 of file guidance_indi.c.
Referenced by guidance_indi_calcG(), guidance_indi_hybrid_set_wls_settings(), guidance_indi_run(), guidance_indi_set_wls_settings(), and guidance_set_max_bank_angle().
|
extern |
Definition at line 210 of file guidance_indi_hybrid.c.
Referenced by guidance_indi_run().
|
extern |
Definition at line 133 of file guidance_indi_hybrid.c.
Referenced by guidance_indi_hybrid_set_wls_settings().
|
extern |
|
extern |
Referenced by guidance_indi_hybrid_set_wls_settings().
|
extern |
Definition at line 102 of file guidance_indi.c.
Referenced by guidance_indi_calcg_wing(), guidance_indi_calcg_wing(), guidance_indi_enter(), guidance_indi_init_filters(), guidance_indi_propagate_filters(), guidance_indi_propagate_filters(), and guidance_indi_run().
|
extern |
Definition at line 169 of file guidance_indi_hybrid.c.
Referenced by guidance_indi_run().