Paparazzi UAS  v6.2_unstable
Paparazzi is a free software Unmanned Aircraft System.
imu.c
Go to the documentation of this file.
1 /*
2  * Copyright (C) 2008-2010 The Paparazzi Team
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, write to
18  * the Free Software Foundation, 59 Temple Place - Suite 330,
19  * Boston, MA 02111-1307, USA.
20  */
21 
27 #ifdef BOARD_CONFIG
28 #include BOARD_CONFIG
29 #endif
30 
31 #include "modules/imu/imu.h"
32 #include "state.h"
33 #include "modules/core/abi.h"
34 
35 #ifdef IMU_POWER_GPIO
36 #include "mcu_periph/gpio.h"
37 
38 #ifndef IMU_POWER_GPIO_ON
39 #define IMU_POWER_GPIO_ON gpio_set
40 #endif
41 #endif
42 
43 #if PERIODIC_TELEMETRY
45 
46 static void send_accel_raw(struct transport_tx *trans, struct link_device *dev)
47 {
48  pprz_msg_send_IMU_ACCEL_RAW(trans, dev, AC_ID,
50 }
51 
52 static void send_accel_scaled(struct transport_tx *trans, struct link_device *dev)
53 {
54  pprz_msg_send_IMU_ACCEL_SCALED(trans, dev, AC_ID,
55  &imu.accel.x, &imu.accel.y, &imu.accel.z);
56 }
57 
58 static void send_accel(struct transport_tx *trans, struct link_device *dev)
59 {
60  struct FloatVect3 accel_float;
62  pprz_msg_send_IMU_ACCEL(trans, dev, AC_ID,
64 }
65 
66 static void send_gyro_raw(struct transport_tx *trans, struct link_device *dev)
67 {
68  pprz_msg_send_IMU_GYRO_RAW(trans, dev, AC_ID,
70 }
71 
72 static void send_gyro_scaled(struct transport_tx *trans, struct link_device *dev)
73 {
74  pprz_msg_send_IMU_GYRO_SCALED(trans, dev, AC_ID,
75  &imu.gyro.p, &imu.gyro.q, &imu.gyro.r);
76 }
77 
78 static void send_gyro(struct transport_tx *trans, struct link_device *dev)
79 {
80  struct FloatRates gyro_float;
81  RATES_FLOAT_OF_BFP(gyro_float, imu.gyro);
82  pprz_msg_send_IMU_GYRO(trans, dev, AC_ID,
83  &gyro_float.p, &gyro_float.q, &gyro_float.r);
84 }
85 
86 static void send_mag_raw(struct transport_tx *trans, struct link_device *dev)
87 {
88  pprz_msg_send_IMU_MAG_RAW(trans, dev, AC_ID,
90 }
91 
92 static void send_mag_scaled(struct transport_tx *trans, struct link_device *dev)
93 {
94  pprz_msg_send_IMU_MAG_SCALED(trans, dev, AC_ID,
95  &imu.mag.x, &imu.mag.y, &imu.mag.z);
96 }
97 
98 static void send_mag(struct transport_tx *trans, struct link_device *dev)
99 {
100  struct FloatVect3 mag_float;
102  pprz_msg_send_IMU_MAG(trans, dev, AC_ID,
104 }
105 
106 #endif /* PERIODIC_TELEMETRY */
107 
108 struct Imu imu;
109 
110 void imu_init(void)
111 {
112 
113 #ifdef IMU_POWER_GPIO
115  IMU_POWER_GPIO_ON(IMU_POWER_GPIO);
116 #endif
117 
118  /* initialises neutrals */
120 
122 
123 #if defined IMU_MAG_X_NEUTRAL && defined IMU_MAG_Y_NEUTRAL && defined IMU_MAG_Z_NEUTRAL
125 #else
126 #if USE_MAGNETOMETER && (!defined MAG_CALIB_UKF_H)
127  INFO("Magnetometer neutrals are set to zero, you should calibrate!")
128 #endif
130 #endif
131 
132  struct FloatEulers body_to_imu_eulers =
134  orientationSetEulers_f(&imu.body_to_imu, &body_to_imu_eulers);
135 
136 #if PERIODIC_TELEMETRY
137  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_ACCEL_RAW, send_accel_raw);
138  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_ACCEL_SCALED, send_accel_scaled);
139  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_ACCEL, send_accel);
140  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_GYRO_RAW, send_gyro_raw);
141  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_GYRO_SCALED, send_gyro_scaled);
142  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_GYRO, send_gyro);
143  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_MAG_RAW, send_mag_raw);
144  register_periodic_telemetry(DefaultPeriodic, PPRZ_MSG_ID_IMU_MAG_SCALED, send_mag_scaled);
146 #endif // DOWNLINK
147 
148 }
149 
150 
152 {
153  struct FloatEulers body_to_imu_eulers;
154  body_to_imu_eulers = *orientationGetEulers_f(&imu.body_to_imu);
155  body_to_imu_eulers.phi = phi;
156  orientationSetEulers_f(&imu.body_to_imu, &body_to_imu_eulers);
157  AbiSendMsgBODY_TO_IMU_QUAT(1, orientationGetQuat_f(&imu.body_to_imu));
158 }
159 
161 {
162  struct FloatEulers body_to_imu_eulers;
163  body_to_imu_eulers = *orientationGetEulers_f(&imu.body_to_imu);
164  body_to_imu_eulers.theta = theta;
165  orientationSetEulers_f(&imu.body_to_imu, &body_to_imu_eulers);
166  AbiSendMsgBODY_TO_IMU_QUAT(1, orientationGetQuat_f(&imu.body_to_imu));
167 }
168 
170 {
171  struct FloatEulers body_to_imu_eulers;
172  body_to_imu_eulers = *orientationGetEulers_f(&imu.body_to_imu);
173  body_to_imu_eulers.psi = psi;
174  orientationSetEulers_f(&imu.body_to_imu, &body_to_imu_eulers);
175  AbiSendMsgBODY_TO_IMU_QUAT(1, orientationGetQuat_f(&imu.body_to_imu));
176 }
177 
178 void imu_SetBodyToImuCurrent(float set)
179 {
180  imu.b2i_set_current = set;
181 
182  if (imu.b2i_set_current) {
183  // adjust imu_to_body roll and pitch by current NedToBody roll and pitch
184  struct FloatEulers body_to_imu_eulers;
185  body_to_imu_eulers = *orientationGetEulers_f(&imu.body_to_imu);
186  if (stateIsAttitudeValid()) {
187  // adjust imu_to_body roll and pitch by current NedToBody roll and pitch
188  body_to_imu_eulers.phi += stateGetNedToBodyEulers_f()->phi;
189  body_to_imu_eulers.theta += stateGetNedToBodyEulers_f()->theta;
190  orientationSetEulers_f(&imu.body_to_imu, &body_to_imu_eulers);
191  AbiSendMsgBODY_TO_IMU_QUAT(1, orientationGetQuat_f(&imu.body_to_imu));
192  } else {
193  // indicate that we couldn't set to current roll/pitch
194  imu.b2i_set_current = false;
195  }
196  } else {
197  // reset to BODY_TO_IMU as defined in airframe file
198  struct FloatEulers body_to_imu_eulers =
200  orientationSetEulers_f(&imu.body_to_imu, &body_to_imu_eulers);
201  AbiSendMsgBODY_TO_IMU_QUAT(1, orientationGetQuat_f(&imu.body_to_imu));
202  }
203 }
204 
205 
206 // weak functions, used if not explicitly provided by implementation
207 
208 void WEAK imu_scale_gyro(struct Imu *_imu)
209 {
210  RATES_COPY(_imu->gyro_prev, _imu->gyro);
211  _imu->gyro.p = ((_imu->gyro_unscaled.p - _imu->gyro_neutral.p) * IMU_GYRO_P_SIGN *
213  _imu->gyro.q = ((_imu->gyro_unscaled.q - _imu->gyro_neutral.q) * IMU_GYRO_Q_SIGN *
215  _imu->gyro.r = ((_imu->gyro_unscaled.r - _imu->gyro_neutral.r) * IMU_GYRO_R_SIGN *
217 }
218 
219 void WEAK imu_scale_accel(struct Imu *_imu)
220 {
221  VECT3_COPY(_imu->accel_prev, _imu->accel);
222  _imu->accel.x = ((_imu->accel_unscaled.x - _imu->accel_neutral.x) * IMU_ACCEL_X_SIGN *
224  _imu->accel.y = ((_imu->accel_unscaled.y - _imu->accel_neutral.y) * IMU_ACCEL_Y_SIGN *
226  _imu->accel.z = ((_imu->accel_unscaled.z - _imu->accel_neutral.z) * IMU_ACCEL_Z_SIGN *
228 }
229 
230 #if !defined SITL && defined IMU_MAG_X_CURRENT_COEF && defined IMU_MAG_Y_CURRENT_COEF && defined IMU_MAG_Z_CURRENT_COEF
232 void WEAK imu_scale_mag(struct Imu *_imu)
233 {
234  struct Int32Vect3 mag_correction;
235  mag_correction.x = (int32_t)(IMU_MAG_X_CURRENT_COEF * (float) electrical.current);
236  mag_correction.y = (int32_t)(IMU_MAG_Y_CURRENT_COEF * (float) electrical.current);
237  mag_correction.z = (int32_t)(IMU_MAG_Z_CURRENT_COEF * (float) electrical.current);
238  _imu->mag.x = (((_imu->mag_unscaled.x - mag_correction.x) - _imu->mag_neutral.x) *
240  _imu->mag.y = (((_imu->mag_unscaled.y - mag_correction.y) - _imu->mag_neutral.y) *
242  _imu->mag.z = (((_imu->mag_unscaled.z - mag_correction.z) - _imu->mag_neutral.z) *
244 }
245 #elif USE_MAGNETOMETER
246 void WEAK imu_scale_mag(struct Imu *_imu)
247 {
248  _imu->mag.x = ((_imu->mag_unscaled.x - _imu->mag_neutral.x) * IMU_MAG_X_SIGN *
250  _imu->mag.y = ((_imu->mag_unscaled.y - _imu->mag_neutral.y) * IMU_MAG_Y_SIGN *
252  _imu->mag.z = ((_imu->mag_unscaled.z - _imu->mag_neutral.z) * IMU_MAG_Z_SIGN *
254 }
255 #else
256 void WEAK imu_scale_mag(struct Imu *_imu __attribute__((unused))) {}
257 #endif /* MAG_x_CURRENT_COEF */
Imu::gyro_unscaled
struct Int32Rates gyro_unscaled
unscaled gyroscope measurements
Definition: imu.h:46
electrical.h
MAGS_FLOAT_OF_BFP
#define MAGS_FLOAT_OF_BFP(_ef, _ei)
Definition: pprz_algebra.h:807
IMU_MAG_Y_SIGN
#define IMU_MAG_Y_SIGN
Definition: imu.h:113
IMU_ACCEL_Y_SIGN
#define IMU_ACCEL_Y_SIGN
Definition: imu_apogee.h:50
IMU_GYRO_Q_SENS_DEN
#define IMU_GYRO_Q_SENS_DEN
Definition: imu_apogee.h:68
IMU_GYRO_R_SENS_DEN
#define IMU_GYRO_R_SENS_DEN
Definition: imu_apogee.h:71
IMU_GYRO_R_SIGN
#define IMU_GYRO_R_SIGN
Definition: imu_apogee.h:46
IMU_GYRO_R_SENS_NUM
#define IMU_GYRO_R_SENS_NUM
Definition: imu_apogee.h:70
abi.h
Imu::accel
struct Int32Vect3 accel
accelerometer measurements in m/s^2 in BFP with INT32_ACCEL_FRAC
Definition: imu.h:39
IMU_MAG_Y_SENS_DEN
#define IMU_MAG_Y_SENS_DEN
Definition: imu_ardrone2.h:76
IMU_GYRO_Q_SENS_NUM
#define IMU_GYRO_Q_SENS_NUM
Definition: imu_apogee.h:67
Int32Rates::q
int32_t q
in rad/s with INT32_RATE_FRAC
Definition: pprz_algebra_int.h:181
Imu::b2i_set_current
bool b2i_set_current
flag for adjusting body_to_imu via settings.
Definition: imu.h:54
Int32Vect3::z
int32_t z
Definition: pprz_algebra_int.h:91
send_gyro_scaled
static void send_gyro_scaled(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:72
IMU_GYRO_P_NEUTRAL
#define IMU_GYRO_P_NEUTRAL
Definition: imu_apogee.h:74
RATES_FLOAT_OF_BFP
#define RATES_FLOAT_OF_BFP(_rf, _ri)
Definition: pprz_algebra.h:759
imu_SetBodyToImuTheta
void imu_SetBodyToImuTheta(float theta)
Definition: imu.c:160
stateGetNedToBodyEulers_f
static struct FloatEulers * stateGetNedToBodyEulers_f(void)
Get vehicle body attitude euler angles (float).
Definition: state.h:1143
IMU_ACCEL_Y_SENS_DEN
#define IMU_ACCEL_Y_SENS_DEN
Definition: imu_apogee.h:87
send_accel_scaled
static void send_accel_scaled(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:52
gpio_setup_output
void gpio_setup_output(ioportid_t port, uint16_t gpios)
Setup one or more pins of the given GPIO port as outputs.
Definition: gpio_arch.c:33
Imu::mag_neutral
struct Int32Vect3 mag_neutral
magnetometer neutral readings (bias) in raw/unscaled units
Definition: imu.h:45
Imu::body_to_imu
struct OrientationReps body_to_imu
rotation from body to imu frame
Definition: imu.h:49
send_accel_raw
static void send_accel_raw(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:46
IMU_MAG_Y_SENS_NUM
#define IMU_MAG_Y_SENS_NUM
Definition: imu_ardrone2.h:75
IMU_MAG_X_SENS_NUM
#define IMU_MAG_X_SENS_NUM
Definition: imu_ardrone2.h:72
IMU_GYRO_Q_NEUTRAL
#define IMU_GYRO_Q_NEUTRAL
Definition: imu_apogee.h:75
IMU_BODY_TO_IMU_THETA
#define IMU_BODY_TO_IMU_THETA
Definition: imu.h:79
IMU_MAG_Z_SENS_DEN
#define IMU_MAG_Z_SENS_DEN
Definition: imu_ardrone2.h:79
IMU_GYRO_Q_SIGN
#define IMU_GYRO_Q_SIGN
Definition: imu_apogee.h:45
IMU_GYRO_P_SENS_NUM
#define IMU_GYRO_P_SENS_NUM
Definition: imu_apogee.h:64
mag_float
struct FloatVect3 mag_float
Definition: ahrs_float_dcm.c:60
imu_scale_gyro
void WEAK imu_scale_gyro(struct Imu *_imu)
Definition: imu.c:208
Imu::accel_unscaled
struct Int32Vect3 accel_unscaled
unscaled accelerometer measurements
Definition: imu.h:47
IMU_MAG_Z_SIGN
#define IMU_MAG_Z_SIGN
Definition: imu.h:114
FloatEulers::theta
float theta
in radians
Definition: pprz_algebra_float.h:86
IMU_ACCEL_X_SENS_DEN
#define IMU_ACCEL_X_SENS_DEN
Definition: imu_apogee.h:84
FloatVect3
Definition: pprz_algebra_float.h:54
send_mag
static void send_mag(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:98
Int32Rates::p
int32_t p
in rad/s with INT32_RATE_FRAC
Definition: pprz_algebra_int.h:180
telemetry.h
imu.h
imu_SetBodyToImuPhi
void imu_SetBodyToImuPhi(float phi)
Definition: imu.c:151
IMU_MAG_Z_NEUTRAL
#define IMU_MAG_Z_NEUTRAL
Definition: imu.h:98
Imu
abstract IMU interface providing fixed point interface
Definition: imu.h:37
RATES_ASSIGN
#define RATES_ASSIGN(_ra, _p, _q, _r)
Definition: pprz_algebra.h:330
IMU_ACCEL_X_SIGN
#define IMU_ACCEL_X_SIGN
Definition: imu_apogee.h:49
FloatEulers::phi
float phi
in radians
Definition: pprz_algebra_float.h:85
orientationGetQuat_f
static struct FloatQuat * orientationGetQuat_f(struct OrientationReps *orientation)
Get vehicle body attitude quaternion (float).
Definition: pprz_orientation_conversion.h:225
IMU_ACCEL_Y_NEUTRAL
#define IMU_ACCEL_Y_NEUTRAL
Definition: imu_apogee.h:94
send_mag_raw
static void send_mag_raw(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:86
IMU_MAG_X_NEUTRAL
#define IMU_MAG_X_NEUTRAL
Definition: imu.h:96
dev
static const struct usb_device_descriptor dev
Definition: usb_ser_hw.c:74
stateIsAttitudeValid
static bool stateIsAttitudeValid(void)
Test if attitudes are valid.
Definition: state.h:1067
IMU_ACCEL_Y_SENS_NUM
#define IMU_ACCEL_Y_SENS_NUM
Definition: imu_apogee.h:86
Int32Vect3
Definition: pprz_algebra_int.h:88
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:51
FloatRates::r
float r
in rad/s
Definition: pprz_algebra_float.h:96
imu_scale_accel
void WEAK imu_scale_accel(struct Imu *_imu)
Definition: imu.c:219
Int32Vect3::y
int32_t y
Definition: pprz_algebra_int.h:90
send_gyro
static void send_gyro(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:78
IMU_GYRO_R_NEUTRAL
#define IMU_GYRO_R_NEUTRAL
Definition: imu_apogee.h:76
IMU_ACCEL_Z_NEUTRAL
#define IMU_ACCEL_Z_NEUTRAL
Definition: imu_apogee.h:95
IMU_MAG_X_SENS_DEN
#define IMU_MAG_X_SENS_DEN
Definition: imu_ardrone2.h:73
orientationSetEulers_f
static void orientationSetEulers_f(struct OrientationReps *orientation, struct FloatEulers *eulers)
Set vehicle body attitude from euler angles (float).
Definition: pprz_orientation_conversion.h:189
Imu::gyro_neutral
struct Int32Rates gyro_neutral
static gyroscope bias from calibration in raw/unscaled units
Definition: imu.h:43
IMU_POWER_GPIO
#define IMU_POWER_GPIO
Definition: navstik_1.0.h:59
IMU_MAG_Z_SENS_NUM
#define IMU_MAG_Z_SENS_NUM
Definition: imu_ardrone2.h:78
imu
struct Imu imu
global IMU state
Definition: imu.c:108
FloatVect3::y
float y
Definition: pprz_algebra_float.h:56
IMU_ACCEL_Z_SENS_NUM
#define IMU_ACCEL_Z_SENS_NUM
Definition: imu_apogee.h:89
IMU_ACCEL_Z_SENS_DEN
#define IMU_ACCEL_Z_SENS_DEN
Definition: imu_apogee.h:90
FloatRates::q
float q
in rad/s
Definition: pprz_algebra_float.h:95
IMU_BODY_TO_IMU_PSI
#define IMU_BODY_TO_IMU_PSI
Definition: imu.h:80
IMU_MAG_X_SIGN
#define IMU_MAG_X_SIGN
Definition: max7456.c:99
Imu::accel_neutral
struct Int32Vect3 accel_neutral
static accelerometer bias from calibration in raw/unscaled units
Definition: imu.h:44
int32_t
int int32_t
Typedef defining 32 bit int type.
Definition: vl53l1_types.h:83
IMU_ACCEL_X_SENS_NUM
#define IMU_ACCEL_X_SENS_NUM
Definition: imu_apogee.h:83
IMU_ACCEL_Z_SIGN
#define IMU_ACCEL_Z_SIGN
Definition: imu_apogee.h:51
FloatVect3::x
float x
Definition: pprz_algebra_float.h:55
gpio.h
imu_init
void imu_init(void)
Definition: imu.c:110
IMU_ACCEL_X_NEUTRAL
#define IMU_ACCEL_X_NEUTRAL
Definition: imu_apogee.h:93
IMU_GYRO_P_SIGN
#define IMU_GYRO_P_SIGN
Definition: imu_apogee.h:44
Int32Vect3::x
int32_t x
Definition: pprz_algebra_int.h:89
send_gyro_raw
static void send_gyro_raw(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:66
Imu::accel_prev
struct Int32Vect3 accel_prev
previous accelerometer measurements
Definition: imu.h:42
Imu::mag
struct Int32Vect3 mag
magnetometer measurements scaled to 1 in BFP with INT32_MAG_FRAC
Definition: imu.h:40
Imu::mag_unscaled
struct Int32Vect3 mag_unscaled
unscaled magnetometer measurements
Definition: imu.h:48
ACCELS_FLOAT_OF_BFP
#define ACCELS_FLOAT_OF_BFP(_ef, _ei)
Definition: pprz_algebra.h:795
FloatVect3::z
float z
Definition: pprz_algebra_float.h:57
send_mag_scaled
static void send_mag_scaled(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:92
imu_SetBodyToImuCurrent
void imu_SetBodyToImuCurrent(float set)
Definition: imu.c:178
INT_VECT3_ZERO
#define INT_VECT3_ZERO(_v)
Definition: pprz_algebra_int.h:288
FloatEulers
euler angles
Definition: pprz_algebra_float.h:84
accel_float
struct FloatVect3 accel_float
Definition: ahrs_float_dcm.c:59
send_accel
static void send_accel(struct transport_tx *trans, struct link_device *dev)
Definition: imu.c:58
electrical
struct Electrical electrical
Definition: electrical.c:66
state.h
FloatEulers::psi
float psi
in radians
Definition: pprz_algebra_float.h:87
VECT3_ASSIGN
#define VECT3_ASSIGN(_a, _x, _y, _z)
Definition: pprz_algebra.h:125
RATES_COPY
#define RATES_COPY(_a, _b)
Definition: pprz_algebra.h:337
IMU_BODY_TO_IMU_PHI
#define IMU_BODY_TO_IMU_PHI
Definition: imu.h:78
IMU_GYRO_P_SENS_DEN
#define IMU_GYRO_P_SENS_DEN
Definition: imu_apogee.h:65
imu_SetBodyToImuPsi
void imu_SetBodyToImuPsi(float psi)
Definition: imu.c:169
IMU_MAG_Y_NEUTRAL
#define IMU_MAG_Y_NEUTRAL
Definition: imu.h:97
FloatRates::p
float p
in rad/s
Definition: pprz_algebra_float.h:94
imu_scale_mag
void WEAK imu_scale_mag(struct Imu *_imu)
Definition: imu.c:246
Int32Rates::r
int32_t r
in rad/s with INT32_RATE_FRAC
Definition: pprz_algebra_int.h:182
DefaultPeriodic
#define DefaultPeriodic
Set default periodic telemetry.
Definition: telemetry.h:66
Imu::gyro_prev
struct Int32Rates gyro_prev
previous gyroscope measurements
Definition: imu.h:41
VECT3_COPY
#define VECT3_COPY(_a, _b)
Definition: pprz_algebra.h:140
orientationGetEulers_f
static struct FloatEulers * orientationGetEulers_f(struct OrientationReps *orientation)
Get vehicle body attitude euler angles (float).
Definition: pprz_orientation_conversion.h:243
Electrical::current
float current
current in A
Definition: electrical.h:46
FloatRates
angular rates
Definition: pprz_algebra_float.h:93
Imu::gyro
struct Int32Rates gyro
gyroscope measurements in rad/s in BFP with INT32_RATE_FRAC
Definition: imu.h:38