|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
#include "firmwares/rotorcraft/stabilization/stabilization_indi.h"#include "math/pprz_algebra_float.h"#include "autopilot.h"Go to the source code of this file.
Functions | |
| struct FloatRates | stabilization_indi_rate_controller (struct FloatRates rates, struct FloatRates sp) |
| Angular acceleration controller based on Hinfinity. | |
| struct FloatRates WEAK | stabilization_indi_attitude_controller (struct FloatQuat att, struct FloatQuat att_sp, struct FloatRates rates_ff) |
| Angular rate controller based on Hinfinity. | |
Variables | |
| static struct FloatRates | rate_state |
| static struct FloatRates | att_state |
| static float | Ap = STABILIZATION_INDI_HINF_Ap |
| static float | Bp = STABILIZATION_INDI_HINF_Bp |
| static float | Cp = STABILIZATION_INDI_HINF_Cp |
| static float | Dp = STABILIZATION_INDI_HINF_Dp |
| static float | Ad = STABILIZATION_INDI_HINF_Ad |
| static float | Bd = STABILIZATION_INDI_HINF_Bd |
| static float | Cd = STABILIZATION_INDI_HINF_Cd |
| static float | Dd = STABILIZATION_INDI_HINF_Dd |
| struct FloatRates WEAK stabilization_indi_attitude_controller | ( | struct FloatQuat | att, |
| struct FloatQuat | att_sp, | ||
| struct FloatRates | rates_ff ) |
Angular rate controller based on Hinfinity.
Default PD angular rate controller.
Takes the current attitude filtered state and setpoint and compute the desired rates. Can be redefined elsewhere to use an other control scheme.
Definition at line 70 of file stabilization_indi_hinf.c.
References Ap, att_state, autopilot_in_flight(), Bp, Cp, Dp, float_quat_inv_comp_norm_shortest(), float_quat_tilt_twist(), FLOAT_RATES_ZERO, indi_gains, FloatRates::p, FloatRates::q, FloatQuat::qx, FloatQuat::qy, FloatQuat::qz, FloatRates::r, RATES_ADD, stabilization_indi_attitude_controller(), FloatVect3::x, FloatVect3::y, and FloatVect3::z.
| struct FloatRates stabilization_indi_rate_controller | ( | struct FloatRates | rates, |
| struct FloatRates | sp ) |
Angular acceleration controller based on Hinfinity.
Default PD angular acceleration controller.
Takes the current rates filtered state and setpoint and compute the desired acceleration.
Definition at line 43 of file stabilization_indi_hinf.c.
References Ad, autopilot_in_flight(), Bd, Cd, Dd, FLOAT_RATES_ZERO, indi_gains, FloatRates::p, FloatRates::q, FloatRates::r, rate_state, RATES_DIFF, and stabilization_indi_rate_controller().
|
static |
Definition at line 34 of file stabilization_indi_hinf.c.
|
static |
Definition at line 29 of file stabilization_indi_hinf.c.
|
static |
Definition at line 26 of file stabilization_indi_hinf.c.
Referenced by control_error_attitude(), control_error_rate(), and stabilization_indi_attitude_controller().
|
static |
Definition at line 35 of file stabilization_indi_hinf.c.
|
static |
Definition at line 30 of file stabilization_indi_hinf.c.
|
static |
Definition at line 36 of file stabilization_indi_hinf.c.
|
static |
Definition at line 31 of file stabilization_indi_hinf.c.
|
static |
Definition at line 37 of file stabilization_indi_hinf.c.
|
static |
Definition at line 32 of file stabilization_indi_hinf.c.
|
static |
Definition at line 25 of file stabilization_indi_hinf.c.
Referenced by stabilization_indi_rate_controller().