46#define NMEA_PRINT(...) {};
49#if NMEA_PRINT == printf
80 struct link_device *
dev = &((NMEA_GPS_LINK).device);
86 while (
dev->char_available(
dev->periph)) {
135 bool msg_valid =
false;
141 }
else if (
gps_nmea.msg_len > 5 && !strncmp(&
gps_nmea.msg_buf[2] ,
"GGA", 3)) {
145 }
else if (
gps_nmea.msg_len > 5 && !strncmp(&
gps_nmea.msg_buf[2] ,
"GSA", 3)) {
149 }
else if (
gps_nmea.msg_len > 5 && !strncmp(&
gps_nmea.msg_buf[2] ,
"GSV", 3)) {
205 NMEA_PRINT(
"nmea_parse_char: skipping incomplete msg: len=%i, \"%s\"\n\r",
218 NMEA_PRINT(
"nmea_parse_char: msg too long, len=%i, \"%s\"\n\r",
232 NMEA_PRINT(
"nmea_parse_char: this should not happen!");
248 for (it = 0; it < buff_sz; ++it) {
267 NMEA_PRINT(
"p_GSA() - skipping empty message\n\r");
287 for (prn_cnt = 0; prn_cnt < 12; prn_cnt++) {
289 int prn = atoi(&
gps_nmea.msg_buf[i]);
290 NMEA_PRINT(
"p_GSA() - PRN %i=%i\n\r", satcount, prn);
292 gps_nmea.state.svinfos[prn_cnt].svid = prn;
298 gps_nmea.state.svinfos[prn_cnt].svid = 0;
305 float pdop = strtof(&
gps_nmea.msg_buf[i], NULL);
311 float hdop __attribute__((unused)) = strtof(&
gps_nmea.msg_buf[i], NULL);
316 float vdop __attribute__((unused)) = strtof(&
gps_nmea.msg_buf[i], NULL);
336 NMEA_PRINT(
"p_RMC() - skipping empty message\n\r");
358 double speed = strtod(&
gps_nmea.msg_buf[i], NULL);
359 gps_nmea.state.gspeed = speed * 1.852 * 100 / (60 * 60);
360 NMEA_PRINT(
"p_RMC() - ground-speed=%f knot = %d cm/s\n\r", speed, (
gps_nmea.state.gspeed * 1000));
383 double degrees, minutesfrac;
388 NMEA_PRINT(
"p_GGA() - skipping empty message\n\r");
395 double utc_time = strtod(&
gps_nmea.msg_buf[i], NULL);
402 minutesfrac = modf(
lat / 100, °rees);
403 lat = degrees + (minutesfrac * 100) / 60;
412 lla_f.
lat = RadOfDeg(
lat);
421 minutesfrac = modf(
lon / 100, °rees);
422 lon = degrees + (minutesfrac * 100) / 60;
431 lla_f.
lon = RadOfDeg(
lon);
441 NMEA_PRINT(
"p_GGA() - POS_AVAILABLE == TRUE\n\r");
443 NMEA_PRINT(
"p_GGA() - gps_pos_available == false\n\r");
458 float hmsl = strtof(&
gps_nmea.msg_buf[i], NULL);
468 float geoid = strtof(&
gps_nmea.msg_buf[i], NULL);
469 NMEA_PRINT(
"p_GGA() - geoid alt=%f\n\r", geoid);
471 lla_f.
alt = hmsl + geoid;
484 gps_nmea.state.ecef_pos.x = ecef_f.
x * 100;
485 gps_nmea.state.ecef_pos.y = ecef_f.
y * 100;
486 gps_nmea.state.ecef_pos.z = ecef_f.
z * 100;
504 NMEA_PRINT(
"p_GSV() - skipping empty message\n\r");
511 bool is_glonass =
false;
512 if (!strncmp(&
gps_nmea.msg_buf[0] ,
"GL", 2)) {
517 int nb_sen __attribute__((unused)) = atoi(&
gps_nmea.msg_buf[i]);
518 NMEA_PRINT(
"p_GSV() - %i sentences\n\r", nb_sen);
522 int cur_sen = atoi(&
gps_nmea.msg_buf[i]);
523 NMEA_PRINT(
"p_GSV() - sentence=%i\n\r", cur_sen);
527 int num_sat __attribute__((unused)) = atoi(&
gps_nmea.msg_buf[i]);
528 NMEA_PRINT(
"p_GSV() - num_sat=%i\n\r", num_sat);
533 for (sat_cnt = 0; sat_cnt < 4; sat_cnt++) {
534 if (
gps_nmea.msg_buf[i] ==
',')
break;
536 int prn = atoi(&
gps_nmea.msg_buf[i]);
538 int elev = atoi(&
gps_nmea.msg_buf[i]);
540 int azim = atoi(&
gps_nmea.msg_buf[i]);
542 int snr = atoi(&
gps_nmea.msg_buf[i]);
545 int ch_idx = (cur_sen - 1) * 4 + sat_cnt;
547 if (!is_glonass && ch_idx > 0 && ch_idx < 12) {
548 gps_nmea.state.svinfos[ch_idx].svid = prn;
549 gps_nmea.state.svinfos[ch_idx].cno = snr;
550 gps_nmea.state.svinfos[ch_idx].elev = elev;
551 gps_nmea.state.svinfos[ch_idx].azim = azim;
554 NMEA_PRINT(
"p_GSV() - GLONASS %i PRN=%i elev=%i azim=%i snr=%i\n\r", ch_idx, prn, elev, azim, snr);
557 NMEA_PRINT(
"p_GSV() - GPS %i PRN=%i elev=%i azim=%i snr=%i\n\r", ch_idx, prn, elev, azim, snr);
Main include for ABI (AirBorneInterface).
uint32_t get_sys_time_usec(void)
Get the time in microseconds since startup.
static struct uart_periph * dev
Device independent GPS code (interface).
#define GPS_VALID_POS_LLA_BIT
#define GPS_VALID_POS_ECEF_BIT
#define GPS_VALID_HMSL_BIT
#define GPS_FIX_3D
3D GPS fix
#define GPS_VALID_COURSE_BIT
static bool nmea_parse_RMC(void)
Parse RMC NMEA messages.
bool nmea_parse_msg(void)
nmea_parse_char() has a complete line.
static bool nmea_parse_GSV(void)
Parse GSV-nmea-messages.
bool WEAK nmea_parse_prop_msg(void)
uint8_t nmea_calc_crc(const char *buff, int buff_sz)
Calculate control sum of binary buffer.
static bool nmea_parse_GSA(void)
Parse GSA NMEA messages.
void gps_nmea_event(void)
void WEAK nmea_parse_prop_init(void)
void WEAK nmea_configure(void)
The function to be called when a characted from the device is available.
void nmea_parse_char(uint8_t c)
This is the actual parser.
static bool nmea_parse_GGA(void)
Parse GGA NMEA messages.
NMEA protocol specific code.
#define GPS_NMEA_NB_CHANNELS
static void nmea_read_until(int *i)
Read until a certain character, placed here for proprietary includes.
arch independent LED (Light Emitting Diodes) API
void ecef_of_lla_f(struct EcefCoor_f *out, struct LlaCoor_f *in)
Paparazzi floating point math for geodetic calculations.
float alt
in meters (normally above WGS84 reference ellipsoid)
vector in EarthCenteredEarthFixed coordinates
vector in Latitude, Longitude and Altitude
volatile uint32_t nb_sec
full seconds since startup
volatile uint32_t nb_sec_rem
remainder of seconds since startup in CPU_TICKS
unsigned int uint32_t
Typedef defining 32 bit unsigned int type.
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.