Paparazzi UAS  v6.1.0_stable
Paparazzi is a free software Unmanned Aircraft System.
gps_datalink.c
Go to the documentation of this file.
1 
2 /*
3  * Copyright (C) 2014 Freek van Tienen
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 
31 #include "generated/flight_plan.h" // reference lla NAV_XXX0
32 
33 #include "modules/gps/gps.h"
34 #include "modules/core/abi.h"
35 #include "modules/imu/imu.h"
36 #include "modules/datalink/datalink.h"
37 #include "modules/datalink/downlink.h"
38 
40 #ifndef GPS_DATALINK_USE_MAG
41 #define GPS_DATALINK_USE_MAG 1
42 #endif
43 PRINT_CONFIG_VAR(GPS_DATALINK_USE_MAG)
44 
45 struct LtpDef_i ltp_def;
46 
47 struct GpsState gps_datalink;
48 
50 void gps_datalink_init(void)
51 {
52  gps_datalink.fix = GPS_FIX_NONE;
53  gps_datalink.pdop = 10;
54  gps_datalink.sacc = 5;
55  gps_datalink.pacc = 1;
56  gps_datalink.cacc = 1;
57 
58  gps_datalink.comp_id = GPS_DATALINK_ID;
59 
60  struct LlaCoor_i llh_nav0; /* Height above the ellipsoid */
61  llh_nav0.lat = NAV_LAT0;
62  llh_nav0.lon = NAV_LON0;
63  /* NAV_ALT0 = ground alt above msl, NAV_MSL0 = geoid-height (msl) over ellipsoid */
64  llh_nav0.alt = NAV_ALT0 + NAV_MSL0;
65 
66  ltp_def_from_lla_i(&ltp_def, &llh_nav0);
67 }
68 
69 // Send GPS heading info as magnetometer messages
70 static void send_magnetometer(int32_t course, uint32_t now_ts)
71 {
72  struct Int32Vect3 mag;
73  struct FloatVect3 mag_real;
74  // course from gps in [0, 2*Pi]*1e7 (CW/north)
75  float heading = course/1e7;
76  mag_real.x = cos(heading);
77  mag_real.y = -sin(heading);
78  mag_real.z = 0;
79  MAGS_BFP_OF_REAL(mag, mag_real);
80 
81  // update IMU information
82  VECT3_COPY(imu.mag_unscaled, mag);
83  imu_scale_mag(&imu);
84 
85  // Send fake ABI for GPS, Magnetometer and Optical Flow for GPS fusion
86  AbiSendMsgIMU_MAG_INT32(MAG_DATALINK_SENDER_ID, now_ts, &mag);
87 }
88 
89 // Parse the REMOTE_GPS_SMALL datalink packet
90 static void parse_gps_datalink_small(int16_t heading, uint32_t pos_xyz, uint32_t speed_xyz, uint32_t tow)
91 {
92  struct EnuCoor_i enu_pos, enu_speed;
93 
94  // Position in ENU coordinates
95  enu_pos.x = (int32_t)((pos_xyz >> 21) & 0x7FF); // bits 31-21 x position in cm
96  if (enu_pos.x & 0x400) {
97  enu_pos.x |= 0xFFFFF800; // sign extend for twos complements
98  }
99  enu_pos.y = (int32_t)((pos_xyz >> 10) & 0x7FF); // bits 20-10 y position in cm
100  if (enu_pos.y & 0x400) {
101  enu_pos.y |= 0xFFFFF800; // sign extend for twos complements
102  }
103  enu_pos.z = (int32_t)(pos_xyz & 0x3FF); // bits 9-0 z position in cm
104 
105  // Convert the ENU coordinates to ECEF
106  ecef_of_enu_point_i(&gps_datalink.ecef_pos, &ltp_def, &enu_pos);
107  SetBit(gps_datalink.valid_fields, GPS_VALID_POS_ECEF_BIT);
108 
109  lla_of_ecef_i(&gps_datalink.lla_pos, &gps_datalink.ecef_pos);
110  SetBit(gps_datalink.valid_fields, GPS_VALID_POS_LLA_BIT);
111 
112  enu_speed.x = (int32_t)((speed_xyz >> 21) & 0x7FF); // bits 31-21 speed x in cm/s
113  if (enu_speed.x & 0x400) {
114  enu_speed.x |= 0xFFFFF800; // sign extend for twos complements
115  }
116  enu_speed.y = (int32_t)((speed_xyz >> 10) & 0x7FF); // bits 20-10 speed y in cm/s
117  if (enu_speed.y & 0x400) {
118  enu_speed.y |= 0xFFFFF800; // sign extend for twos complements
119  }
120  enu_speed.z = (int32_t)((speed_xyz) & 0x3FF); // bits 9-0 speed z in cm/s
121  if (enu_speed.z & 0x200) {
122  enu_speed.z |= 0xFFFFFC00; // sign extend for twos complements
123  }
124 
125  VECT3_NED_OF_ENU(gps_datalink.ned_vel, enu_speed);
126  SetBit(gps_datalink.valid_fields, GPS_VALID_VEL_NED_BIT);
127 
128  ecef_of_enu_vect_i(&gps_datalink.ecef_vel , &ltp_def , &enu_speed);
129  SetBit(gps_datalink.valid_fields, GPS_VALID_VEL_ECEF_BIT);
130 
131  gps_datalink.gspeed = (int16_t)FLOAT_VECT2_NORM(enu_speed);
132  gps_datalink.speed_3d = (int16_t)FLOAT_VECT3_NORM(enu_speed);
133 
134  gps_datalink.hmsl = ltp_def.hmsl + enu_pos.z * 10;
135  SetBit(gps_datalink.valid_fields, GPS_VALID_HMSL_BIT);
136 
137  gps_datalink.course = ((int32_t)heading) * 1e3;
138  SetBit(gps_datalink.valid_fields, GPS_VALID_COURSE_BIT);
139 
140  gps_datalink.num_sv = 30;
141  gps_datalink.tow = tow;
142  gps_datalink.fix = GPS_FIX_3D; // set 3D fix to true
143 
144  // set gps msg time
145  gps_datalink.last_msg_ticks = sys_time.nb_sec_rem;
146  gps_datalink.last_msg_time = sys_time.nb_sec;
147 
148  gps_datalink.last_3dfix_ticks = sys_time.nb_sec_rem;
149  gps_datalink.last_3dfix_time = sys_time.nb_sec;
150 
151  // publish new GPS data
152  uint32_t now_ts = get_sys_time_usec();
153  AbiSendMsgGPS(GPS_DATALINK_ID, now_ts, &gps_datalink);
154 }
155 
157 static void parse_gps_datalink(uint8_t numsv, int32_t ecef_x, int32_t ecef_y, int32_t ecef_z,
158  int32_t lat, int32_t lon, int32_t alt, int32_t hmsl,
159  int32_t ecef_xd, int32_t ecef_yd, int32_t ecef_zd,
160  uint32_t tow, int32_t course)
161 {
162  gps_datalink.lla_pos.lat = lat;
163  gps_datalink.lla_pos.lon = lon;
164  gps_datalink.lla_pos.alt = alt;
165  SetBit(gps_datalink.valid_fields, GPS_VALID_POS_LLA_BIT);
166 
167  gps_datalink.hmsl = hmsl;
168  SetBit(gps_datalink.valid_fields, GPS_VALID_HMSL_BIT);
169 
170  gps_datalink.ecef_pos.x = ecef_x;
171  gps_datalink.ecef_pos.y = ecef_y;
172  gps_datalink.ecef_pos.z = ecef_z;
173  SetBit(gps_datalink.valid_fields, GPS_VALID_POS_ECEF_BIT);
174 
175  gps_datalink.ecef_vel.x = ecef_xd;
176  gps_datalink.ecef_vel.y = ecef_yd;
177  gps_datalink.ecef_vel.z = ecef_zd;
178  SetBit(gps_datalink.valid_fields, GPS_VALID_VEL_ECEF_BIT);
179 
180  ned_of_ecef_vect_i(&gps_datalink.ned_vel, &ltp_def , &gps_datalink.ecef_vel);
181  SetBit(gps_datalink.valid_fields, GPS_VALID_VEL_NED_BIT);
182 
183  gps_datalink.gspeed = (int16_t)FLOAT_VECT2_NORM(gps_datalink.ned_vel);
184  gps_datalink.speed_3d = (int16_t)FLOAT_VECT3_NORM(gps_datalink.ned_vel);
185 
186  gps_datalink.course = course;
187  SetBit(gps_datalink.valid_fields, GPS_VALID_COURSE_BIT);
188 
189  gps_datalink.num_sv = numsv;
190  gps_datalink.tow = tow;
191  gps_datalink.fix = GPS_FIX_3D;
192 
193  // set gps msg time
194  gps_datalink.last_msg_ticks = sys_time.nb_sec_rem;
195  gps_datalink.last_msg_time = sys_time.nb_sec;
196 
197  gps_datalink.last_3dfix_ticks = sys_time.nb_sec_rem;
198  gps_datalink.last_3dfix_time = sys_time.nb_sec;
199 
200  uint32_t now_ts = get_sys_time_usec();
201 
202  // if selected, publish magnetometer data
203  #if GPS_DATALINK_USE_MAG
204  send_magnetometer(course, now_ts);
205  #endif
206 
207  // publish new GPS data
208  AbiSendMsgGPS(GPS_DATALINK_ID, now_ts, &gps_datalink);
209 }
210 
212 static void parse_gps_datalink_local(float enu_x, float enu_y, float enu_z,
213  float enu_xd, float enu_yd, float enu_zd,
214  uint32_t tow, float course)
215 {
216 
217  struct EnuCoor_i enu_pos, enu_speed;
218 
219  // Position in ENU coordinates
220  enu_pos.x = (int32_t)CM_OF_M(enu_x);
221  enu_pos.y = (int32_t)CM_OF_M(enu_y);
222  enu_pos.z = (int32_t)CM_OF_M(enu_z);
223 
224  // Convert the ENU coordinates to ECEF
225  ecef_of_enu_point_i(&gps_datalink.ecef_pos, &ltp_def, &enu_pos);
226  SetBit(gps_datalink.valid_fields, GPS_VALID_POS_ECEF_BIT);
227 
228  lla_of_ecef_i(&gps_datalink.lla_pos, &gps_datalink.ecef_pos);
229  SetBit(gps_datalink.valid_fields, GPS_VALID_POS_LLA_BIT);
230 
231  enu_speed.x = (int32_t)CM_OF_M(enu_xd);
232  enu_speed.y = (int32_t)CM_OF_M(enu_yd);
233  enu_speed.z = (int32_t)CM_OF_M(enu_zd);
234 
235  VECT3_NED_OF_ENU(gps_datalink.ned_vel, enu_speed);
236  SetBit(gps_datalink.valid_fields, GPS_VALID_VEL_NED_BIT);
237 
238  ecef_of_enu_vect_i(&gps_datalink.ecef_vel , &ltp_def , &enu_speed);
239  SetBit(gps_datalink.valid_fields, GPS_VALID_VEL_ECEF_BIT);
240 
241  gps_datalink.gspeed = (int16_t)FLOAT_VECT2_NORM(enu_speed);
242  gps_datalink.speed_3d = (int16_t)FLOAT_VECT3_NORM(enu_speed);
243 
244  gps_datalink.hmsl = ltp_def.hmsl + enu_pos.z * 10;
245  SetBit(gps_datalink.valid_fields, GPS_VALID_HMSL_BIT);
246 
247  gps_datalink.course = (int32_t)(RadOfDeg(course)*1e7);
248  SetBit(gps_datalink.valid_fields, GPS_VALID_COURSE_BIT);
249 
250  gps_datalink.num_sv = 7;
251  gps_datalink.tow = tow;
252  gps_datalink.fix = GPS_FIX_3D; // set 3D fix to true
253 
254  // set gps msg time
255  gps_datalink.last_msg_ticks = sys_time.nb_sec_rem;
256  gps_datalink.last_msg_time = sys_time.nb_sec;
257 
258  gps_datalink.last_3dfix_ticks = sys_time.nb_sec_rem;
259  gps_datalink.last_3dfix_time = sys_time.nb_sec;
260 
261  uint32_t now_ts = get_sys_time_usec();
262 
263  // if selected, publish magnetometer data
264  #if GPS_DATALINK_USE_MAG
265  send_magnetometer(course, now_ts);
266  #endif
267 
268  // Publish GPS data
269  AbiSendMsgGPS(GPS_DATALINK_ID, now_ts, &gps_datalink);
270 }
271 
272 void gps_datalink_parse_REMOTE_GPS(uint8_t *buf)
273 {
274  if (DL_REMOTE_GPS_ac_id(buf) != AC_ID) { return; } // not for this aircraft
275 
276  parse_gps_datalink(DL_REMOTE_GPS_numsv(buf),
277  DL_REMOTE_GPS_ecef_x(buf),
278  DL_REMOTE_GPS_ecef_y(buf),
279  DL_REMOTE_GPS_ecef_z(buf),
280  DL_REMOTE_GPS_lat(buf),
281  DL_REMOTE_GPS_lon(buf),
282  DL_REMOTE_GPS_alt(buf),
283  DL_REMOTE_GPS_hmsl(buf),
284  DL_REMOTE_GPS_ecef_xd(buf),
285  DL_REMOTE_GPS_ecef_yd(buf),
286  DL_REMOTE_GPS_ecef_zd(buf),
287  DL_REMOTE_GPS_tow(buf),
288  DL_REMOTE_GPS_course(buf));
289 }
290 
291 void gps_datalink_parse_REMOTE_GPS_SMALL(uint8_t *buf)
292 {
293  if (DL_REMOTE_GPS_SMALL_ac_id(buf) != AC_ID) { return; } // not for this aircraft
294 
295  parse_gps_datalink_small(DL_REMOTE_GPS_SMALL_heading(buf),
296  DL_REMOTE_GPS_SMALL_pos_xyz(buf),
297  DL_REMOTE_GPS_SMALL_speed_xyz(buf),
298  DL_REMOTE_GPS_SMALL_tow(buf));
299 }
300 
301 void gps_datalink_parse_REMOTE_GPS_LOCAL(uint8_t *buf)
302 {
303  if (DL_REMOTE_GPS_LOCAL_ac_id(buf) != AC_ID) { return; } // not for this aircraft
304 
305  parse_gps_datalink_local(DL_REMOTE_GPS_LOCAL_enu_x(buf),
306  DL_REMOTE_GPS_LOCAL_enu_y(buf),
307  DL_REMOTE_GPS_LOCAL_enu_z(buf),
308  DL_REMOTE_GPS_LOCAL_enu_xd(buf),
309  DL_REMOTE_GPS_LOCAL_enu_yd(buf),
310  DL_REMOTE_GPS_LOCAL_enu_zd(buf),
311  DL_REMOTE_GPS_LOCAL_tow(buf),
312  DL_REMOTE_GPS_LOCAL_course(buf));
313 }
LlaCoor_i::lon
int32_t lon
in degrees*1e7
Definition: pprz_geodetic_int.h:61
GpsState::valid_fields
uint8_t valid_fields
bitfield indicating valid fields (GPS_VALID_x_BIT)
Definition: gps.h:88
uint32_t
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.
Definition: vl53l1_types.h:78
uint8_t
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.
Definition: vl53l1_types.h:98
VECT3_NED_OF_ENU
#define VECT3_NED_OF_ENU(_o, _i)
Definition: pprz_geodetic_int.h:150
GPS_DATALINK_ID
#define GPS_DATALINK_ID
Definition: abi_sender_ids.h:256
LlaCoor_i::alt
int32_t alt
in millimeters above WGS84 reference ellipsoid
Definition: pprz_geodetic_int.h:62
GPS_VALID_COURSE_BIT
#define GPS_VALID_COURSE_BIT
Definition: gps.h:54
MAG_DATALINK_SENDER_ID
#define MAG_DATALINK_SENDER_ID
Definition: abi_sender_ids.h:217
abi.h
EnuCoor_i::y
int32_t y
North.
Definition: pprz_geodetic_int.h:79
lla_of_ecef_i
void lla_of_ecef_i(struct LlaCoor_i *out, struct EcefCoor_i *in)
Convert a ECEF to LLA.
Definition: pprz_geodetic_int.c:363
EnuCoor_i::x
int32_t x
East.
Definition: pprz_geodetic_int.h:78
GpsState::tow
uint32_t tow
GPS time of week in ms.
Definition: gps.h:109
LtpDef_i
definition of the local (flat earth) coordinate system
Definition: pprz_geodetic_int.h:98
send_magnetometer
static void send_magnetometer(int32_t course, uint32_t now_ts)
Definition: gps_datalink.c:70
GpsState
data structure for GPS information
Definition: gps.h:87
EcefCoor_i::x
int32_t x
in centimeters
Definition: pprz_geodetic_int.h:51
GpsState::pacc
uint32_t pacc
position accuracy in cm
Definition: gps.h:100
GpsState::sacc
uint32_t sacc
speed accuracy in cm/s
Definition: gps.h:103
ecef_of_enu_vect_i
void ecef_of_enu_vect_i(struct EcefCoor_i *ecef, struct LtpDef_i *def, struct EnuCoor_i *enu)
Rotate a vector from ENU to ECEF.
Definition: pprz_geodetic_int.c:199
FLOAT_VECT3_NORM
#define FLOAT_VECT3_NORM(_v)
Definition: pprz_algebra_float.h:164
gps_datalink_parse_REMOTE_GPS_SMALL
void gps_datalink_parse_REMOTE_GPS_SMALL(uint8_t *buf)
Definition: gps_datalink.c:291
GpsState::ned_vel
struct NedCoor_i ned_vel
speed NED in cm/s
Definition: gps.h:96
EcefCoor_i::y
int32_t y
in centimeters
Definition: pprz_geodetic_int.h:52
GPS_VALID_POS_LLA_BIT
#define GPS_VALID_POS_LLA_BIT
Definition: gps.h:49
get_sys_time_usec
uint32_t get_sys_time_usec(void)
Get the time in microseconds since startup.
Definition: sys_time_arch.c:71
FloatVect3
Definition: pprz_algebra_float.h:54
LlaCoor_i::lat
int32_t lat
in degrees*1e7
Definition: pprz_geodetic_int.h:60
imu.h
int16_t
short int16_t
Typedef defining 16 bit short type.
Definition: vl53l1_types.h:93
GpsState::last_msg_ticks
uint32_t last_msg_ticks
cpu time ticks at last received GPS message
Definition: gps.h:116
EcefCoor_i::z
int32_t z
in centimeters
Definition: pprz_geodetic_int.h:53
gps.h
Device independent GPS code (interface)
GpsState::fix
uint8_t fix
status of fix
Definition: gps.h:107
GpsState::speed_3d
uint16_t speed_3d
norm of 3d speed in cm/s
Definition: gps.h:98
FLOAT_VECT2_NORM
#define FLOAT_VECT2_NORM(_v)
Definition: pprz_algebra_float.h:132
ltp_def
struct LtpDef_i ltp_def
Definition: gps_datalink.c:45
Int32Vect3
Definition: pprz_algebra_int.h:88
gps_datalink_parse_REMOTE_GPS_LOCAL
void gps_datalink_parse_REMOTE_GPS_LOCAL(uint8_t *buf)
Definition: gps_datalink.c:301
GpsState::gspeed
uint16_t gspeed
norm of 2d ground speed in cm/s
Definition: gps.h:97
gps_datalink_parse_REMOTE_GPS
void gps_datalink_parse_REMOTE_GPS(uint8_t *buf)
Definition: gps_datalink.c:272
parse_gps_datalink_small
static void parse_gps_datalink_small(int16_t heading, uint32_t pos_xyz, uint32_t speed_xyz, uint32_t tow)
Definition: gps_datalink.c:90
GpsState::last_3dfix_time
uint32_t last_3dfix_time
cpu time in sec at last valid 3D fix
Definition: gps.h:115
GpsState::last_3dfix_ticks
uint32_t last_3dfix_ticks
cpu time ticks at last valid 3D fix
Definition: gps.h:114
parse_gps_datalink
static void parse_gps_datalink(uint8_t numsv, int32_t ecef_x, int32_t ecef_y, int32_t ecef_z, int32_t lat, int32_t lon, int32_t alt, int32_t hmsl, int32_t ecef_xd, int32_t ecef_yd, int32_t ecef_zd, uint32_t tow, int32_t course)
Parse the REMOTE_GPS datalink packet.
Definition: gps_datalink.c:157
ned_of_ecef_vect_i
void ned_of_ecef_vect_i(struct NedCoor_i *ned, struct LtpDef_i *def, struct EcefCoor_i *ecef)
Rotate a vector from ECEF to NED.
Definition: pprz_geodetic_int.c:186
GpsState::comp_id
uint8_t comp_id
id of current gps
Definition: gps.h:89
ltp_def_from_lla_i
void ltp_def_from_lla_i(struct LtpDef_i *def, struct LlaCoor_i *lla)
Definition: pprz_geodetic_int.c:72
imu
struct Imu imu
global IMU state
Definition: imu.c:108
FloatVect3::y
float y
Definition: pprz_algebra_float.h:56
GpsState::course
int32_t course
GPS course over ground in rad*1e7, [0, 2*Pi]*1e7 (CW/north)
Definition: gps.h:99
GpsState::last_msg_time
uint32_t last_msg_time
cpu time in sec at last received GPS message
Definition: gps.h:117
GpsState::ecef_pos
struct EcefCoor_i ecef_pos
position in ECEF in cm
Definition: gps.h:91
course
static int16_t course[3]
Definition: airspeed_uADC.c:58
int32_t
int int32_t
Typedef defining 32 bit int type.
Definition: vl53l1_types.h:83
GPS_VALID_VEL_NED_BIT
#define GPS_VALID_VEL_NED_BIT
Definition: gps.h:52
LlaCoor_i
vector in Latitude, Longitude and Altitude
Definition: pprz_geodetic_int.h:59
FloatVect3::x
float x
Definition: pprz_algebra_float.h:55
gps_datalink_init
void gps_datalink_init(void)
GPS initialization.
Definition: gps_datalink.c:50
GpsState::lla_pos
struct LlaCoor_i lla_pos
position in LLA (lat,lon: deg*1e7; alt: mm over ellipsoid)
Definition: gps.h:92
LtpDef_i::hmsl
int32_t hmsl
Height above mean sea level in mm.
Definition: pprz_geodetic_int.h:102
CM_OF_M
#define CM_OF_M(_m)
Definition: pprz_geodetic_int.h:131
GPS_VALID_VEL_ECEF_BIT
#define GPS_VALID_VEL_ECEF_BIT
Definition: gps.h:51
imu_scale_mag
void imu_scale_mag(struct Imu *_imu)
Definition: ahrs_gx3.c:352
sys_time
Definition: sys_time.h:67
GpsState::num_sv
uint8_t num_sv
number of sat in fix
Definition: gps.h:106
sys_time::nb_sec_rem
volatile uint32_t nb_sec_rem
remainder of seconds since startup in CPU_TICKS
Definition: sys_time.h:69
parse_gps_datalink_local
static void parse_gps_datalink_local(float enu_x, float enu_y, float enu_z, float enu_xd, float enu_yd, float enu_zd, uint32_t tow, float course)
Parse the REMOTE_GPS_LOCAL datalink packet.
Definition: gps_datalink.c:212
GpsState::hmsl
int32_t hmsl
height above mean sea level (MSL) in mm
Definition: gps.h:94
gps_datalink
struct GpsState gps_datalink
Definition: gps_datalink.c:47
GPS_DATALINK_USE_MAG
#define GPS_DATALINK_USE_MAG
Set to 1 to receive also magnetometer ABI messages.
Definition: gps_datalink.c:41
GpsState::pdop
uint16_t pdop
position dilution of precision scaled by 100
Definition: gps.h:105
ecef_of_enu_point_i
void ecef_of_enu_point_i(struct EcefCoor_i *ecef, struct LtpDef_i *def, struct EnuCoor_i *enu)
Convert a point in local ENU to ECEF.
Definition: pprz_geodetic_int.c:238
Imu::mag_unscaled
struct Int32Vect3 mag_unscaled
unscaled magnetometer measurements
Definition: imu.h:48
FloatVect3::z
float z
Definition: pprz_algebra_float.h:57
GPS_VALID_POS_ECEF_BIT
#define GPS_VALID_POS_ECEF_BIT
Definition: gps.h:48
GpsState::cacc
uint32_t cacc
course accuracy in rad*1e7
Definition: gps.h:104
EnuCoor_i::z
int32_t z
Up.
Definition: pprz_geodetic_int.h:80
sys_time::nb_sec
volatile uint32_t nb_sec
full seconds since startup
Definition: sys_time.h:68
GpsState::ecef_vel
struct EcefCoor_i ecef_vel
speed ECEF in cm/s
Definition: gps.h:95
GPS_FIX_NONE
#define GPS_FIX_NONE
No GPS fix.
Definition: gps.h:37
GPS_FIX_3D
#define GPS_FIX_3D
3D GPS fix
Definition: gps.h:39
EnuCoor_i
vector in East North Up coordinates
Definition: pprz_geodetic_int.h:77
GPS_VALID_HMSL_BIT
#define GPS_VALID_HMSL_BIT
Definition: gps.h:53
VECT3_COPY
#define VECT3_COPY(_a, _b)
Definition: pprz_algebra.h:140
MAGS_BFP_OF_REAL
#define MAGS_BFP_OF_REAL(_ef, _ei)
Definition: pprz_algebra.h:813
heading
float heading
Definition: wedgebug.c:258