example.c 4.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104
  1. /*
  2. * Copyright © 2014 Kosma Moczek <kosma@cloudyourcar.com>
  3. * This program is free software. It comes without any warranty, to the extent
  4. * permitted by applicable law. You can redistribute it and/or modify it under
  5. * the terms of the Do What The Fuck You Want To Public License, Version 2, as
  6. * published by Sam Hocevar. See the COPYING file for more details.
  7. */
  8. #include <stdio.h>
  9. #include <string.h>
  10. #include <ctype.h>
  11. #include "minmea.h"
  12. int main(void)
  13. {
  14. char line[MINMEA_MAX_LENGTH];
  15. while (fgets(line, sizeof(line), stdin) != NULL) {
  16. printf("%s", line);
  17. switch (minmea_sentence_id(line)) {
  18. case MINMEA_SENTENCE_RMC: {
  19. struct minmea_sentence_rmc frame;
  20. if (minmea_parse_rmc(&frame, line)) {
  21. printf("$xxRMC: raw coordinates and speed: (%d/%d,%d/%d) %d/%d\n",
  22. frame.latitude.value, frame.latitude.scale,
  23. frame.longitude.value, frame.longitude.scale,
  24. frame.speed.value, frame.speed.scale);
  25. printf("$xxRMC fixed-point coordinates and speed scaled to three decimal places: (%d,%d) %d\n",
  26. minmea_rescale(&frame.latitude, 1000),
  27. minmea_rescale(&frame.longitude, 1000),
  28. minmea_rescale(&frame.speed, 1000));
  29. printf("$xxRMC floating point degree coordinates and speed: (%f,%f) %f\n",
  30. minmea_tocoord(&frame.latitude),
  31. minmea_tocoord(&frame.longitude),
  32. minmea_tofloat(&frame.speed));
  33. }
  34. else {
  35. printf("$xxRMC sentence is not parsed\n");
  36. }
  37. } break;
  38. case MINMEA_SENTENCE_GGA: {
  39. struct minmea_sentence_gga frame;
  40. if (minmea_parse_gga(&frame, line)) {
  41. printf("$xxGGA: fix quality: %d\n", frame.fix_quality);
  42. }
  43. else {
  44. printf("$xxGGA sentence is not parsed\n");
  45. }
  46. } break;
  47. case MINMEA_SENTENCE_GST: {
  48. struct minmea_sentence_gst frame;
  49. if (minmea_parse_gst(&frame, line)) {
  50. printf("$xxGST: raw latitude,longitude and altitude error deviation: (%d/%d,%d/%d,%d/%d)\n",
  51. frame.latitude_error_deviation.value, frame.latitude_error_deviation.scale,
  52. frame.longitude_error_deviation.value, frame.longitude_error_deviation.scale,
  53. frame.altitude_error_deviation.value, frame.altitude_error_deviation.scale);
  54. printf("$xxGST fixed point latitude,longitude and altitude error deviation"
  55. " scaled to one decimal place: (%d,%d,%d)\n",
  56. minmea_rescale(&frame.latitude_error_deviation, 10),
  57. minmea_rescale(&frame.longitude_error_deviation, 10),
  58. minmea_rescale(&frame.altitude_error_deviation, 10));
  59. printf("$xxGST floating point degree latitude, longitude and altitude error deviation: (%f,%f,%f)",
  60. minmea_tofloat(&frame.latitude_error_deviation),
  61. minmea_tofloat(&frame.longitude_error_deviation),
  62. minmea_tofloat(&frame.altitude_error_deviation));
  63. }
  64. else {
  65. printf("$xxGST sentence is not parsed\n");
  66. }
  67. } break;
  68. case MINMEA_SENTENCE_GSV: {
  69. struct minmea_sentence_gsv frame;
  70. if (minmea_parse_gsv(&frame, line)) {
  71. printf("$xxGSV: message %d of %d\n", frame.msg_nr, frame.total_msgs);
  72. printf("$xxGSV: sattelites in view: %d\n", frame.total_sats);
  73. for (int i = 0; i < 4; i++)
  74. printf("$xxGSV: sat nr %d, elevation: %d, azimuth: %d, snr: %d dbm\n",
  75. frame.sats[i].nr,
  76. frame.sats[i].elevation,
  77. frame.sats[i].azimuth,
  78. frame.sats[i].snr);
  79. }
  80. else {
  81. printf("$xxGSV sentence is not parsed\n");
  82. }
  83. } break;
  84. case MINMEA_INVALID: {
  85. printf("$xxxxx sentence is not valid\n");
  86. } break;
  87. default: {
  88. printf("$xxxxx sentence is not parsed\n");
  89. } break;
  90. }
  91. }
  92. return 0;
  93. }
  94. /* vim: set ts=4 sw=4 et: */