Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
stabilization_attitude_heli_indi.h File Reference
Include dependency graph for stabilization_attitude_heli_indi.h:
This graph shows which files directly or indirectly include this file:

Go to the source code of this file.

Data Structures

struct  HeliIndiGains
struct  IndiController_int

Macros

#define __k   1
#define INDI_NR_FILTERS   2
#define INDI_DOF   4
#define INDI_ROLL   0
#define INDI_PITCH   1
#define INDI_YAW   2
#define INDI_THRUST   3
#define INDI_YAW_BUFFER_SIZE   9

Functions

void stabilization_attitude_heli_indi_init (void)
 stabilization_attitude_heli_indi_init
void stabilization_attitude_heli_indi_set_steadystate_pitch (float pitch)
 stabilization_attitude_heli_indi_set_steadystate_pitch
void stabilization_attitude_heli_indi_set_steadystate_roll (float roll)
 stabilization_attitude_heli_indi_set_steadystate_roll
void stabilization_attitude_heli_indi_set_steadystate_pitchroll (void)
 stabilization_attitude_heli_indi_set_steadystate_pitchroll

Variables

struct delayed_first_order_lowpass_filter_t actuator_model [INDI_DOF]
struct HeliIndiGains heli_indi_gains

Data Structure Documentation

◆ HeliIndiGains

struct HeliIndiGains

Definition at line 39 of file stabilization_attitude_heli_indi.h.

Data Fields
int32_t pitch_p
int32_t roll_p
int32_t yaw_d
int32_t yaw_p

◆ IndiController_int

struct IndiController_int

Definition at line 47 of file stabilization_attitude_heli_indi.h.

Data Fields
int32_t actuator_out[INDI_DOF] Actuator position.
void(*[INDI_NR_FILTERS])(int32_t _out[], int32_t _in[]) apply_actuator_filters
void(*)(int32_t _out[], int32_t _in[]) apply_actuator_models
void(*)(int32_t _out[], int32_t _in[]) apply_compensator_filters
void(*[INDI_NR_FILTERS])(int32_t _out[], int32_t _in[]) apply_measurement_filters
int32_t command_out[2][INDI_DOF] Command and command from previous measurement.
int32_t du[INDI_DOF] Actuator commanded increment.
bool enable_notch Use notch filters.
int32_t error[INDI_DOF] virtual control minus measurement
int32_t filtered_actuator[INDI_NR_FILTERS][INDI_DOF] Filtered actuator position.
int32_t filtered_measurement[INDI_NR_FILTERS][INDI_DOF] Filtered measurement.
int32_t invG[INDI_DOF][INDI_DOF] Inverse control effectiveness matrix.
int32_t measurement[INDI_DOF] Raw measurement.
int16_t motor_rpm RPM of the main motor.
int32_t pitch_comp_angle Angle to rotate pitch/roll commands with INT32_ANGLE_FRAC.
int32_t reference[INDI_DOF] Range -MAX_PPRZ:MAX_PPRZ.
int32_t roll_comp_angle Angle to rotate pitch/roll commands with INT32_ANGLE_FRAC.
float sp_offset_pitch Neutral pitch angle [deg].
float sp_offset_roll Neutral roll angle [deg].
int32_t u_setpoint[INDI_DOF] Actuator setpoint without compensator.

Macro Definition Documentation

◆ __k

#define __k   1

Definition at line 30 of file stabilization_attitude_heli_indi.h.

Referenced by stabilization_attitude_run().

◆ INDI_DOF

◆ INDI_NR_FILTERS

#define INDI_NR_FILTERS   2

Definition at line 31 of file stabilization_attitude_heli_indi.h.

Referenced by stabilization_attitude_run().

◆ INDI_PITCH

◆ INDI_ROLL

◆ INDI_THRUST

◆ INDI_YAW

◆ INDI_YAW_BUFFER_SIZE

#define INDI_YAW_BUFFER_SIZE   9

Definition at line 37 of file stabilization_attitude_heli_indi.h.

Referenced by indi_apply_compensator_filters().

Function Documentation

◆ stabilization_attitude_heli_indi_init()

void stabilization_attitude_heli_indi_init ( void )
extern

stabilization_attitude_heli_indi_init

Initialize the heli indi attitude controller.

Definition at line 334 of file stabilization_attitude_heli_indi.c.

