Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
stabilization_attitude_euler_float.c File Reference

Rotorcraft attitude stabilization in euler float version. More...

Include dependency graph for stabilization_attitude_euler_float.c:

Go to the source code of this file.

Macros

#define USE_ATT_REF   1
#define MAX_SUM_ERR   200

Functions

static void send_att (struct transport_tx *trans, struct link_device *dev)
static void send_att_ref (struct transport_tx *trans, struct link_device *dev)
void stabilization_attitude_euler_float_init (void)
void stabilization_attitude_enter (void)
 Attitude control enter function.
void stabilization_attitude_run (bool in_flight, struct StabilizationSetpoint *sp, struct ThrustSetpoint *thrust, int32_t *cmd)
 Attitude control run function.

Variables

struct FloatAttitudeGains stabilization_gains
struct FloatEulers stabilization_att_sum_err
static struct FloatEulers stab_att_sp_euler
static struct AttRefEulerFloat att_ref_euler_f
float stabilization_att_fb_cmd [COMMANDS_NB]
float stabilization_att_ff_cmd [COMMANDS_NB]

Detailed Description

Rotorcraft attitude stabilization in euler float version.

Definition in file stabilization_attitude_euler_float.c.

Macro Definition Documentation

◆ MAX_SUM_ERR

◆ USE_ATT_REF

#define USE_ATT_REF   1

Definition at line 39 of file stabilization_attitude_euler_float.c.

Function Documentation

◆ send_att()

◆ send_att_ref()

void send_att_ref ( struct transport_tx * trans,
struct link_device * dev )
static

◆ stabilization_attitude_enter()

void stabilization_attitude_enter ( void )

Attitude control enter function.

Definition at line 131 of file stabilization_attitude_euler_float.c.

References att_ref_euler_f, attitude_ref_euler_float_enter(), FLOAT_EULERS_ZERO, stabilization_att_sum_err, and stabilization_attitude_get_heading_f().

Here is the call graph for this function:

◆ stabilization_attitude_euler_float_init()

void stabilization_attitude_euler_float_init ( void )

◆ stabilization_attitude_run()

void stabilization_attitude_run ( bool in_flight,
struct StabilizationSetpoint * sp,
struct ThrustSetpoint * thrust,
int32_t * cmd )

Attitude control run function.

Parameters
[in]in_flighttrue if in flight
[in]sppointer to the stabilization setpoint structure
[in]thrustpointer to the thrust setoint structure
[out]cmdpointer to the output command vector

Definition at line 141 of file stabilization_attitude_euler_float.c.

References att_ref_euler_f, attitude_ref_euler_float_update(), COMMAND_PITCH, COMMAND_ROLL, EULERS_ADD, EULERS_BOUND_CUBE, EULERS_COPY, EULERS_DIFF, FLOAT_ANGLE_NORMALIZE, FLOAT_EULERS_ZERO, FLOAT_RATES_ZERO, MAX_PPRZ, MAX_SUM_ERR, FloatRates::p, FloatEulers::phi, FloatEulers::psi, FloatRates::q, FloatRates::r, RATES_DIFF, stab_att_sp_euler, stab_sp_to_eulers_f(), stabilization_att_fb_cmd, stabilization_att_ff_cmd, stabilization_att_sum_err, stabilization_gains, stateGetBodyRates_f(), stateGetNedToBodyEulers_f(), th_sp_to_thrust_i(), FloatEulers::theta, and THRUST_AXIS_Z.

Here is the call graph for this function:

Variable Documentation

◆ att_ref_euler_f

◆ stab_att_sp_euler

◆ stabilization_att_fb_cmd

float stabilization_att_fb_cmd[COMMANDS_NB]

Definition at line 48 of file stabilization_attitude_euler_float.c.

◆ stabilization_att_ff_cmd

float stabilization_att_ff_cmd[COMMANDS_NB]

Definition at line 49 of file stabilization_attitude_euler_float.c.

◆ stabilization_att_sum_err

◆ stabilization_gains

struct FloatAttitudeGains stabilization_gains

Definition at line 42 of file stabilization_attitude_euler_float.c.