tests.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714
  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. #pragma GCC diagnostic ignored "-Wmissing-field-initializers"
  9. #include <stdlib.h>
  10. #include <string.h>
  11. #include <math.h>
  12. #include <check.h>
  13. #include "minmea.h"
  14. static const char *valid_sequences[] = {
  15. "$GPTXT,xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx",
  16. "$GPTXT,01,01,02,ANTSTATUS=INIT*25",
  17. "$GPRMC,,V,,,,,,,,,,N*53",
  18. "$GPVTG,,,,,,,,,N*30",
  19. "$GPGGA,,,,,,0,00,99.99,,,,,,*48",
  20. "$GPGSA,A,1,,,,,,,,,,,,,99.99,99.99,99.99*30",
  21. "$GPGLL,,,,,,V,N*64",
  22. "$GPXTE,A,A,0.67,L,N*6F",
  23. "$GPXTE,A,A,0.67,L,N*6f",
  24. "$GPGGA,123204.00,5106.94086,N,01701.51680,E,1,06,3.86,127.9,M,40.5,M,,*51",
  25. "$GPGSA,A,3,02,08,09,05,04,26,,,,,,,4.92,3.86,3.05*00",
  26. "$GPGSV,4,1,13,02,28,259,33,04,12,212,27,05,34,305,30,07,79,138,*7F",
  27. "$GPGSV,4,2,13,08,51,203,30,09,45,215,28,10,69,197,19,13,47,081,*76",
  28. "$GPGSV,4,3,13,16,20,040,17,26,08,271,30,28,01,168,18,33,24,219,27*74",
  29. "$GPGSV,4,4,13,39,31,170,27*40",
  30. "$GPGLL,5106.94086,N,01701.51680,E,123204.00,A,A*63",
  31. "$GPRMC,123205.00,A,5106.94085,N,01701.51689,E,0.016,,280214,,,A*7B",
  32. "$GPVTG,,T,,M,0.016,N,0.030,K,A*27",
  33. "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58",
  34. NULL,
  35. };
  36. static const char *invalid_sequences[] = {
  37. "$GPTXT,xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx"
  38. "xxxxxxxxxxxxxxxxxxxxxxxxxxx",
  39. "$GPTXT,01,01,02,ANTSTATUS=INIT*26",
  40. "$GPRMC,,V,,,,,,,,,,N*532",
  41. "$GPVTG,,,,\xff,,,,,N*30",
  42. "$$GPGGA,,,,,,0,00,99.99,,,,,,*48",
  43. "GPGSA,A,1,,,,,,,,,,,,,99.99,99.99,99.99*30",
  44. "gps: $GPGLL,,,,,,V,N",
  45. "$GPXTE,A,A,0.67,L,N*6e",
  46. "$GPXTE,A,A,0.67,L,N*6g",
  47. NULL,
  48. };
  49. START_TEST(test_minmea_check)
  50. {
  51. for (const char **sequence=valid_sequences; *sequence; sequence++)
  52. ck_assert_msg(minmea_check(*sequence) == true, *sequence);
  53. for (const char **sequence=invalid_sequences; *sequence; sequence++)
  54. ck_assert_msg(minmea_check(*sequence) == false, *sequence);
  55. }
  56. END_TEST
  57. START_TEST(test_minmea_scan_c)
  58. {
  59. char ch, extra;
  60. ck_assert(minmea_scan("A,123.45", "c", &ch) == true);
  61. ck_assert_int_eq(ch, 'A');
  62. ck_assert(minmea_scan("WUT,123.45", "c", &ch) == true);
  63. ck_assert_int_eq(ch, 'W');
  64. ck_assert(minmea_scan(",123.45", "c", &ch) == true);
  65. ck_assert_int_eq(ch, '\0');
  66. ck_assert(minmea_scan("A,B", "cc", &ch, &extra) == true);
  67. ck_assert_int_eq(ch, 'A');
  68. ck_assert_int_eq(extra, 'B');
  69. ck_assert(minmea_scan("C", "cc", &ch, &extra) == false);
  70. ck_assert(minmea_scan("D", "c;c", &ch, &extra) == true);
  71. ck_assert_int_eq(ch, 'D');
  72. ck_assert_int_eq(extra, '\0');
  73. ck_assert(minmea_scan("E,F", "c;c", &ch, &extra) == true);
  74. ck_assert_int_eq(ch, 'E');
  75. ck_assert_int_eq(extra, 'F');
  76. }
  77. END_TEST
  78. START_TEST(test_minmea_scan_d)
  79. {
  80. int direction;
  81. ck_assert(minmea_scan("K", "d", &direction) == false);
  82. ck_assert(minmea_scan("", "d", &direction) == true);
  83. ck_assert(minmea_scan(",foo", "d", &direction) == true);
  84. ck_assert_int_eq(direction, 0);
  85. ck_assert(minmea_scan("N", "d", &direction) == true);
  86. ck_assert_int_eq(direction, 1);
  87. ck_assert(minmea_scan("S,foo", "d", &direction) == true);
  88. ck_assert_int_eq(direction, -1);
  89. ck_assert(minmea_scan("W", "d", &direction) == true);
  90. ck_assert_int_eq(direction, -1);
  91. ck_assert(minmea_scan("E,foo", "d", &direction) == true);
  92. ck_assert_int_eq(direction, 1);
  93. }
  94. END_TEST
  95. START_TEST(test_minmea_scan_f)
  96. {
  97. int value, scale;
  98. ck_assert(minmea_scan("-", "f", &value, &scale) == false);
  99. ck_assert(minmea_scan("10-", "f", &value, &scale) == false);
  100. ck_assert(minmea_scan("+-10", "f", &value, &scale) == false);
  101. ck_assert(minmea_scan("12..45", "f", &value, &scale) == false);
  102. ck_assert(minmea_scan("blah", "f", &value, &scale) == false);
  103. ck_assert(minmea_scan("12.3.4", "f", &value, &scale) == false);
  104. ck_assert(minmea_scan(",", "f", &value, &scale) == true);
  105. ck_assert_int_eq(scale, 0);
  106. ck_assert(minmea_scan("", "f", &value, &scale) == true);
  107. ck_assert_int_eq(scale, 0);
  108. ck_assert(minmea_scan("15.345", "f", &value, &scale) == true);
  109. ck_assert_int_eq(value, 15345);
  110. ck_assert_int_eq(scale, 1000);
  111. ck_assert(minmea_scan("-1.23,V", "f", &value, &scale) == true);
  112. ck_assert_int_eq(value, -123);
  113. ck_assert_int_eq(scale, 100);
  114. /* some GPS units have absurdly big precision. handle whatever int handles. */
  115. ck_assert(minmea_scan("5106.94091", "f", &value, &scale) == true);
  116. ck_assert_int_eq(value, 510694091);
  117. ck_assert_int_eq(scale, 100000);
  118. /* for now we support +-180 degrees with 5 decimal digits; anything
  119. * more will overflow. */
  120. ck_assert(minmea_scan("18000.00000", "f", &value, &scale) == true);
  121. ck_assert_int_eq(value, 1800000000);
  122. ck_assert_int_eq(scale, 100000);
  123. ck_assert(minmea_scan("-18000.00000", "f", &value, &scale) == true);
  124. ck_assert_int_eq(value, -1800000000);
  125. ck_assert_int_eq(scale, 100000);
  126. /* optional values */
  127. ck_assert(minmea_scan("foo", "_;f", &value, &scale) == true);
  128. ck_assert_int_eq(scale, 0);
  129. ck_assert(minmea_scan("foo,", "_;f", &value, &scale) == true);
  130. ck_assert_int_eq(scale, 0);
  131. ck_assert(minmea_scan("foo,12.3", "_;f", &value, &scale) == true);
  132. ck_assert_int_eq(value, 123);
  133. ck_assert_int_eq(scale, 10);
  134. }
  135. END_TEST
  136. START_TEST(test_minmea_scan_i)
  137. {
  138. int value, extra;
  139. // valid parses
  140. ck_assert(minmea_scan("14", "i", &value) == true);
  141. ck_assert_int_eq(value, 14);
  142. ck_assert(minmea_scan("-1234", "i", &value) == true);
  143. ck_assert_int_eq(value, -1234);
  144. // empty field
  145. ck_assert(minmea_scan("", "i", &value) == true);
  146. ck_assert_int_eq(value, 0);
  147. // invalid value
  148. ck_assert(minmea_scan("foo", "i", &value) == false);
  149. // missing field
  150. ck_assert(minmea_scan("41", "ii", &value, &extra) == false);
  151. /* optional values */
  152. ck_assert(minmea_scan("10", "i;i", &value, &extra) == true);
  153. ck_assert_int_eq(value, 10);
  154. ck_assert(minmea_scan("20,30", "i;i", &value, &extra) == true);
  155. ck_assert_int_eq(value, 20);
  156. ck_assert_int_eq(extra, 30);
  157. ck_assert(minmea_scan("42,foo", "i;i", &value, &extra) == false);
  158. }
  159. END_TEST
  160. START_TEST(test_minmea_scan_s)
  161. {
  162. char value[MINMEA_MAX_LENGTH];
  163. ck_assert(minmea_scan(",bar,baz", "s", value) == true);
  164. ck_assert_str_eq(value, "");
  165. ck_assert(minmea_scan("foo,bar,baz", "s", value) == true);
  166. ck_assert_str_eq(value, "foo");
  167. ck_assert(minmea_scan("dummy", "_;s", value) == true);
  168. ck_assert_str_eq(value, "");
  169. ck_assert(minmea_scan("dummy,foo", "_;s", value) == true);
  170. ck_assert_str_eq(value, "foo");
  171. ck_assert(minmea_scan("dummy,", "_;s", value) == true);
  172. ck_assert_str_eq(value, "");
  173. }
  174. END_TEST
  175. START_TEST(test_minmea_scan_t)
  176. {
  177. char buf[7];
  178. buf[sizeof(buf)-1] = 0x42;
  179. ck_assert(minmea_scan("$GPRM,foo,bar,baz", "t", buf) == false);
  180. ck_assert(minmea_scan("GPRMC,foo,bar,baz", "t", buf) == false);
  181. ck_assert(minmea_scan("$GPRMC,foo,bar,baz", "t", buf) == true);
  182. ck_assert_str_eq(buf, "GPRMC");
  183. ck_assert(buf[sizeof(buf)-1] == 0x42);
  184. }
  185. END_TEST
  186. START_TEST(test_minmea_scan_D)
  187. {
  188. struct minmea_date date;
  189. ck_assert(minmea_scan("$GPXXX,3112", "_D", &date) == false);
  190. ck_assert(minmea_scan("$GPXXX,foobar", "_D", &date) == false);
  191. ck_assert(minmea_scan("$GPXXX,311299", "_D", &date) == true);
  192. ck_assert_int_eq(date.day, 31);
  193. ck_assert_int_eq(date.month, 12);
  194. ck_assert_int_eq(date.year, 99);
  195. ck_assert(minmea_scan("$GPXXX,,,,,,,,,nope", "_D", &date) == true);
  196. ck_assert_int_eq(date.day, -1);
  197. ck_assert_int_eq(date.month, -1);
  198. ck_assert_int_eq(date.year, -1);
  199. }
  200. END_TEST
  201. START_TEST(test_minmea_scan_T)
  202. {
  203. struct minmea_time time;
  204. ck_assert(minmea_scan("$GPXXX,2359", "_T", &time) == false);
  205. ck_assert(minmea_scan("$GPXXX,foobar", "_T", &time) == false);
  206. ck_assert(minmea_scan("$GPXXX,235960", "_T", &time) == true);
  207. ck_assert_int_eq(time.hours, 23);
  208. ck_assert_int_eq(time.minutes, 59);
  209. ck_assert_int_eq(time.seconds, 60);
  210. ck_assert_int_eq(time.microseconds, 0);
  211. ck_assert(minmea_scan("$GPXXX,213700.001", "_T", &time) == true);
  212. ck_assert_int_eq(time.hours, 21);
  213. ck_assert_int_eq(time.minutes, 37);
  214. ck_assert_int_eq(time.seconds, 0);
  215. ck_assert_int_eq(time.microseconds, 1000);
  216. ck_assert(minmea_scan("$GPXXX,,,,,,,nope", "_T", &time) == true);
  217. ck_assert_int_eq(time.hours, -1);
  218. ck_assert_int_eq(time.minutes, -1);
  219. ck_assert_int_eq(time.seconds, -1);
  220. ck_assert_int_eq(time.microseconds, -1);
  221. }
  222. END_TEST
  223. START_TEST(test_minmea_scan_complex1)
  224. {
  225. const char *sentence = "$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47\r\n";
  226. char type[6];
  227. struct minmea_time time;
  228. int latitude, latitude_scale, latitude_direction;
  229. int longitude, longitude_scale, longitude_direction;
  230. int fix_quality;
  231. int satellites;
  232. int hdop, hdop_scale;
  233. int altitude, altitude_scale; char altitude_units;
  234. int height, height_scale; char height_units;
  235. ck_assert(minmea_scan(sentence, "tTfdfdiiffcfc__",
  236. type,
  237. &time,
  238. &latitude, &latitude_scale, &latitude_direction,
  239. &longitude, &longitude_scale, &longitude_direction,
  240. &fix_quality,
  241. &satellites,
  242. &hdop, &hdop_scale,
  243. &altitude, &altitude_scale, &altitude_units,
  244. &height, &height_scale, &height_units) == true);
  245. ck_assert_str_eq(type, "GPGGA");
  246. ck_assert_int_eq(time.hours, 12);
  247. ck_assert_int_eq(time.minutes, 35);
  248. ck_assert_int_eq(time.seconds, 19);
  249. ck_assert_int_eq(latitude, 4807038);
  250. ck_assert_int_eq(latitude_scale, 1000);
  251. ck_assert_int_eq(latitude_direction, 1);
  252. ck_assert_int_eq(longitude, 1131000);
  253. ck_assert_int_eq(longitude_scale, 1000);
  254. ck_assert_int_eq(longitude_direction, 1);
  255. ck_assert_int_eq(fix_quality, 1);
  256. ck_assert_int_eq(satellites, 8);
  257. ck_assert_int_eq(hdop, 9);
  258. ck_assert_int_eq(hdop_scale, 10);
  259. ck_assert_int_eq(altitude, 5454);
  260. ck_assert_int_eq(altitude_scale, 10);
  261. ck_assert_int_eq(altitude_units, 'M');
  262. ck_assert_int_eq(height, 469);
  263. ck_assert_int_eq(height_scale, 10);
  264. ck_assert_int_eq(height_units, 'M');
  265. }
  266. END_TEST
  267. START_TEST(test_minmea_scan_complex2)
  268. {
  269. const char *sentence = "$GPBWC,081837,,,,,,T,,M,,N,*13";
  270. char type[6];
  271. struct minmea_time time;
  272. int latitude, latitude_scale, latitude_direction;
  273. int longitude, longitude_scale, longitude_direction;
  274. int bearing_true, bearing_true_scale; char bearing_true_mark;
  275. int bearing_magnetic, bearing_magnetic_scale; char bearing_magnetic_mark;
  276. int distance, distance_scale; char distance_units;
  277. char name[MINMEA_MAX_LENGTH];
  278. ck_assert(minmea_scan(sentence, "tTfdfdfcfcfcs",
  279. type,
  280. &time,
  281. &latitude, &latitude_scale, &latitude_direction,
  282. &longitude, &longitude_scale, &longitude_direction,
  283. &bearing_true, &bearing_true_scale, &bearing_true_mark,
  284. &bearing_magnetic, &bearing_magnetic_scale, &bearing_magnetic_mark,
  285. &distance, &distance_scale, &distance_units,
  286. name) == true);
  287. ck_assert_str_eq(type, "GPBWC");
  288. ck_assert_int_eq(time.hours, 8);
  289. ck_assert_int_eq(time.minutes, 18);
  290. ck_assert_int_eq(time.seconds, 37);
  291. ck_assert_int_eq(latitude_scale, 0);
  292. ck_assert_int_eq(latitude_direction, 0);
  293. ck_assert_int_eq(longitude_scale, 0);
  294. ck_assert_int_eq(longitude_direction, 0);
  295. ck_assert_int_eq(bearing_true_scale, 0);
  296. ck_assert_int_eq(bearing_true_mark, 'T');
  297. ck_assert_int_eq(bearing_magnetic_scale, 0);
  298. ck_assert_int_eq(bearing_magnetic_mark, 'M');
  299. ck_assert_int_eq(distance_scale, 0);
  300. ck_assert_int_eq(distance_units, 'N');
  301. ck_assert_str_eq(name, "");
  302. }
  303. END_TEST
  304. START_TEST(test_minmea_scan_complex3)
  305. {
  306. const char *sentence = "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58";
  307. char type[6];
  308. struct minmea_time time;
  309. int rms_deviation, rms_deviation_scale;
  310. int semi_major_deviation, semi_major_deviation_scale;
  311. int semi_minor_deviation, semi_minor_deviation_scale;
  312. int semi_major_orientation, semi_major_orientation_scale;
  313. int latitude_error_deviation, latitude_error_deviation_scale;
  314. int longitude_error_deviation, longitude_error_deviation_scale;
  315. int altitude_error_deviation, altitude_error_deviation_scale;
  316. ck_assert(minmea_scan(sentence, "tTfffffff",
  317. type,
  318. &time,
  319. &rms_deviation, &rms_deviation_scale,
  320. &semi_major_deviation, &semi_major_deviation_scale,
  321. &semi_minor_deviation, &semi_minor_deviation_scale,
  322. &semi_major_orientation, &semi_major_orientation_scale,
  323. &latitude_error_deviation, &latitude_error_deviation_scale,
  324. &longitude_error_deviation, &longitude_error_deviation_scale,
  325. &altitude_error_deviation, &altitude_error_deviation_scale) == true);
  326. ck_assert_str_eq(type, "GPGST");
  327. ck_assert_int_eq(time.hours, 2);
  328. ck_assert_int_eq(time.minutes, 46);
  329. ck_assert_int_eq(time.seconds, 3);
  330. ck_assert_int_eq(time.microseconds, 0);
  331. ck_assert_int_eq(rms_deviation, 32);
  332. ck_assert_int_eq(rms_deviation_scale, 10);
  333. ck_assert_int_eq(semi_major_deviation, 66);
  334. ck_assert_int_eq(semi_major_deviation_scale, 10);
  335. ck_assert_int_eq(semi_minor_deviation, 47);
  336. ck_assert_int_eq(semi_minor_deviation_scale, 10);
  337. ck_assert_int_eq(semi_major_orientation, 473);
  338. ck_assert_int_eq(semi_major_orientation_scale, 10);
  339. ck_assert_int_eq(latitude_error_deviation, 58);
  340. ck_assert_int_eq(latitude_error_deviation_scale, 10);
  341. ck_assert_int_eq(longitude_error_deviation, 56);
  342. ck_assert_int_eq(longitude_error_deviation_scale, 10);
  343. ck_assert_int_eq(altitude_error_deviation, 220);
  344. ck_assert_int_eq(altitude_error_deviation_scale,10);
  345. }
  346. END_TEST
  347. START_TEST(test_minmea_parse_rmc1)
  348. {
  349. const char *sentence = "$GPRMC,081836.75,A,3751.65,S,14507.36,E,000.0,360.0,130998,011.3,E";
  350. struct minmea_sentence_rmc frame = {};
  351. static const struct minmea_sentence_rmc expected = {
  352. .time = { 8, 18, 36, 750000 },
  353. .valid = true,
  354. .latitude = -375165,
  355. .latitude_scale = 100,
  356. .longitude = 1450736,
  357. .longitude_scale = 100,
  358. .speed = 0,
  359. .speed_scale = 10,
  360. .course = 3600,
  361. .course_scale = 10,
  362. .date = { 13, 9, 98 },
  363. .variation = 113,
  364. .variation_scale = 10,
  365. };
  366. ck_assert(minmea_check(sentence) == true);
  367. ck_assert(minmea_parse_rmc(&frame, sentence) == true);
  368. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  369. }
  370. END_TEST
  371. START_TEST(test_minmea_parse_rmc2)
  372. {
  373. const char *sentence = "$GPRMC,,A,3751.65,N,14507.36,W,,,,,";
  374. struct minmea_sentence_rmc frame = {};
  375. static const struct minmea_sentence_rmc expected = {
  376. .time = { -1, -1, -1, -1 },
  377. .valid = true,
  378. .latitude = 375165,
  379. .latitude_scale = 100,
  380. .longitude = -1450736,
  381. .longitude_scale = 100,
  382. .date = { -1, -1, -1 },
  383. };
  384. ck_assert(minmea_check(sentence) == true);
  385. ck_assert(minmea_parse_rmc(&frame, sentence) == true);
  386. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  387. }
  388. END_TEST
  389. START_TEST(test_minmea_parse_gga1)
  390. {
  391. const char *sentence = "$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47";
  392. struct minmea_sentence_gga frame = {};
  393. static const struct minmea_sentence_gga expected = {
  394. .time = { 12, 35, 19, 0 },
  395. .latitude = 4807038,
  396. .latitude_scale = 1000,
  397. .longitude = 1131000,
  398. .longitude_scale = 1000,
  399. .fix_quality = 1,
  400. .satellites_tracked = 8,
  401. .hdop = 9,
  402. .hdop_scale = 10,
  403. .altitude = 5454,
  404. .altitude_scale = 10,
  405. .altitude_units = 'M',
  406. .height = 469,
  407. .height_scale = 10,
  408. .height_units = 'M',
  409. .dgps_age = 0,
  410. };
  411. ck_assert(minmea_check(sentence) == true);
  412. ck_assert(minmea_parse_gga(&frame, sentence) == true);
  413. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  414. }
  415. END_TEST
  416. START_TEST(test_minmea_parse_gst1)
  417. {
  418. const char *sentence = "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58";
  419. struct minmea_sentence_gst frame = {};
  420. struct minmea_sentence_gst expected = {
  421. .time = { 2, 46, 3, 0 },
  422. .rms_deviation = 32,
  423. .rms_deviation_scale = 10,
  424. .semi_major_deviation = 66,
  425. .semi_major_deviation_scale = 10,
  426. .semi_minor_deviation = 47,
  427. .semi_minor_deviation_scale = 10,
  428. .semi_major_orientation = 473,
  429. .semi_major_orientation_scale = 10,
  430. .latitude_error_deviation = 58,
  431. .latitude_error_deviation_scale = 10,
  432. .longitude_error_deviation = 56,
  433. .longitude_error_deviation_scale = 10,
  434. .altitude_error_deviation = 220,
  435. .altitude_error_deviation_scale = 10,
  436. };
  437. ck_assert(minmea_check(sentence) == true);
  438. ck_assert(minmea_parse_gst(&frame, sentence) == true);
  439. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  440. }
  441. END_TEST
  442. START_TEST(test_minmea_parse_gsa1)
  443. {
  444. const char *sentence = "$GPGSA,A,3,04,05,,09,12,,,24,,,,,2.5,1.3,2.1*39";
  445. struct minmea_sentence_gsa frame = {};
  446. static const struct minmea_sentence_gsa expected = {
  447. .mode = MINMEA_GPGSA_MODE_AUTO,
  448. .fix_type = MINMEA_GPGSA_FIX_3D,
  449. .sats = { 4, 5, 0, 9, 12, 0, 0, 24, 0, 0, 0, 0 },
  450. .pdop = 25,
  451. .pdop_scale = 10,
  452. .hdop = 13,
  453. .hdop_scale = 10,
  454. .vdop = 21,
  455. .vdop_scale = 10
  456. };
  457. ck_assert(minmea_check(sentence) == true);
  458. ck_assert(minmea_parse_gsa(&frame, sentence) == true);
  459. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  460. }
  461. END_TEST
  462. START_TEST(test_minmea_parse_gsv1)
  463. {
  464. const char *sentence = "$GPGSV,3,3,11,22,42,067,42,24,14,311,43,27,05,244,00,,,,*4D";
  465. struct minmea_sentence_gsv frame = {};
  466. static const struct minmea_sentence_gsv expected = {
  467. .total_msgs = 3,
  468. .msg_nr = 3,
  469. .total_sats = 11,
  470. .sats = {
  471. {
  472. .nr = 22,
  473. .elevation = 42,
  474. .azimuth = 67,
  475. .snr = 42
  476. },
  477. {
  478. .nr = 24,
  479. .elevation = 14,
  480. .azimuth = 311,
  481. .snr = 43
  482. },
  483. {
  484. .nr = 27,
  485. .elevation = 5,
  486. .azimuth = 244,
  487. .snr = 0
  488. },
  489. {
  490. .nr = 0,
  491. .elevation = 0,
  492. .azimuth = 0,
  493. .snr = 0
  494. }
  495. }
  496. };
  497. ck_assert(minmea_check(sentence) == true);
  498. ck_assert(minmea_parse_gsv(&frame, sentence) == true);
  499. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  500. }
  501. END_TEST
  502. START_TEST(test_minmea_usage1)
  503. {
  504. const char *sentences[] = {
  505. "$GPRMC,081836,A,3751.65,S,14507.36,E,000.0,360.0,130998,011.3,E*62",
  506. "$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47",
  507. "$GNGSA,A,3,04,05,,09,12,,,24,,,,,2.5,1.3,2.1",
  508. "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58",
  509. NULL,
  510. };
  511. for (const char **sentence=sentences; *sentence; sentence++) {
  512. switch (minmea_sentence_id(*sentence)) {
  513. case MINMEA_SENTENCE_RMC: {
  514. struct minmea_sentence_rmc frame;
  515. ck_assert(minmea_parse_rmc(&frame, *sentence) == true);
  516. } break;
  517. case MINMEA_SENTENCE_GGA: {
  518. struct minmea_sentence_gga frame;
  519. ck_assert(minmea_parse_gga(&frame, *sentence) == true);
  520. } break;
  521. case MINMEA_SENTENCE_GSA: {
  522. struct minmea_sentence_gsa frame;
  523. ck_assert(minmea_parse_gsa(&frame, *sentence) == true);
  524. } break;
  525. case MINMEA_SENTENCE_GST: {
  526. struct minmea_sentence_gst frame;
  527. ck_assert(minmea_parse_gst(&frame, *sentence) == true);
  528. } break;
  529. default: {
  530. } break;
  531. }
  532. char talker[3];
  533. char expected[3] = { (*sentence)[1], (*sentence)[2], '\0' };
  534. ck_assert(minmea_talker_id(talker, *sentence) == true);
  535. ck_assert_str_eq(talker, expected);
  536. }
  537. }
  538. END_TEST
  539. START_TEST(test_minmea_gettimeofday)
  540. {
  541. struct minmea_date date = { 14, 2, 14 };
  542. struct minmea_time time = { 13, 0, 9, 123456 };
  543. struct timeval tv;
  544. ck_assert(minmea_gettimeofday(&tv, &date, &time) == 0);
  545. ck_assert_int_eq(tv.tv_sec, 1392382809);
  546. ck_assert_int_eq(tv.tv_usec, 123456);
  547. date.year = -1;
  548. ck_assert(minmea_gettimeofday(&tv, &date, &time) != 0);
  549. date.year = 2014;
  550. time.hours = -1;
  551. ck_assert(minmea_gettimeofday(&tv, &date, &time) != 0);
  552. }
  553. END_TEST
  554. START_TEST(test_minmea_rescale)
  555. {
  556. /* basic and edge cases. */
  557. ck_assert_int_eq(minmea_rescale(42, 0, 3), 0);
  558. ck_assert_int_eq(minmea_rescale(1234, 10, 1), 123);
  559. ck_assert_int_eq(minmea_rescale(1235, 10, 1), 124);
  560. ck_assert_int_eq(minmea_rescale(1234, 10, 1000), 123400);
  561. /* round towards zero. */
  562. ck_assert_int_eq(minmea_rescale(-1234, 10, 1), -123);
  563. ck_assert_int_eq(minmea_rescale(-1235, 10, 1), -124);
  564. ck_assert_int_eq(minmea_rescale(-1236, 10, 1), -124);
  565. /* shouldn't overflow on large numbers. */
  566. ck_assert_int_eq(minmea_rescale(510693608, 100000, 10000), 51069361);
  567. }
  568. END_TEST
  569. START_TEST(test_minmea_float)
  570. {
  571. ck_assert(isnan(minmea_float(42, 0)));
  572. ck_assert(minmea_float(7, 1) == 7.0);
  573. ck_assert(minmea_float(-200, 100) == -2.0);
  574. ck_assert(minmea_float(15, 10) == 1.5);
  575. }
  576. END_TEST
  577. START_TEST(test_minmea_coord)
  578. {
  579. ck_assert(isnan(minmea_coord(42, 0)));
  580. ck_assert(minmea_coord(4200, 1) == 42.0);
  581. ck_assert(minmea_coord(420000, 100) == 42.0);
  582. ck_assert(minmea_coord(423000, 100) == 42.5);
  583. }
  584. END_TEST
  585. Suite *minmea_suite(void)
  586. {
  587. Suite *s = suite_create ("minmea");
  588. TCase *tc_check = tcase_create("minmea_check");
  589. tcase_add_test(tc_check, test_minmea_check);
  590. suite_add_tcase(s, tc_check);
  591. TCase *tc_scan = tcase_create("minmea_scan");
  592. tcase_add_test(tc_scan, test_minmea_scan_c);
  593. tcase_add_test(tc_scan, test_minmea_scan_d);
  594. tcase_add_test(tc_scan, test_minmea_scan_f);
  595. tcase_add_test(tc_scan, test_minmea_scan_i);
  596. tcase_add_test(tc_scan, test_minmea_scan_s);
  597. tcase_add_test(tc_scan, test_minmea_scan_t);
  598. tcase_add_test(tc_scan, test_minmea_scan_D);
  599. tcase_add_test(tc_scan, test_minmea_scan_T);
  600. tcase_add_test(tc_scan, test_minmea_scan_complex1);
  601. tcase_add_test(tc_scan, test_minmea_scan_complex2);
  602. tcase_add_test(tc_scan, test_minmea_scan_complex3);
  603. suite_add_tcase(s, tc_scan);
  604. TCase *tc_parse = tcase_create("minmea_parse");
  605. tcase_add_test(tc_parse, test_minmea_parse_rmc1);
  606. tcase_add_test(tc_parse, test_minmea_parse_rmc2);
  607. tcase_add_test(tc_parse, test_minmea_parse_gga1);
  608. tcase_add_test(tc_parse, test_minmea_parse_gsa1);
  609. tcase_add_test(tc_parse, test_minmea_parse_gst1);
  610. tcase_add_test(tc_parse, test_minmea_parse_gsv1);
  611. suite_add_tcase(s, tc_parse);
  612. TCase *tc_usage = tcase_create("minmea_usage");
  613. tcase_add_test(tc_usage, test_minmea_usage1);
  614. suite_add_tcase(s, tc_usage);
  615. TCase *tc_utils = tcase_create("minmea_utils");
  616. tcase_add_test(tc_utils, test_minmea_gettimeofday);
  617. tcase_add_test(tc_utils, test_minmea_rescale);
  618. tcase_add_test(tc_utils, test_minmea_float);
  619. tcase_add_test(tc_utils, test_minmea_coord);
  620. suite_add_tcase(s, tc_utils);
  621. return s;
  622. }
  623. int main()
  624. {
  625. int number_failed;
  626. Suite *s = minmea_suite();
  627. SRunner *sr = srunner_create(s);
  628. srunner_run_all(sr, CK_NORMAL);
  629. number_failed = srunner_ntests_failed(sr);
  630. srunner_free(sr);
  631. return (number_failed == 0) ? EXIT_SUCCESS : EXIT_FAILURE;
  632. }
  633. /* vim: set ts=4 sw=4 et: */