References actuator_lowpass_filters, actuator_model, actuator_notchfilter, alpha_yaw_dec, alpha_yaw_inc, ANGLE_BFP_OF_REAL, IndiController_int::apply_actuator_filters, IndiController_int::apply_actuator_models, IndiController_int::apply_compensator_filters, IndiController_int::apply_measurement_filters, DELAYED_FIRST_ORDER_LOWPASS_FILTER_FILTER_ALPHA_SHIFT, delayed_first_order_lowpass_initialize(), IndiController_int::enable_notch, FALSE, heli_indi_ctl, indi_apply_actuator_butterworth_filters(), indi_apply_actuator_models(), indi_apply_actuator_notch_filters(), indi_apply_compensator_filters(), indi_apply_measurement_butterworth_filters(), indi_apply_measurement_notch_filters(), INDI_PITCH, INDI_ROLL, INDI_THRUST, INDI_YAW, init_butterworth_2_low_pass_int(), IndiController_int::invG, INVG_00, INVG_11, INVG_22, INVG_33, MAX_PPRZ, measurement_lowpass_filters, measurement_notchfilter, IndiController_int::motor_rpm, notch_filter_init(), IndiController_int::pitch_comp_angle, IndiController_int::roll_comp_angle, IndiController_int::sp_offset_pitch, IndiController_int::sp_offset_roll, STABILIZATION_ATTITUDE_HELI_INDI_BUTTERW_CUTOFF_PITCH, STABILIZATION_ATTITUDE_HELI_INDI_BUTTERW_CUTOFF_ROLL, STABILIZATION_ATTITUDE_HELI_INDI_BUTTERW_CUTOFF_THRUST, STABILIZATION_ATTITUDE_HELI_INDI_BUTTERW_CUTOFF_YAW, STABILIZATION_ATTITUDE_HELI_INDI_NOTCHFILT_BW_PITCH, STABILIZATION_ATTITUDE_HELI_INDI_NOTCHFILT_BW_ROLL, STABILIZATION_ATTITUDE_HELI_INDI_NOTCHFILT_BW_THRUST, STABILIZATION_ATTITUDE_HELI_INDI_NOTCHFILT_BW_YAW, STABILIZATION_ATTITUDE_HELI_INDI_PITCH_COMMAND_ROTATION, STABILIZATION_ATTITUDE_HELI_INDI_ROLL_COMMAND_ROTATION, stabilization_attitude_heli_indi_set_steadystate_pitchroll(), STABILIZATION_ATTITUDE_HELI_INDI_STEADY_STATE_PITCH, STABILIZATION_ATTITUDE_HELI_INDI_STEADY_STATE_ROLL, and TRUE.

Here is the call graph for this function:

◆ stabilization_attitude_heli_indi_set_steadystate_pitch()

void stabilization_attitude_heli_indi_set_steadystate_pitch ( float pitch)
extern

stabilization_attitude_heli_indi_set_steadystate_pitch

Parameters
pitchneutral pitch angle [deg].

Change the neutral pitch angle.

Definition at line 290 of file stabilization_attitude_heli_indi.c.

References heli_indi_ctl, and stabilization_attitude_heli_indi_set_steadystate_pitchroll().

Here is the call graph for this function:

◆ stabilization_attitude_heli_indi_set_steadystate_pitchroll()

void stabilization_attitude_heli_indi_set_steadystate_pitchroll ( void )
extern

stabilization_attitude_heli_indi_set_steadystate_pitchroll

Updates the neutral pitch and roll angles and calculates the compensation quaternion.

Definition at line 315 of file stabilization_attitude_heli_indi.c.

References float_quat_of_orientation_vect(), heli_indi_ctl, QUAT_BFP_OF_REAL, sp_offset, FloatVect3::x, FloatVect3::y, and FloatVect3::z.

Referenced by stabilization_attitude_heli_indi_init(), stabilization_attitude_heli_indi_set_steadystate_pitch(), and stabilization_attitude_heli_indi_set_steadystate_roll().

Here is the call graph for this function:
Here is the caller graph for this function:

◆ stabilization_attitude_heli_indi_set_steadystate_roll()

void stabilization_attitude_heli_indi_set_steadystate_roll ( float roll)
extern

stabilization_attitude_heli_indi_set_steadystate_roll

Parameters
rollneutral roll angle [deg].

Change the neutral roll angle. Especially useful for helicopters, since they need a small roll angle in hover to compensate the tail force.

Definition at line 303 of file stabilization_attitude_heli_indi.c.

References heli_indi_ctl, and stabilization_attitude_heli_indi_set_steadystate_pitchroll().

Here is the call graph for this function:

Variable Documentation

◆ actuator_model

◆ heli_indi_gains

struct HeliIndiGains heli_indi_gains
extern

Definition at line 129 of file stabilization_attitude_heli_indi.c.

Referenced by stabilization_attitude_run().