88 lines
4.0 KiB
C
88 lines
4.0 KiB
C
/*
|
|
* Copyright © 2014 Kosma Moczek <kosma@cloudyourcar.com>
|
|
* This program is free software. It comes without any warranty, to the extent
|
|
* permitted by applicable law. You can redistribute it and/or modify it under
|
|
* the terms of the Do What The Fuck You Want To Public License, Version 2, as
|
|
* published by Sam Hocevar. See the COPYING file for more details.
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <ctype.h>
|
|
|
|
#include "minmea.h"
|
|
|
|
int main()
|
|
{
|
|
char line[MINMEA_MAX_LENGTH];
|
|
while (fgets(line, sizeof(line), stdin) != NULL) {
|
|
printf("%s", line);
|
|
switch (minmea_sentence_id(line)) {
|
|
case MINMEA_SENTENCE_RMC: {
|
|
struct minmea_sentence_rmc frame;
|
|
if (minmea_parse_rmc(&frame, line)) {
|
|
printf("$xxRMC: raw coordinates and speed: (%d/%d,%d/%d) %d/%d\n",
|
|
frame.latitude.value, frame.latitude.scale,
|
|
frame.longitude.value, frame.longitude.scale,
|
|
frame.speed.value, frame.speed.scale);
|
|
printf("$xxRMC fixed-point coordinates and speed scaled to three decimal places: (%d,%d) %d\n",
|
|
minmea_rescale(&frame.latitude, 1000),
|
|
minmea_rescale(&frame.longitude, 1000),
|
|
minmea_rescale(&frame.speed, 1000));
|
|
printf("$xxRMC floating point degree coordinates and speed: (%f,%f) %f\n",
|
|
minmea_tocoord(&frame.latitude),
|
|
minmea_tocoord(&frame.longitude),
|
|
minmea_tofloat(&frame.speed));
|
|
}
|
|
} break;
|
|
|
|
case MINMEA_SENTENCE_GGA: {
|
|
struct minmea_sentence_gga frame;
|
|
if (minmea_parse_gga(&frame, line)) {
|
|
printf("$xxGGA: fix quality: %d\n", frame.fix_quality);
|
|
}
|
|
} break;
|
|
|
|
case MINMEA_SENTENCE_GST: {
|
|
struct minmea_sentence_gst frame;
|
|
if (minmea_parse_gst(&frame, line)) {
|
|
printf("$xxGST: raw latitude,longitude and altitude error deviation: (%d/%d,%d/%d,%d/%d)\n",
|
|
frame.latitude_error_deviation.value, frame.latitude_error_deviation.scale,
|
|
frame.longitude_error_deviation.value, frame.longitude_error_deviation.scale,
|
|
frame.altitude_error_deviation.value, frame.altitude_error_deviation.scale);
|
|
printf("$xxGST fixed point latitude,longitude and altitude error deviation \
|
|
scaled to one decimal place: (%d,%d,%d)\n",
|
|
minmea_rescale(&frame.latitude_error_deviation, 10),
|
|
minmea_rescale(&frame.longitude_error_deviation, 10),
|
|
minmea_rescale(&frame.altitude_error_deviation, 10));
|
|
printf("$xxGST floating point degree latitude, longitude and altitude error deviation: (%f,%f,%f)",
|
|
minmea_tofloat(&frame.latitude_error_deviation),
|
|
minmea_tofloat(&frame.longitude_error_deviation),
|
|
minmea_tofloat(&frame.altitude_error_deviation));
|
|
}
|
|
} break;
|
|
|
|
case MINMEA_SENTENCE_GSV: {
|
|
struct minmea_sentence_gsv frame;
|
|
if (minmea_parse_gsv(&frame, line)) {
|
|
printf("$xxGSV: message %d of %d\n", frame.msg_nr, frame.total_msgs);
|
|
printf("$xxGSV: sattelites in view: %d\n", frame.total_sats);
|
|
for (int i = 0; i < 4; i++)
|
|
printf("$xxGSV: sat nr %d, elevation: %d, azimuth: %d, snr: %d dbm\n",
|
|
frame.sats[i].nr,
|
|
frame.sats[i].elevation,
|
|
frame.sats[i].azimuth,
|
|
frame.sats[i].snr);
|
|
}
|
|
} break;
|
|
|
|
default: {
|
|
} break;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* vim: set ts=4 sw=4 et: */
|