stabilization_attitude_euler_int.c File Reference

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

#include "generated/airframe.h"
#include "firmwares/rotorcraft/stabilization/stabilization_attitude.h"
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_rc_setpoint.h"
#include "std.h"
#include "paparazzi.h"
#include "math/pprz_algebra_int.h"
#include "state.h"

Include dependency graph for stabilization_attitude_euler_int.c:

Go to the source code of this file.

Macros
#define	USE_ATTITUDE_REF   1
	explicitly define to zero to disable attitude reference generation More...
#define	OFFSET_AND_ROUND(_a, _b)   (((_a)+(1<<((_b)-1)))>>(_b))
#define	OFFSET_AND_ROUND2(_a, _b)   (((_a)+(1<<((_b)-1))-((_a)<0?1:0))>>(_b))
#define	MAX_SUM_ERR   4000000
#define	CMD_SHIFT   11

Functions
static void	reset_psi_ref_from_body (void)
void	stabilization_attitude_init (void)
void	stabilization_attitude_read_rc (bool_t in_flight, bool_t in_carefree, bool_t coordinated_turn)
void	stabilization_attitude_enter (void)
void	stabilization_attitude_set_failsafe_setpoint (void)
void	stabilization_attitude_set_rpy_setpoint_i (struct Int32Eulers *rpy)
void	stabilization_attitude_set_earth_cmd_i (struct Int32Vect2 *cmd, int32_t heading)
void	stabilization_attitude_run (bool_t in_flight)

Variables
struct Int32AttitudeGains	stabilization_gains
struct Int32Eulers	stabilization_att_sum_err
int32_t	stabilization_att_fb_cmd [COMMANDS_NB]
int32_t	stabilization_att_ff_cmd [COMMANDS_NB]
struct Int32Eulers	stab_att_sp_euler
	with INT32_ANGLE_FRAC More...
struct AttRefEulerInt	att_ref_euler_i

Detailed Description

Rotorcraft attitude stabilization in euler int version.

Definition in file stabilization_attitude_euler_int.c.

Macro Definition Documentation

#define CMD_SHIFT   11

Referenced by stabilization_attitude_run().

#define MAX_SUM_ERR   4000000

Definition at line 195 of file stabilization_attitude_euler_int.c.

Referenced by stabilization_attitude_run().

#define OFFSET_AND_ROUND	(		_a,
			_b
	)		(((_a)+(1<<((_b)-1)))>>(_b))

Definition at line 192 of file stabilization_attitude_euler_int.c.

Referenced by stabilization_attitude_run().

#define OFFSET_AND_ROUND2	(		_a,
			_b
	)		(((_a)+(1<<((_b)-1))-((_a)<0?1:0))>>(_b))

Definition at line 193 of file stabilization_attitude_euler_int.c.

Referenced by stabilization_attitude_run().

#define USE_ATTITUDE_REF   1

explicitly define to zero to disable attitude reference generation

Definition at line 40 of file stabilization_attitude_euler_int.c.

Function Documentation

static void reset_psi_ref_from_body ( void  )

inlinestatic

Definition at line 66 of file stabilization_attitude_euler_int.c.

References AttRefEulerInt::accel, att_ref_euler_i, AttRefEulerInt::euler, INT32_ANGLE_FRAC, Int32Eulers::psi, Int32Rates::r, AttRefEulerInt::rate, REF_ANGLE_FRAC, and stab_att_sp_euler.

Referenced by stabilization_attitude_enter().

Here is the caller graph for this function:

void stabilization_attitude_enter

(

void

)

Definition at line 161 of file stabilization_attitude_euler_int.c.

References INT_EULERS_ZERO, Int32Eulers::psi, reset_psi_ref_from_body(), stab_att_sp_euler, stabilization_att_sum_err, and stateGetNedToBodyEulers_i().

Here is the call graph for this function:

void stabilization_attitude_init

(

void

)

Definition at line 119 of file stabilization_attitude_euler_int.c.

References att_ref_euler_i, attitude_ref_euler_int_init(), Int32AttitudeGains::d, Int32AttitudeGains::dd, DefaultPeriodic, Int32AttitudeGains::i, INT_EULERS_ZERO, Int32AttitudeGains::p, register_periodic_telemetry(), stab_att_sp_euler, stabilization_att_sum_err, stabilization_gains, and VECT3_ASSIGN.

Here is the call graph for this function:

