Paparazzi UAS  v5.18.0_stable
Paparazzi is a free software Unmanned Aircraft System.
ahrs_int_cmpl_quat_wrapper.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) 2015 Felix Ruess <felix.ruess@gmail.com>
3  *
4  * This file is part of paparazzi.
5  *
6  * paparazzi is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2, or (at your option)
9  * any later version.
10  *
11  * paparazzi is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with Paparazzi; see the file COPYING. If not, see
18  * <http://www.gnu.org/licenses/>.
19  */
20 
28 #include "subsystems/ahrs.h"
29 #include "subsystems/abi.h"
30 #include "state.h"
31 
32 #ifndef AHRS_ICQ_OUTPUT_ENABLED
33 #define AHRS_ICQ_OUTPUT_ENABLED TRUE
34 #endif
35 PRINT_CONFIG_VAR(AHRS_ICQ_OUTPUT_ENABLED)
36 
37 
41 
42 static void set_body_state_from_quat(void);
43 
44 #if PERIODIC_TELEMETRY
46 #include "mcu_periph/sys_time.h"
47 #include "state.h"
48 
49 static void send_quat(struct transport_tx *trans, struct link_device *dev)
50 {
51  struct Int32Quat *quat = stateGetNedToBodyQuat_i();
52  pprz_msg_send_AHRS_QUAT_INT(trans, dev, AC_ID,
58  &(quat->qi),
59  &(quat->qx),
60  &(quat->qy),
61  &(quat->qz),
62  &ahrs_icq_id);
63 }
64 
65 static void send_euler(struct transport_tx *trans, struct link_device *dev)
66 {
67  struct Int32Eulers ltp_to_imu_euler;
68  int32_eulers_of_quat(&ltp_to_imu_euler, &ahrs_icq.ltp_to_imu_quat);
69  struct Int32Eulers *eulers = stateGetNedToBodyEulers_i();
70  pprz_msg_send_AHRS_EULER_INT(trans, dev, AC_ID,
71  &ltp_to_imu_euler.phi,
72  &ltp_to_imu_euler.theta,
73  &ltp_to_imu_euler.psi,
74  &(eulers->phi),
75  &(eulers->theta),
76  &(eulers->psi),
77  &ahrs_icq_id);
78 }
79 
80 static void send_bias(struct transport_tx *trans, struct link_device *dev)
81 {
82  pprz_msg_send_AHRS_GYRO_BIAS_INT(trans, dev, AC_ID,
85 }
86 
87 static void send_geo_mag(struct transport_tx *trans, struct link_device *dev)
88 {
89  struct FloatVect3 h_float;
90  h_float.x = MAG_FLOAT_OF_BFP(ahrs_icq.mag_h.x);
91  h_float.y = MAG_FLOAT_OF_BFP(ahrs_icq.mag_h.y);
92  h_float.z = MAG_FLOAT_OF_BFP(ahrs_icq.mag_h.z);
93  pprz_msg_send_GEO_MAG(trans, dev, AC_ID,
94  &h_float.x, &h_float.y, &h_float.z, &ahrs_icq_id);
95 }
96 
97 static void send_filter_status(struct transport_tx *trans, struct link_device *dev)
98 {
99  uint8_t mde = 3;
100  uint16_t val = 0;
101  if (!ahrs_icq.is_aligned) { mde = 2; }
103  /* set lost if no new gyro measurements for 50ms */
104  if (t_diff > 50000) { mde = 5; }
105  pprz_msg_send_STATE_FILTER_STATUS(trans, dev, AC_ID, &ahrs_icq_id, &mde, &val);
106 }
107 #endif
108 
109 
113 #ifndef AHRS_ICQ_IMU_ID
114 #define AHRS_ICQ_IMU_ID ABI_BROADCAST
115 #endif
116 PRINT_CONFIG_VAR(AHRS_ICQ_IMU_ID)
120 #ifndef AHRS_ICQ_MAG_ID
121 #define AHRS_ICQ_MAG_ID AHRS_ICQ_IMU_ID
122 #endif
123 PRINT_CONFIG_VAR(AHRS_ICQ_MAG_ID)
127 #ifndef AHRS_ICQ_GPS_ID
128 #define AHRS_ICQ_GPS_ID GPS_MULTI_ID
129 #endif
130 PRINT_CONFIG_VAR(AHRS_ICQ_GPS_ID)
138 
139 
140 static void gyro_cb(uint8_t __attribute__((unused)) sender_id,
141  uint32_t stamp, struct Int32Rates *gyro)
142 {
143  ahrs_icq_last_stamp = stamp;
144 #if USE_AUTO_AHRS_FREQ || !defined(AHRS_PROPAGATE_FREQUENCY)
145  PRINT_CONFIG_MSG("Calculating dt for AHRS_ICQ propagation.")
146  /* timestamp in usec when last callback was received */
147  static uint32_t last_stamp = 0;
148 
149  if (last_stamp > 0 && ahrs_icq.is_aligned) {
150  float dt = (float)(stamp - last_stamp) * 1e-6;
151  ahrs_icq_propagate(gyro, dt);
153  }
154  last_stamp = stamp;
155 #else
156  PRINT_CONFIG_MSG("Using fixed AHRS_PROPAGATE_FREQUENCY for AHRS_ICQ propagation.")
157  PRINT_CONFIG_VAR(AHRS_PROPAGATE_FREQUENCY)
159  const float dt = 1. / (AHRS_PROPAGATE_FREQUENCY);
160  ahrs_icq_propagate(gyro, dt);
162  }
163 #endif
164 }
165 
166 static void accel_cb(uint8_t __attribute__((unused)) sender_id,
167  uint32_t __attribute__((unused)) stamp,
168  struct Int32Vect3 *accel)
169 {
170 #if USE_AUTO_AHRS_FREQ || !defined(AHRS_CORRECT_FREQUENCY)
171  PRINT_CONFIG_MSG("Calculating dt for AHRS int_cmpl_quat accel update.")
172  static uint32_t last_stamp = 0;
173  if (last_stamp > 0 && ahrs_icq.is_aligned) {
174  float dt = (float)(stamp - last_stamp) * 1e-6;
175  ahrs_icq_update_accel(accel, dt);
177  }
178  last_stamp = stamp;
179 #else
180  PRINT_CONFIG_MSG("Using fixed AHRS_CORRECT_FREQUENCY for AHRS int_cmpl_quat accel update.")
181  PRINT_CONFIG_VAR(AHRS_CORRECT_FREQUENCY)
182  if (ahrs_icq.is_aligned) {
183  const float dt = 1. / (AHRS_CORRECT_FREQUENCY);
184  ahrs_icq_update_accel(accel, dt);
186  }
187 #endif
188 }
189 
190 static void mag_cb(uint8_t __attribute__((unused)) sender_id,
191  uint32_t __attribute__((unused)) stamp,
192  struct Int32Vect3 *mag)
193 {
194 #if USE_AUTO_AHRS_FREQ || !defined(AHRS_MAG_CORRECT_FREQUENCY)
195  PRINT_CONFIG_MSG("Calculating dt for AHRS int_cmpl_quat mag update.")
196  static uint32_t last_stamp = 0;
197  if (last_stamp > 0 && ahrs_icq.is_aligned) {
198  float dt = (float)(stamp - last_stamp) * 1e-6;
199  ahrs_icq_update_mag(mag, dt);
201  }
202  last_stamp = stamp;
203 #else
204  PRINT_CONFIG_MSG("Using fixed AHRS_MAG_CORRECT_FREQUENCY for AHRS int_cmpl_quat mag update.")
205  PRINT_CONFIG_VAR(AHRS_MAG_CORRECT_FREQUENCY)
206  if (ahrs_icq.is_aligned) {
207  const float dt = 1. / (AHRS_MAG_CORRECT_FREQUENCY);
208  ahrs_icq_update_mag(mag, dt);
210  }
211 #endif
212 }
213 
214 static void aligner_cb(uint8_t __attribute__((unused)) sender_id,
215  uint32_t stamp __attribute__((unused)),
216  struct Int32Rates *lp_gyro, struct Int32Vect3 *lp_accel,
217  struct Int32Vect3 *lp_mag)
218 {
219  if (!ahrs_icq.is_aligned) {
220  if (ahrs_icq_align(lp_gyro, lp_accel, lp_mag)) {
222  }
223  }
224 }
225 
226 static void body_to_imu_cb(uint8_t sender_id __attribute__((unused)),
227  struct FloatQuat *q_b2i_f)
228 {
230 }
231 
232 static void geo_mag_cb(uint8_t sender_id __attribute__((unused)), struct FloatVect3 *h)
233 {
235  MAG_BFP_OF_REAL(h->z));
236 }
237 
238 static void gps_cb(uint8_t sender_id __attribute__((unused)),
239  uint32_t stamp __attribute__((unused)),
240  struct GpsState *gps_s)
241 {
242  ahrs_icq_update_gps(gps_s);
243 }
244 
245 static bool ahrs_icq_enable_output(bool enable)
246 {
247  ahrs_icq_output_enabled = enable;
249 }
250 
252 static void set_body_state_from_quat(void)
253 {
255  /* Compute LTP to BODY quaternion */
256  struct Int32Quat ltp_to_body_quat;
257  struct Int32Quat *body_to_imu_quat = orientationGetQuat_i(&ahrs_icq.body_to_imu);
258  int32_quat_comp_inv(&ltp_to_body_quat, &ahrs_icq.ltp_to_imu_quat, body_to_imu_quat);
259  /* Set state */
260  stateSetNedToBodyQuat_i(&ltp_to_body_quat);
261 
262  /* compute body rates */
263  struct Int32Rates body_rate;
264  struct Int32RMat *body_to_imu_rmat = orientationGetRMat_i(&ahrs_icq.body_to_imu);
265  int32_rmat_transp_ratemult(&body_rate, body_to_imu_rmat, &ahrs_icq.imu_rate);
266  /* Set state */
267  stateSetBodyRates_i(&body_rate);
268  }
269 }
270 
272 {
274  ahrs_icq_init();
276 
277  /*
278  * Subscribe to scaled IMU measurements and attach callbacks
279  */
280  AbiBindMsgIMU_GYRO_INT32(AHRS_ICQ_IMU_ID, &gyro_ev, gyro_cb);
281  AbiBindMsgIMU_ACCEL_INT32(AHRS_ICQ_IMU_ID, &accel_ev, accel_cb);
282  AbiBindMsgIMU_MAG_INT32(AHRS_ICQ_MAG_ID, &mag_ev, mag_cb);
283  AbiBindMsgIMU_LOWPASSED(ABI_BROADCAST, &aligner_ev, aligner_cb);
284  AbiBindMsgBODY_TO_IMU_QUAT(ABI_BROADCAST, &body_to_imu_ev, body_to_imu_cb);
285  AbiBindMsgGEO_MAG(ABI_BROADCAST, &geo_mag_ev, geo_mag_cb);
286  AbiBindMsgGPS(AHRS_ICQ_GPS_ID, &gps_ev, gps_cb);
287 
288 #if PERIODIC_TELEMETRY
289  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_AHRS_QUAT_INT, send_quat);
290  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_AHRS_EULER_INT, send_euler);
291  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_AHRS_GYRO_BIAS_INT, send_bias);
293  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_STATE_FILTER_STATUS, send_filter_status);
294 #endif
295 }
Int32Eulers::theta
int32_t theta
in rad with INT32_ANGLE_FRAC
Definition: pprz_algebra_int.h:148
set_body_state_from_quat
static void set_body_state_from_quat(void)
Rotate angles and rates from imu to body frame and set state.
Definition: ahrs_int_cmpl_quat_wrapper.c:252
uint16_t
unsigned short uint16_t
Definition: types.h:16
AhrsIntCmplQuat::body_to_imu
struct OrientationReps body_to_imu
Definition: ahrs_int_cmpl_quat.h:101
val
uint16_t val[TCOUPLE_NB]
Definition: temp_tcouple_adc.c:49
ahrs_icq_init
void ahrs_icq_init(void)
Definition: ahrs_int_cmpl_quat.c:115
aligner_cb
static void aligner_cb(uint8_t sender_id, uint32_t stamp, struct Int32Rates *lp_gyro, struct Int32Vect3 *lp_accel, struct Int32Vect3 *lp_mag)
Definition: ahrs_int_cmpl_quat_wrapper.c:214
AHRS_COMP_ID_ICQ
#define AHRS_COMP_ID_ICQ
Definition: ahrs.h:35
Int32RMat
rotation matrix
Definition: pprz_algebra_int.h:159
geo_mag_cb
static void geo_mag_cb(uint8_t sender_id, struct FloatVect3 *h)
Definition: ahrs_int_cmpl_quat_wrapper.c:232
Int32Rates
angular rates
Definition: pprz_algebra_int.h:179
h
static void h(const real32_T x[7], const real32_T q[4], real32_T y[6])
Definition: UKF_Wind_Estimator.c:821
abi.h
Int32Rates::q
int32_t q
in rad/s with INT32_RATE_FRAC
Definition: pprz_algebra_int.h:181
gps_ev
static abi_event gps_ev
Definition: ahrs_int_cmpl_quat_wrapper.c:137
Int32Vect3::z
int32_t z
Definition: pprz_algebra_int.h:91
Int32Quat
Rotation quaternion.
Definition: pprz_algebra_int.h:99
GpsState
data structure for GPS information
Definition: gps.h:87
MAG_FLOAT_OF_BFP
#define MAG_FLOAT_OF_BFP(_ai)
Definition: pprz_algebra_int.h:223
send_quat
static void send_quat(struct transport_tx *trans, struct link_device *dev)
Definition: ahrs_int_cmpl_quat_wrapper.c:49
stateGetNedToBodyQuat_i
static struct Int32Quat * stateGetNedToBodyQuat_i(void)
Get vehicle body attitude quaternion (int).
Definition: state.h:1113
abi_struct
Event structure to store callbacks in a linked list.
Definition: abi_common.h:65
AHRS_ICQ_RUNNING
@ AHRS_ICQ_RUNNING
Definition: ahrs_int_cmpl_quat.h:42
uint32_t
unsigned long uint32_t
Definition: types.h:18
orientationGetQuat_i
static struct Int32Quat * orientationGetQuat_i(struct OrientationReps *orientation)
Get vehicle body attitude quaternion (int).
Definition: pprz_orientation_conversion.h:198
send_bias
static void send_bias(struct transport_tx *trans, struct link_device *dev)
Definition: ahrs_int_cmpl_quat_wrapper.c:80
ahrs_int_cmpl_quat_wrapper.h
AhrsIntCmplQuat::status
enum AhrsICQStatus status
status of the AHRS, AHRS_ICQ_UNINIT or AHRS_ICQ_RUNNING
Definition: ahrs_int_cmpl_quat.h:103
int32_eulers_of_quat
void int32_eulers_of_quat(struct Int32Eulers *e, struct Int32Quat *q)
Definition: pprz_algebra_int.c:523
ahrs_icq_output_enabled
static bool ahrs_icq_output_enabled
if TRUE with push the estimation results to the state interface
Definition: ahrs_int_cmpl_quat_wrapper.c:38
ahrs_icq_last_stamp
static uint32_t ahrs_icq_last_stamp
Definition: ahrs_int_cmpl_quat_wrapper.c:39
ahrs_icq_propagate
void ahrs_icq_propagate(struct Int32Rates *gyro, float dt)
Definition: ahrs_int_cmpl_quat.c:187
int32_quat_comp_inv
void int32_quat_comp_inv(struct Int32Quat *a2b, struct Int32Quat *a2c, struct Int32Quat *b2c)
Composition (multiplication) of two quaternions.
Definition: pprz_algebra_int.c:277
get_sys_time_usec
uint32_t get_sys_time_usec(void)
Get the time in microseconds since startup.
Definition: sys_time_arch.c:68
geo_mag_ev
static abi_event geo_mag_ev
Definition: ahrs_int_cmpl_quat_wrapper.c:136
FloatVect3
Definition: pprz_algebra_float.h:54
ahrs_icq_update_gps
void ahrs_icq_update_gps(struct GpsState *gps_s)
Definition: ahrs_int_cmpl_quat.c:529
Int32Rates::p
int32_t p
in rad/s with INT32_RATE_FRAC
Definition: pprz_algebra_int.h:180
telemetry.h
FloatQuat
Roation quaternion.
Definition: pprz_algebra_float.h:63
stateSetBodyRates_i
static void stateSetBodyRates_i(struct Int32Rates *body_rate)
Set vehicle body angular rate (int).
Definition: state.h:1173
AhrsIntCmplQuat::weight
float weight
Definition: ahrs_int_cmpl_quat.h:60
Int32Eulers::psi
int32_t psi
in rad with INT32_ANGLE_FRAC
Definition: pprz_algebra_int.h:149
AhrsIntCmplQuat::gyro_bias
struct Int32Rates gyro_bias
Definition: ahrs_int_cmpl_quat.h:49
Int32Eulers::phi
int32_t phi
in rad with INT32_ANGLE_FRAC
Definition: pprz_algebra_int.h:147
MAG_BFP_OF_REAL
#define MAG_BFP_OF_REAL(_af)
Definition: pprz_algebra_int.h:222
dev
static const struct usb_device_descriptor dev
Definition: usb_ser_hw.c:74
mag_cb
static void mag_cb(uint8_t sender_id, uint32_t stamp, struct Int32Vect3 *mag)
Definition: ahrs_int_cmpl_quat_wrapper.c:190
AhrsIntCmplQuat::ltp_to_imu_quat
struct Int32Quat ltp_to_imu_quat
Definition: ahrs_int_cmpl_quat.h:54
Int32Quat::qz
int32_t qz
Definition: pprz_algebra_int.h:103
body_to_imu_cb
static void body_to_imu_cb(uint8_t sender_id, struct FloatQuat *q_b2i_f)
Definition: ahrs_int_cmpl_quat_wrapper.c:226
Int32Vect3
Definition: pprz_algebra_int.h:88
sys_time.h
Architecture independent timing functions.
uint8_t
unsigned char uint8_t
Definition: types.h:14
ahrs_icq_enable_output
static bool ahrs_icq_enable_output(bool enable)
Definition: ahrs_int_cmpl_quat_wrapper.c:245
stateSetNedToBodyQuat_i
static void stateSetNedToBodyQuat_i(struct Int32Quat *ned_to_body_quat)
Set vehicle body attitude from quaternion (int).
Definition: state.h:1075
send_euler
static void send_euler(struct transport_tx *trans, struct link_device *dev)
Definition: ahrs_int_cmpl_quat_wrapper.c:65
register_periodic_telemetry
int8_t register_periodic_telemetry(struct periodic_telemetry *_pt, uint8_t _id, telemetry_cb _cb)
Register a telemetry callback function.
Definition: telemetry.c:46
AHRS_ICQ_MAG_ID
#define AHRS_ICQ_MAG_ID
ABI binding for magnetometer data.
Definition: ahrs_int_cmpl_quat_wrapper.c:121
Int32Vect3::y
int32_t y
Definition: pprz_algebra_int.h:90
Int32Eulers
euler angles
Definition: pprz_algebra_int.h:146
AhrsIntCmplQuat::mag_h
struct Int32Vect3 mag_h
Definition: ahrs_int_cmpl_quat.h:55
mag_ev
static abi_event mag_ev
Definition: ahrs_int_cmpl_quat_wrapper.c:133
Int32Quat::qi
int32_t qi
Definition: pprz_algebra_int.h:100
ahrs.h
accel_ev
static abi_event accel_ev
Definition: ahrs_int_cmpl_quat_wrapper.c:132
FloatVect3::y
float y
Definition: pprz_algebra_float.h:56
gyro_ev
static abi_event gyro_ev
Definition: ahrs_int_cmpl_quat_wrapper.c:131
PRINT_CONFIG_MSG
PRINT_CONFIG_MSG("USE_INS_NAV_INIT defaulting to TRUE")
ahrs_icq_register
void ahrs_icq_register(void)
Definition: ahrs_int_cmpl_quat_wrapper.c:271
ahrs_icq_set_body_to_imu_quat
void ahrs_icq_set_body_to_imu_quat(struct FloatQuat *q_b2i)
Definition: ahrs_int_cmpl_quat.c:667
int32_rmat_transp_ratemult
void int32_rmat_transp_ratemult(struct Int32Rates *rb, struct Int32RMat *m_b2a, struct Int32Rates *ra)
rotate anglular rates by transposed rotation matrix.
Definition: pprz_algebra_int.c:137
Int32Quat::qy
int32_t qy
Definition: pprz_algebra_int.h:102
AHRS_ICQ_GPS_ID
#define AHRS_ICQ_GPS_ID
ABI binding for gps data.
Definition: ahrs_int_cmpl_quat_wrapper.c:128
body_to_imu_ev
static abi_event body_to_imu_ev
Definition: ahrs_int_cmpl_quat_wrapper.c:135
ahrs_icq_update_mag
void ahrs_icq_update_mag(struct Int32Vect3 *mag, float dt)
Definition: ahrs_int_cmpl_quat.c:384
AHRS_ICQ_IMU_ID
#define AHRS_ICQ_IMU_ID
ABI binding for IMU data.
Definition: ahrs_int_cmpl_quat_wrapper.c:114
FloatVect3::x
float x
Definition: pprz_algebra_float.h:55
AhrsIntCmplQuat::imu_rate
struct Int32Rates imu_rate
Definition: ahrs_int_cmpl_quat.h:50
ahrs_icq_update_accel
void ahrs_icq_update_accel(struct Int32Vect3 *accel, float dt)
Definition: ahrs_int_cmpl_quat.c:241
gps_cb
static void gps_cb(uint8_t sender_id, uint32_t stamp, struct GpsState *gps_s)
Definition: ahrs_int_cmpl_quat_wrapper.c:238
Int32Vect3::x
int32_t x
Definition: pprz_algebra_int.h:89
AhrsIntCmplQuat::is_aligned
bool is_aligned
Definition: ahrs_int_cmpl_quat.h:104
orientationGetRMat_i
static struct Int32RMat * orientationGetRMat_i(struct OrientationReps *orientation)
Get vehicle body attitude rotation matrix (int).
Definition: pprz_orientation_conversion.h:207
AHRS_PROPAGATE_FREQUENCY
#define AHRS_PROPAGATE_FREQUENCY
Definition: hf_float.c:55
send_geo_mag
static void send_geo_mag(struct transport_tx *trans, struct link_device *dev)
Definition: ahrs_int_cmpl_quat_wrapper.c:87
FloatVect3::z
float z
Definition: pprz_algebra_float.h:57
stateGetNedToBodyEulers_i
static struct Int32Eulers * stateGetNedToBodyEulers_i(void)
Get vehicle body attitude euler angles (int).
Definition: state.h:1125
ahrs_register_impl
void ahrs_register_impl(AhrsEnableOutput enable)
Register an AHRS implementation.
Definition: ahrs.c:62
state.h
VECT3_ASSIGN
#define VECT3_ASSIGN(_a, _x, _y, _z)
Definition: pprz_algebra.h:125
AHRS_ICQ_OUTPUT_ENABLED
#define AHRS_ICQ_OUTPUT_ENABLED
Definition: ahrs_int_cmpl_quat_wrapper.c:33
ahrs_icq_align
bool ahrs_icq_align(struct Int32Rates *lp_gyro, struct Int32Vect3 *lp_accel, struct Int32Vect3 *lp_mag)
Definition: ahrs_int_cmpl_quat.c:158
send_filter_status
static void send_filter_status(struct transport_tx *trans, struct link_device *dev)
Definition: ahrs_int_cmpl_quat_wrapper.c:97
gyro_cb
static void gyro_cb(uint8_t sender_id, uint32_t stamp, struct Int32Rates *gyro)
Definition: ahrs_int_cmpl_quat_wrapper.c:140
ABI_BROADCAST
#define ABI_BROADCAST
Broadcast address.
Definition: abi_common.h:56
Int32Quat::qx
int32_t qx
Definition: pprz_algebra_int.h:101
ahrs_icq_id
static uint8_t ahrs_icq_id
Definition: ahrs_int_cmpl_quat_wrapper.c:40
ahrs_icq
struct AhrsIntCmplQuat ahrs_icq
Default Rate filter Low pass.
Definition: ahrs_int_cmpl_quat.c:110
Int32Rates::r
int32_t r
in rad/s with INT32_RATE_FRAC
Definition: pprz_algebra_int.h:182
aligner_ev
static abi_event aligner_ev
Definition: ahrs_int_cmpl_quat_wrapper.c:134
DefaultPeriodic
#define DefaultPeriodic
Set default periodic telemetry.
Definition: telemetry.h:66
accel_cb
static void accel_cb(uint8_t sender_id, uint32_t stamp, struct Int32Vect3 *accel)
Definition: ahrs_int_cmpl_quat_wrapper.c:166