26static float Ap = GUIDANCE_INDI_HINF_Ap;
27static float Bp = GUIDANCE_INDI_HINF_Bp;
28static float Cp = GUIDANCE_INDI_HINF_Cp;
29static float Dp = GUIDANCE_INDI_HINF_Dp;
31static float Ad = GUIDANCE_INDI_HINF_Ad;
32static float Bd = GUIDANCE_INDI_HINF_Bd;
33static float Cd = GUIDANCE_INDI_HINF_Cd;
34static float Dd = GUIDANCE_INDI_HINF_Dd;
36static float Apz = GUIDANCE_INDI_HINF_Apz;
37static float Bpz = GUIDANCE_INDI_HINF_Bpz;
38static float Cpz = GUIDANCE_INDI_HINF_Cpz;
39static float Dpz = GUIDANCE_INDI_HINF_Dpz;
41static float Adz = GUIDANCE_INDI_HINF_Adz;
42static float Bdz = GUIDANCE_INDI_HINF_Bdz;
43static float Cdz = GUIDANCE_INDI_HINF_Cdz;
44static float Ddz = GUIDANCE_INDI_HINF_Ddz;
123 accel_sp.
x = speed_fb.
x;
124 accel_sp.
y = speed_fb.
y;
125 accel_sp.
z = speed_fb.
z;
#define FLOAT_VECT3_ZERO(_v)
#define POS_FLOAT_OF_BFP(_ai)
#define SPEED_FLOAT_OF_BFP(_ai)
static struct NedCoor_f * stateGetPositionNed_f(void)
Get position in local NED coordinates (float).
static struct NedCoor_f * stateGetSpeedNed_f(void)
Get ground speed in local NED coordinates (float).
struct FloatVect3 speed_sp
struct FloatVect3 WEAK guidance_indi_controller(bool in_flight UNUSED, struct HorizontalGuidance *gh, struct VerticalGuidance *gv, enum GuidanceIndi_HMode h_mode, enum GuidanceIndi_VMode v_mode)
A guidance mode based on Incremental Nonlinear Dynamic Inversion.
static struct FloatVect3 pos_state
static struct FloatVect3 speed_state
Paparazzi floating point algebra.
int32_t z_ref
altitude reference in meters.
int32_t zd_ref
vertical speed reference in meter/s.
API to get/set the generic vehicle states.