22#ifndef STABILIZATION_INDI
23#define STABILIZATION_INDI
31#define INDI_G_SCALING 1000.0
33extern float g1g2[INDI_OUTPUTS][INDI_NUM_ACT];
49extern float *
Bwls[INDI_OUTPUTS];
89#if !STABILIZATION_INDI_ALLOCATION_PSEUDO_INVERSE
General attitude stabilization interface for rotorcrafts.
General stabilization interface for rotorcrafts.
Common data structures shared by euler and quaternion int implementations.
Rotorcraft attitude reference generation.
float act_pref[INDI_NUM_ACT]
struct FloatRates WEAK stabilization_indi_attitude_controller(struct FloatQuat att, struct FloatQuat att_sp, struct FloatRates rates_ff)
Default PD angular rate controller.
float * Bwls[INDI_OUTPUTS]
struct Indi_gains indi_gains
bool act_is_servo[INDI_NUM_ACT]
float g1g2[INDI_OUTPUTS][INDI_NUM_ACT]
struct FloatVect3 stab_thrust_filt
float stablization_indi_yaw_dist_limit
float actuator_state_filt_vect[INDI_NUM_ACT]
struct FloatRates WEAK stabilization_indi_rate_controller(struct FloatRates rates, struct FloatRates sp)
Default PD angular acceleration controller.
float stabilization_indi_filter_freq
int16_t actuators_pprz[INDI_NUM_ACT+1]
PPRZ command to each actuator Can be used to directly control actuators from the control algorithm if...
float thrust_bx_state_filt
void stabilization_indi_enter(void)
Function that resets important values upon engaging INDI.
void stabilization_indi_rate_run(bool in_flight, struct StabilizationSetpoint *rate_sp, struct ThrustSetpoint *thrust, int32_t *cmd)
Does the INDI calculations.
void stabilization_indi_set_wls_settings(void)
Function that sets the u_min, u_max and u_pref if function not elsewhere defined.
float * stabilization_indi_get_act_state(void)
bool * stabilization_indi_get_act_is_thruster_z(void)
float * stabilization_indi_get_act_dyn(void)
float actuator_thrust_bx_pprz
void stabilization_indi_get_actuator_state(void)
Function that tries to get actuator feedback.
void stabilization_indi_update_filt_freq(float freq)
void stabilization_indi_init(void)
Function that initializes important values upon engaging INDI.
void stabilization_indi_attitude_run(bool in_flight, struct StabilizationSetpoint *att_sp, struct ThrustSetpoint *thrust, int32_t *cmd)
runs stabilization indi
uint8_t * stabilization_indi_get_act_to_commands(void)
int32_t stabilization_indi_get_num_thrusters(void)
float * stabilization_indi_get_indi_u(void)
void stabilization_indi_commit_actuator_cmd(int32_t *cmd)
Thrust setpoint // TODO to a setpoint header Structure to store the desired thrust vector with differ...
int int32_t
Typedef defining 32 bit int type.
short int16_t
Typedef defining 16 bit short type.
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.