void stabilization_attitude_read_rc	(	bool_t	in_flight,
		bool_t	in_carefree,
		bool_t	coordinated_turn
	)

Definition at line 156 of file stabilization_attitude_euler_int.c.

References stab_att_sp_euler, and stabilization_attitude_read_rc_setpoint_eulers().

Here is the call graph for this function:

void stabilization_attitude_run

(

bool_t

in_flight

)

Definition at line 197 of file stabilization_attitude_euler_int.c.

References AttRefEulerInt::accel, att_ref_euler_i, attitude_ref_euler_int_update(), CMD_SHIFT, Int32AttitudeGains::d, Int32AttitudeGains::dd, AttRefEulerInt::euler, EULERS_ADD, EULERS_BOUND_CUBE, EULERS_DIFF, Int32AttitudeGains::i, INT32_ANGLE_FRAC, INT32_ANGLE_NORMALIZE, INT32_EULERS_LSHIFT, INT32_RATE_FRAC, INT_EULERS_ZERO, INT_RATES_ZERO, MAX_PPRZ, MAX_SUM_ERR, OFFSET_AND_ROUND, OFFSET_AND_ROUND2, Int32AttitudeGains::p, Int32Rates::p, Int32Eulers::phi, Int32Eulers::psi, Int32Rates::q, Int32Rates::r, AttRefEulerInt::rate, RATES_DIFF, REF_ANGLE_FRAC, REF_RATE_FRAC, stab_att_sp_euler, stabilization_att_fb_cmd, stabilization_att_ff_cmd, stabilization_att_sum_err, stabilization_cmd, stabilization_gains, stateGetBodyRates_i(), stateGetNedToBodyEulers_i(), Int32Eulers::theta, Int32Vect3::x, Int32Vect3::y, and Int32Vect3::z.

Here is the call graph for this function:

void stabilization_attitude_set_earth_cmd_i	(	struct Int32Vect2 *	cmd,
		int32_t	heading
	)

Definition at line 180 of file stabilization_attitude_euler_int.c.

References heading, INT32_TRIG_FRAC, Int32Eulers::phi, PPRZ_ITRIG_COS, PPRZ_ITRIG_SIN, Int32Eulers::psi, stab_att_sp_euler, stateGetNedToBodyEulers_i(), Int32Eulers::theta, Int32Vect2::x, and Int32Vect2::y.

Here is the call graph for this function:

void stabilization_attitude_set_failsafe_setpoint

(

void

)

Definition at line 168 of file stabilization_attitude_euler_int.c.

References Int32Eulers::phi, Int32Eulers::psi, stab_att_sp_euler, stateGetNedToBodyEulers_i(), and Int32Eulers::theta.

Here is the call graph for this function:

void stabilization_attitude_set_rpy_setpoint_i

(

struct Int32Eulers *

rpy

)

Definition at line 175 of file stabilization_attitude_euler_int.c.

References stab_att_sp_euler.

Variable Documentation

struct AttRefEulerInt att_ref_euler_i

Definition at line 64 of file stabilization_attitude_euler_int.c.

Referenced by reset_psi_ref_from_body(), stabilization_attitude_init(), and stabilization_attitude_run().

struct Int32Eulers stab_att_sp_euler

with INT32_ANGLE_FRAC

Definition at line 63 of file stabilization_attitude_euler_int.c.

Referenced by reset_psi_ref_from_body(), stabilization_attitude_enter(), stabilization_attitude_init(), stabilization_attitude_read_rc(), stabilization_attitude_run(), stabilization_attitude_set_earth_cmd_i(), stabilization_attitude_set_failsafe_setpoint(), and stabilization_attitude_set_rpy_setpoint_i().

int32_t stabilization_att_fb_cmd[COMMANDS_NB]

Definition at line 60 of file stabilization_attitude_euler_int.c.

Referenced by stabilization_attitude_run().

int32_t stabilization_att_ff_cmd[COMMANDS_NB]

Definition at line 61 of file stabilization_attitude_euler_int.c.

Referenced by stabilization_attitude_run().

struct Int32Eulers stabilization_att_sum_err

Definition at line 58 of file stabilization_attitude_euler_int.c.

Referenced by stabilization_attitude_enter(), stabilization_attitude_init(), and stabilization_attitude_run().

struct Int32AttitudeGains stabilization_gains

Definition at line 43 of file stabilization_attitude_euler_int.c.

Referenced by stabilization_attitude_init(), and stabilization_attitude_run().