Paparazzi UAS  v5.12_stable-4-g9b43e9b
Paparazzi is a free software Unmanned Aircraft System.
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Modules Pages
stabilization_indi_simple.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) Ewoud Smeur <ewoud_smeur@msn.com>
3  * MAVLab Delft University of Technology
4  *
5  * This file is part of paparazzi.
6  *
7  * paparazzi is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2, or (at your option)
10  * any later version.
11  *
12  * paparazzi is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with paparazzi; see the file COPYING. If not, write to
19  * the Free Software Foundation, 59 Temple Place - Suite 330,
20  * Boston, MA 02111-1307, USA.
21  */
22 
37 
38 #include "state.h"
39 #include "generated/airframe.h"
40 #include "paparazzi.h"
42 
43 #if !defined(STABILIZATION_INDI_ACT_DYN_P) && !defined(STABILIZATION_INDI_ACT_DYN_Q) && !defined(STABILIZATION_INDI_ACT_DYN_R)
44 #error You have to define the first order time constant of the actuator dynamics!
45 #endif
46 
47 // these parameters are used in the filtering of the angular acceleration
48 // define them in the airframe file if different values are required
49 #ifndef STABILIZATION_INDI_FILT_CUTOFF
50 #define STABILIZATION_INDI_FILT_CUTOFF 8.0
51 #endif
52 
53 // the yaw sometimes requires more filtering
54 #ifndef STABILIZATION_INDI_FILT_CUTOFF_R
55 #define STABILIZATION_INDI_FILT_CUTOFF_R STABILIZATION_INDI_FILT_CUTOFF
56 #endif
57 
58 #ifndef STABILIZATION_INDI_MAX_RATE
59 #define STABILIZATION_INDI_MAX_RATE 6.0
60 #endif
61 
62 #if STABILIZATION_INDI_USE_ADAPTIVE
63 #warning "Use caution with adaptive indi. See the wiki for more info"
64 #endif
65 
66 #ifndef STABILIZATION_INDI_MAX_R
67 #define STABILIZATION_INDI_MAX_R STABILIZATION_ATTITUDE_SP_MAX_R
68 #endif
69 
70 #ifndef STABILIZATION_INDI_ESTIMATION_FILT_CUTOFF
71 #define STABILIZATION_INDI_ESTIMATION_FILT_CUTOFF 4.0
72 #endif
73 
76 
77 static int32_t stabilization_att_indi_cmd[COMMANDS_NB];
78 static inline void stabilization_indi_calc_cmd(int32_t indi_commands[], struct Int32Quat *att_err, bool rate_control);
79 static inline void lms_estimation(void);
80 static void indi_init_filters(void);
81 
82 //The G values are scaled to avoid numerical problems during the estimation
83 #define INDI_EST_SCALE 0.001
84 
85 struct IndiVariables indi = {
87  .attitude_max_yaw_rate = STABILIZATION_INDI_MAX_R,
88 
89  .g1 = {STABILIZATION_INDI_G1_P, STABILIZATION_INDI_G1_Q, STABILIZATION_INDI_G1_R},
90  .g2 = STABILIZATION_INDI_G2_R,
91  .reference_acceleration = {
92  STABILIZATION_INDI_REF_ERR_P,
93  STABILIZATION_INDI_REF_ERR_Q,
94  STABILIZATION_INDI_REF_ERR_R,
95  STABILIZATION_INDI_REF_RATE_P,
96  STABILIZATION_INDI_REF_RATE_Q,
97  STABILIZATION_INDI_REF_RATE_R},
98 
99  /* Estimation parameters for adaptive INDI */
100  .est = {
101  .g1 = {
102  STABILIZATION_INDI_G1_P / INDI_EST_SCALE,
103  STABILIZATION_INDI_G1_Q / INDI_EST_SCALE,
104  STABILIZATION_INDI_G1_R / INDI_EST_SCALE},
105  .g2 = STABILIZATION_INDI_G2_R / INDI_EST_SCALE,
106  .mu = STABILIZATION_INDI_ADAPTIVE_MU,
107  },
108 
109 #if STABILIZATION_INDI_USE_ADAPTIVE
110  .adaptive = TRUE,
111 #else
112  .adaptive = FALSE,
113 #endif
114 };
115 
116 #if PERIODIC_TELEMETRY
118 
119 static void send_att_indi(struct transport_tx *trans, struct link_device *dev)
120 {
121  //The estimated G values are scaled, so scale them back before sending
122  struct FloatRates g1_disp;
123  RATES_SMUL(g1_disp, indi.est.g1, INDI_EST_SCALE);
124  float g2_disp = indi.est.g2 * INDI_EST_SCALE;
125 
126  pprz_msg_send_STAB_ATTITUDE_INDI(trans, dev, AC_ID,
127  &indi.rate_d[0],
128  &indi.rate_d[1],
129  &indi.rate_d[2],
130  &indi.angular_accel_ref.p,
131  &indi.angular_accel_ref.q,
132  &indi.angular_accel_ref.r,
133  &g1_disp.p,
134  &g1_disp.q,
135  &g1_disp.r,
136  &g2_disp);
137 }
138 
139 static void send_ahrs_ref_quat(struct transport_tx *trans, struct link_device *dev)
140 {
141  struct Int32Quat *quat = stateGetNedToBodyQuat_i();
142  pprz_msg_send_AHRS_REF_QUAT(trans, dev, AC_ID,
147  &(quat->qi),
148  &(quat->qx),
149  &(quat->qy),
150  &(quat->qz));
151 }
152 #endif
153 
155 {
156  // Initialize filters
158 
159 #if PERIODIC_TELEMETRY
160  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_STAB_ATTITUDE_INDI, send_att_indi);
162 #endif
163 }
164 
165 void indi_init_filters(void) {
166  // tau = 1/(2*pi*Fc)
167  float tau = 1.0/(2.0*M_PI*STABILIZATION_INDI_FILT_CUTOFF);
168  float tau_r = 1.0/(2.0*M_PI*STABILIZATION_INDI_FILT_CUTOFF_R);
169  float tau_axis[3] = {tau, tau, tau_r};
170  float tau_est = 1.0/(2.0*M_PI*STABILIZATION_INDI_ESTIMATION_FILT_CUTOFF);
171  float sample_time = 1.0/PERIODIC_FREQUENCY;
172  // Filtering of gyroscope and actuators
173  for(int8_t i=0; i<3; i++) {
174  init_butterworth_2_low_pass(&indi.u[i], tau_axis[i], sample_time, 0.0);
175  init_butterworth_2_low_pass(&indi.rate[i], tau_axis[i], sample_time, 0.0);
176  init_butterworth_2_low_pass(&indi.est.u[i], tau_est, sample_time, 0.0);
177  init_butterworth_2_low_pass(&indi.est.rate[i], tau_est, sample_time, 0.0);
178  }
179 }
180 
182 {
183  /* reset psi setpoint to current psi angle */
185 
188  FLOAT_RATES_ZERO(indi.u_in);
189 
190  // Re-initialize filters
192 }
193 
195 {
196  /* set failsafe to zero roll/pitch and current heading */
199  stab_att_sp_quat.qx = 0;
200  stab_att_sp_quat.qy = 0;
202 }
203 
210 {
211  // stab_att_sp_euler.psi still used in ref..
212  stab_att_sp_euler = *rpy;
213 
215 }
216 
224 {
225  // stab_att_sp_euler.psi still used in ref..
227 
228  // compute sp_euler phi/theta for debugging/telemetry
229  /* Rotate horizontal commands to body frame by psi */
231  int32_t s_psi, c_psi;
232  PPRZ_ITRIG_SIN(s_psi, psi);
233  PPRZ_ITRIG_COS(c_psi, psi);
234  stab_att_sp_euler.phi = (-s_psi * cmd->x + c_psi * cmd->y) >> INT32_TRIG_FRAC;
235  stab_att_sp_euler.theta = -(c_psi * cmd->x + s_psi * cmd->y) >> INT32_TRIG_FRAC;
236 
237  quat_from_earth_cmd_i(&stab_att_sp_quat, cmd, heading);
238 }
239 
246 static inline void filter_pqr(Butterworth2LowPass *filter, struct FloatRates *new_values) {
247  update_butterworth_2_low_pass(&filter[0], new_values->p);
248  update_butterworth_2_low_pass(&filter[1], new_values->q);
249  update_butterworth_2_low_pass(&filter[2], new_values->r);
250 }
251 
259 static inline void finite_difference_from_filter(float *output, Butterworth2LowPass *filter) {
260  for(int8_t i=0; i<3; i++) {
261  output[i] = (filter[i].o[0] - filter[i].o[1])*PERIODIC_FREQUENCY;
262  }
263 }
264 
272 static inline void finite_difference(float output[3], float new[3], float old[3]) {
273  for(int8_t i=0; i<3; i++) {
274  output[i] = (new[i] - old[i])*PERIODIC_FREQUENCY;
275  }
276 }
277 
285 static inline void stabilization_indi_calc_cmd(int32_t indi_commands[], struct Int32Quat *att_err, bool rate_control)
286 {
287  // Propagate the filter on the gyroscopes and actuators
288  struct FloatRates *body_rates = stateGetBodyRates_f();
289  filter_pqr(indi.u, &indi.u_act_dyn);
290  filter_pqr(indi.rate, body_rates);
291 
292  // Calculate the derivative of the rates
294 
295  //The rates used for feedback are by default the measured rates. If needed they can be filtered (see below)
296  struct FloatRates rates_for_feedback;
297  RATES_COPY(rates_for_feedback, (*body_rates));
298 
299  //If there is a lot of noise on the gyroscope, it might be good to use the filtered value for feedback.
300  //Note that due to the delay, the PD controller can not be as aggressive.
301 #if STABILIZATION_INDI_FILTER_ROLL_RATE
302  rates_for_feedback.p = indi.rate[0].o[0];
303 #endif
304 #if STABILIZATION_INDI_FILTER_PITCH_RATE
305  rates_for_feedback.q = indi.rate[1].o[0];
306 #endif
307 #if STABILIZATION_INDI_FILTER_YAW_RATE
308  rates_for_feedback.r = indi.rate[2].o[0];
309 #endif
310 
312  - indi.reference_acceleration.rate_p * rates_for_feedback.p;
313 
315  - indi.reference_acceleration.rate_q * rates_for_feedback.q;
316 
317  //This separates the P and D controller and lets you impose a maximum yaw rate.
318  float rate_ref_r = indi.reference_acceleration.err_r * QUAT1_FLOAT_OF_BFP(att_err->qz)/indi.reference_acceleration.rate_r;
319  BoundAbs(rate_ref_r, indi.attitude_max_yaw_rate);
320  indi.angular_accel_ref.r = indi.reference_acceleration.rate_r * (rate_ref_r - rates_for_feedback.r);
321 
322  /* Check if we are running the rate controller and overwrite */
323  if(rate_control) {
324  indi.angular_accel_ref.p = indi.reference_acceleration.rate_p * ((float)radio_control.values[RADIO_ROLL] / MAX_PPRZ * indi.max_rate - body_rates->p);
325  indi.angular_accel_ref.q = indi.reference_acceleration.rate_q * ((float)radio_control.values[RADIO_PITCH] / MAX_PPRZ * indi.max_rate - body_rates->q);
326  indi.angular_accel_ref.r = indi.reference_acceleration.rate_r * ((float)radio_control.values[RADIO_YAW] / MAX_PPRZ * indi.max_rate - body_rates->r);
327  }
328 
329  //Increment in angular acceleration requires increment in control input
330  //G1 is the control effectiveness. In the yaw axis, we need something additional: G2.
331  //It takes care of the angular acceleration caused by the change in rotation rate of the propellers
332  //(they have significant inertia, see the paper mentioned in the header for more explanation)
333  indi.du.p = 1.0 / indi.g1.p * (indi.angular_accel_ref.p - indi.rate_d[0]);
334  indi.du.q = 1.0 / indi.g1.q * (indi.angular_accel_ref.q - indi.rate_d[1]);
335  indi.du.r = 1.0 / (indi.g1.r + indi.g2) * (indi.angular_accel_ref.r - indi.rate_d[2] + indi.g2 * indi.du.r);
336 
337  //add the increment to the total control input
338  indi.u_in.p = indi.u[0].o[0] + indi.du.p;
339  indi.u_in.q = indi.u[1].o[0] + indi.du.q;
340  indi.u_in.r = indi.u[2].o[0] + indi.du.r;
341 
342  //bound the total control input
343  Bound(indi.u_in.p, -4500, 4500);
344  Bound(indi.u_in.q, -4500, 4500);
345  Bound(indi.u_in.r, -4500, 4500);
346 
347  //Propagate input filters
348  //first order actuator dynamics
349  indi.u_act_dyn.p = indi.u_act_dyn.p + STABILIZATION_INDI_ACT_DYN_P * (indi.u_in.p - indi.u_act_dyn.p);
350  indi.u_act_dyn.q = indi.u_act_dyn.q + STABILIZATION_INDI_ACT_DYN_Q * (indi.u_in.q - indi.u_act_dyn.q);
351  indi.u_act_dyn.r = indi.u_act_dyn.r + STABILIZATION_INDI_ACT_DYN_R * (indi.u_in.r - indi.u_act_dyn.r);
352 
353  //Don't increment if thrust is off
354  //TODO: this should be something more elegant, but without this the inputs
355  //will increment to the maximum before even getting in the air.
356  if (stabilization_cmd[COMMAND_THRUST] < 300) {
357  FLOAT_RATES_ZERO(indi.du);
359  FLOAT_RATES_ZERO(indi.u_in);
360  } else {
361  // only run the estimation if the commands are not zero.
362  lms_estimation();
363  }
364 
365  /* INDI feedback */
366  indi_commands[COMMAND_ROLL] = indi.u_in.p;
367  indi_commands[COMMAND_PITCH] = indi.u_in.q;
368  indi_commands[COMMAND_YAW] = indi.u_in.r;
369 }
370 
377 void stabilization_indi_run(bool in_flight __attribute__((unused)), bool rate_control)
378 {
379  /* attitude error */
380  struct Int32Quat att_err;
381  struct Int32Quat *att_quat = stateGetNedToBodyQuat_i();
382  int32_quat_inv_comp(&att_err, att_quat, &stab_att_sp_quat);
383  /* wrap it in the shortest direction */
384  int32_quat_wrap_shortest(&att_err);
385  int32_quat_normalize(&att_err);
386 
387  /* compute the INDI command */
389 
390  /* copy the INDI command */
391  stabilization_cmd[COMMAND_ROLL] = stabilization_att_indi_cmd[COMMAND_ROLL];
392  stabilization_cmd[COMMAND_PITCH] = stabilization_att_indi_cmd[COMMAND_PITCH];
393  stabilization_cmd[COMMAND_YAW] = stabilization_att_indi_cmd[COMMAND_YAW];
394 
395  /* bound the result */
396  BoundAbs(stabilization_cmd[COMMAND_ROLL], MAX_PPRZ);
397  BoundAbs(stabilization_cmd[COMMAND_PITCH], MAX_PPRZ);
398  BoundAbs(stabilization_cmd[COMMAND_YAW], MAX_PPRZ);
399 }
400 
406 void stabilization_indi_read_rc(bool in_flight, bool in_carefree, bool coordinated_turn)
407 {
408  struct FloatQuat q_sp;
409 #if USE_EARTH_BOUND_RC_SETPOINT
410  stabilization_attitude_read_rc_setpoint_quat_earth_bound_f(&q_sp, in_flight, in_carefree, coordinated_turn);
411 #else
412  stabilization_attitude_read_rc_setpoint_quat_f(&q_sp, in_flight, in_carefree, coordinated_turn);
413 #endif
415 }
416 
423 static inline void lms_estimation(void)
424 {
425  static struct IndiEstimation *est = &indi.est;
426  // Only pass really low frequencies so you don't adapt to noise
427  struct FloatRates *body_rates = stateGetBodyRates_f();
428  filter_pqr(est->u, &indi.u_act_dyn);
429  filter_pqr(est->rate, body_rates);
430 
431  // Calculate the first and second derivatives of the rates and actuators
432  float rate_d_prev[3];
433  float u_d_prev[3];
434  float_vect_copy(rate_d_prev, est->rate_d, 3);
435  float_vect_copy(u_d_prev, est->u_d, 3);
437  finite_difference_from_filter(est->u_d, est->u);
438  finite_difference(est->rate_dd, est->rate_d, rate_d_prev);
439  finite_difference(est->u_dd, est->u_d, u_d_prev);
440 
441  // The inputs are scaled in order to avoid overflows
442  float du[3];
443  float_vect_copy(du, est->u_d, 3);
445  est->g1.p = est->g1.p - (est->g1.p * du[0] - est->rate_dd[0]) * du[0] * est->mu;
446  est->g1.q = est->g1.q - (est->g1.q * du[1] - est->rate_dd[1]) * du[1] * est->mu;
447  float ddu = est->u_dd[2] * INDI_EST_SCALE / PERIODIC_FREQUENCY;
448  float error = (est->g1.r * du[2] + est->g2 * ddu - est->rate_dd[2]);
449  est->g1.r = est->g1.r - error * du[2] * est->mu / 3;
450  est->g2 = est->g2 - error * 1000 * ddu * est->mu / 3;
451 
452  //the g values should be larger than zero, otherwise there is positive feedback, the command will go to max and there is nothing to learn anymore...
453  if (est->g1.p < 0.01) { est->g1.p = 0.01; }
454  if (est->g1.q < 0.01) { est->g1.q = 0.01; }
455  if (est->g1.r < 0.01) { est->g1.r = 0.01; }
456  if (est->g2 < 0.01) { est->g2 = 0.01; }
457 
458  if (indi.adaptive) {
459  //Commit the estimated G values and apply the scaling
460  indi.g1.p = est->g1.p * INDI_EST_SCALE;
461  indi.g1.q = est->g1.q * INDI_EST_SCALE;
462  indi.g1.r = est->g1.r * INDI_EST_SCALE;
463  indi.g2 = est->g2 * INDI_EST_SCALE;
464  }
465 }
int32_t psi
in rad with INT32_ANGLE_FRAC
struct Int32Quat stab_att_sp_quat
with INT32_QUAT_FRAC
static float update_butterworth_2_low_pass(Butterworth2LowPass *filter, float value)
Update second order Butterworth low pass filter state with a new value.
#define STABILIZATION_INDI_MAX_R
void stabilization_attitude_read_rc_setpoint_quat_f(struct FloatQuat *q_sp, bool in_flight, bool in_carefree, bool coordinated_turn)
Read attitude setpoint from RC as quaternion Interprets the stick positions as axes.
static void init_butterworth_2_low_pass(Butterworth2LowPass *filter, float tau, float sample_time, float value)
Init a second order Butterworth filter.
static void int32_quat_normalize(struct Int32Quat *q)
normalize a quaternion inplace
bool adaptive
Enable adataptive estimation.
void int32_quat_inv_comp(struct Int32Quat *b2c, struct Int32Quat *a2b, struct Int32Quat *a2c)
Composition (multiplication) of two quaternions.
struct ReferenceSystem reference_acceleration
#define STABILIZATION_INDI_MAX_RATE
static void indi_init_filters(void)
#define RADIO_ROLL
Definition: spektrum_arch.h:43
Quaternion transformation functions.
struct FloatRates du
#define RADIO_YAW
Definition: spektrum_arch.h:45
struct FloatRates g1
void stabilization_indi_read_rc(bool in_flight, bool in_carefree, bool coordinated_turn)
This function reads rc commands.
static void send_att_indi(struct transport_tx *trans, struct link_device *dev)
Periodic telemetry system header (includes downlink utility and generated code).
General attitude stabilization interface for rotorcrafts.
#define INDI_EST_SCALE
void stabilization_indi_enter(void)
Function that resets important values upon engaging INDI.
int32_t theta
in rad with INT32_ANGLE_FRAC
struct FloatRates u_in
static void send_ahrs_ref_quat(struct transport_tx *trans, struct link_device *dev)
void int32_quat_of_eulers(struct Int32Quat *q, struct Int32Eulers *e)
Quaternion from Euler angles.
int32_t stabilization_attitude_get_heading_i(void)
float r
in rad/s
Read an attitude setpoint from the RC.
float max_rate
Maximum rate in rate control in rad/s.
static void filter_pqr(Butterworth2LowPass *filter, struct FloatRates *new_values)
Update butterworth filter for p, q and r of a FloatRates struct.
#define FLOAT_RATES_ZERO(_r)
void stabilization_indi_set_failsafe_setpoint(void)
Function that calculates the failsafe setpoint.
float q
in rad/s
float p
in rad/s
pprz_t values[RADIO_CONTROL_NB_CHANNEL]
Definition: radio_control.h:58
static struct Int32Quat * stateGetNedToBodyQuat_i(void)
Get vehicle body attitude quaternion (int).
Definition: state.h:1113
#define FALSE
Definition: std.h:5
void stabilization_indi_init(void)
Function that initializes important values upon engaging INDI.
float o[2]
output history
Roation quaternion.
static void stabilization_indi_calc_cmd(int32_t indi_commands[], struct Int32Quat *att_err, bool rate_control)
Does the INDI calculations.
void stabilization_attitude_read_rc_setpoint_quat_earth_bound_f(struct FloatQuat *q_sp, bool in_flight, bool in_carefree, bool coordinated_turn)
static void finite_difference(float output[3], float new[3], float old[3])
Calculate derivative of an array via finite difference.
void stabilization_indi_run(bool in_flight, bool rate_control)
runs stabilization indi
#define PPRZ_ITRIG_SIN(_s, _a)
#define TRUE
Definition: std.h:4
#define STABILIZATION_INDI_FILT_CUTOFF_R
struct IndiVariables indi
static float heading
Definition: ahrs_infrared.c:45
Butterworth2LowPass rate[3]
Butterworth2LowPass rate[3]
#define RADIO_PITCH
Definition: spektrum_arch.h:44
euler angles
static int32_t stabilization_att_indi_cmd[COMMANDS_NB]
#define QUAT_BFP_OF_REAL(_qi, _qf)
Definition: pprz_algebra.h:696
#define DefaultPeriodic
Set default periodic telemetry.
Definition: telemetry.h:66
static void lms_estimation(void)
This is a Least Mean Squares adaptive filter It estimates the actuator effectiveness online...
struct IndiEstimation est
Estimation parameters for adaptive INDI.
struct Int32Eulers stab_att_sp_euler
with INT32_ANGLE_FRAC
#define STABILIZATION_INDI_ESTIMATION_FILT_CUTOFF
struct RadioControl radio_control
Definition: radio_control.c:30
static void finite_difference_from_filter(float *output, Butterworth2LowPass *filter)
Caclulate finite difference form a filter array The filter already contains the previous values...
void quat_from_earth_cmd_i(struct Int32Quat *quat, struct Int32Vect2 *cmd, int32_t heading)
#define RATES_SMUL(_ro, _ri, _s)
Definition: pprz_algebra.h:378
void stabilization_indi_set_rpy_setpoint_i(struct Int32Eulers *rpy)
Set attitude quaternion setpoint from rpy.
static struct FloatRates * stateGetBodyRates_f(void)
Get vehicle body angular rate (float).
Definition: state.h:1200
signed long int32_t
Definition: types.h:19
#define QUAT1_FLOAT_OF_BFP(_qi)
static const struct usb_device_descriptor dev
Definition: usb_ser_hw.c:73
#define INT32_TRIG_FRAC
#define STABILIZATION_INDI_FILT_CUTOFF
void stabilization_indi_set_earth_cmd_i(struct Int32Vect2 *cmd, int32_t heading)
Set attitude setpoint from command in earth axes.
int32_t phi
in rad with INT32_ANGLE_FRAC
struct FloatRates angular_accel_ref
API to get/set the generic vehicle states.
Butterworth2LowPass u[3]
static void float_vect_scale(float *a, const float s, const int n)
a *= s
static void int32_quat_wrap_shortest(struct Int32Quat *q)
static void float_vect_copy(float *a, const float *b, const int n)
a = b
int32_t stabilization_cmd[COMMANDS_NB]
Stabilization commands.
Definition: stabilization.c:28
#define RATES_COPY(_a, _b)
Definition: pprz_algebra.h:336
Second order low pass filter structure.
#define MAX_PPRZ
Definition: paparazzi.h:8
float attitude_max_yaw_rate
Maximum yaw rate in atttiude control in rad/s.
Butterworth2LowPass u[3]
signed char int8_t
Definition: types.h:15
static struct Int32Eulers * stateGetNedToBodyEulers_i(void)
Get vehicle body attitude euler angles (int).
Definition: state.h:1125
Rotation quaternion.
angular rates
struct FloatRates u_act_dyn
int8_t register_periodic_telemetry(struct periodic_telemetry *_pt, uint8_t _id, telemetry_cb _cb)
Register a telemetry callback function.
Definition: telemetry.c:46
struct FloatRates g1
#define PPRZ_ITRIG_COS(_c, _a)