Paparazzi UAS
v5.14.0_stable-0-g3f680d1
Paparazzi is a free software Unmanned Aircraft System.
|
Rate stabilization for rotorcrafts based on INDI. More...
#include "math/pprz_algebra_int.h"
Go to the source code of this file.
Functions | |
void | stabilization_rate_init (void) |
void | stabilization_rate_read_rc (void) |
void | stabilization_rate_read_rc_switched_sticks (void) |
void | stabilization_rate_run (bool in_flight) |
void | stabilization_rate_enter (void) |
Rate stabilization for rotorcrafts based on INDI.
Definition in file stabilization_rate_indi.h.
void stabilization_rate_enter | ( | void | ) |
Definition at line 182 of file stabilization_rate.c.
References FLOAT_RATES_ZERO, stabilization_indi_enter(), and stabilization_rate_sum_err.
Referenced by guidance_h_mode_changed().
void stabilization_rate_init | ( | void | ) |
Definition at line 115 of file stabilization_rate.c.
References DefaultPeriodic, FLOAT_RATES_ZERO, RATES_ASSIGN, register_periodic_telemetry(), send_rate(), stabilization_indi_init(), stabilization_rate_gain, stabilization_rate_igain, STABILIZATION_RATE_IGAIN_P, STABILIZATION_RATE_IGAIN_Q, STABILIZATION_RATE_IGAIN_R, stabilization_rate_sp, and stabilization_rate_sum_err.
void stabilization_rate_read_rc | ( | void | ) |
Definition at line 137 of file stabilization_rate.c.
References MAX_PPRZ, FloatRates::p, PITCH_RATE_DEADBAND_EXCEEDED, FloatRates::q, FloatRates::r, radio_control, RADIO_PITCH, RADIO_ROLL, RADIO_YAW, ROLL_RATE_DEADBAND_EXCEEDED, stabilization_rate_sp, THROTTLE_STICK_DOWN, RadioControl::values, and YAW_RATE_DEADBAND_EXCEEDED.
Referenced by guidance_h_read_rc().
void stabilization_rate_read_rc_switched_sticks | ( | void | ) |
Definition at line 160 of file stabilization_rate.c.
References MAX_PPRZ, FloatRates::p, PITCH_RATE_DEADBAND_EXCEEDED, FloatRates::q, FloatRates::r, radio_control, RADIO_PITCH, RADIO_ROLL, RADIO_YAW, ROLL_RATE_DEADBAND_EXCEEDED, stabilization_rate_sp, THROTTLE_STICK_DOWN, RadioControl::values, and YAW_RATE_DEADBAND_EXCEEDED.
Referenced by guidance_h_read_rc().
void stabilization_rate_run | ( | bool | in_flight | ) |
Definition at line 187 of file stabilization_rate.c.
References FLOAT_RATES_ZERO, MAX_PPRZ, MAX_SUM_ERR, FloatRates::p, FloatRates::q, FloatRates::r, RATES_ADD, RATES_BOUND_CUBE, RATES_DIFF, RATES_SDIV, stabilization_cmd, stabilization_indi_run(), stabilization_rate_fb_cmd, stabilization_rate_gain, stabilization_rate_igain, stabilization_rate_sp, stabilization_rate_sum_err, stateGetBodyRates_f(), and TRUE.
Referenced by guidance_h_run().