tests.c 32 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974
  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. #pragma GCC diagnostic ignored "-Wtype-limits"
  10. #include <stdlib.h>
  11. #include <string.h>
  12. #include <math.h>
  13. #include <check.h>
  14. #include "minmea.h"
  15. static const char *valid_sequences_nochecksum[] = {
  16. "$GPTXT,xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx",
  17. };
  18. static const char *valid_sequences_checksum[] = {
  19. "$GPTXT,01,01,02,ANTSTATUS=INIT*25",
  20. "$GPRMC,,V,,,,,,,,,,N*53",
  21. "$GPVTG,,,,,,,,,N*30",
  22. "$GPGGA,,,,,,0,00,99.99,,,,,,*48",
  23. "$GPGSA,A,1,,,,,,,,,,,,,99.99,99.99,99.99*30",
  24. "$GPGLL,,,,,,V,N*64",
  25. "$GPXTE,A,A,0.67,L,N*6F",
  26. "$GPXTE,A,A,0.67,L,N*6f",
  27. "$GPGGA,123204.00,5106.94086,N,01701.51680,E,1,06,3.86,127.9,M,40.5,M,,*51",
  28. "$GPGSA,A,3,02,08,09,05,04,26,,,,,,,4.92,3.86,3.05*00",
  29. "$GPGSV,4,1,13,02,28,259,33,04,12,212,27,05,34,305,30,07,79,138,*7F",
  30. "$GPGSV,4,2,13,08,51,203,30,09,45,215,28,10,69,197,19,13,47,081,*76",
  31. "$GPGSV,4,3,13,16,20,040,17,26,08,271,30,28,01,168,18,33,24,219,27*74",
  32. "$GPGSV,4,4,13,39,31,170,27*40",
  33. "$GPGLL,5106.94086,N,01701.51680,E,123204.00,A,A*63",
  34. "$GPRMC,123205.00,A,5106.94085,N,01701.51689,E,0.016,,280214,,,A*7B",
  35. "$GPVTG,,T,,M,0.016,N,0.030,K,A*27",
  36. "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58",
  37. NULL,
  38. };
  39. static const char *invalid_sequences[] = {
  40. "$GPTXT,xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx"
  41. "xxxxxxxxxxxxxxxxxxxxxxxxxxx",
  42. "$GPTXT,01,01,02,ANTSTATUS=INIT*26",
  43. "$GPRMC,,V,,,,,,,,,,N*532",
  44. "$GPVTG,,,,\xff,,,,,N*30",
  45. "$$GPGGA,,,,,,0,00,99.99,,,,,,*48",
  46. "GPGSA,A,1,,,,,,,,,,,,,99.99,99.99,99.99*30",
  47. "gps: $GPGLL,,,,,,V,N",
  48. "$GPXTE,A,A,0.67,L,N*6e",
  49. "$GPXTE,A,A,0.67,L,N*6g",
  50. NULL,
  51. };
  52. START_TEST(test_minmea_check)
  53. {
  54. for (const char **sequence=valid_sequences_nochecksum; *sequence; sequence++) {
  55. ck_assert_msg(minmea_check(*sequence, false) == true, *sequence);
  56. ck_assert_msg(minmea_check(*sequence, true) == false, *sequence);
  57. }
  58. for (const char **sequence=valid_sequences_checksum; *sequence; sequence++) {
  59. ck_assert_msg(minmea_check(*sequence, false) == true, *sequence);
  60. ck_assert_msg(minmea_check(*sequence, true) == true, *sequence);
  61. }
  62. for (const char **sequence=invalid_sequences; *sequence; sequence++) {
  63. ck_assert_msg(minmea_check(*sequence, false) == false, *sequence);
  64. ck_assert_msg(minmea_check(*sequence, true) == false, *sequence);
  65. }
  66. }
  67. END_TEST
  68. START_TEST(test_minmea_scan_c)
  69. {
  70. char ch, extra;
  71. ck_assert(minmea_scan("A,123.45", "c", &ch) == true);
  72. ck_assert_int_eq(ch, 'A');
  73. ck_assert(minmea_scan("WUT,123.45", "c", &ch) == true);
  74. ck_assert_int_eq(ch, 'W');
  75. ck_assert(minmea_scan(",123.45", "c", &ch) == true);
  76. ck_assert_int_eq(ch, '\0');
  77. ck_assert(minmea_scan("A,B", "cc", &ch, &extra) == true);
  78. ck_assert_int_eq(ch, 'A');
  79. ck_assert_int_eq(extra, 'B');
  80. ck_assert(minmea_scan("C", "cc", &ch, &extra) == false);
  81. ck_assert(minmea_scan("D", "c;c", &ch, &extra) == true);
  82. ck_assert_int_eq(ch, 'D');
  83. ck_assert_int_eq(extra, '\0');
  84. ck_assert(minmea_scan("E,F", "c;c", &ch, &extra) == true);
  85. ck_assert_int_eq(ch, 'E');
  86. ck_assert_int_eq(extra, 'F');
  87. }
  88. END_TEST
  89. START_TEST(test_minmea_scan_d)
  90. {
  91. int direction;
  92. ck_assert(minmea_scan("K", "d", &direction) == false);
  93. ck_assert(minmea_scan("", "d", &direction) == true);
  94. ck_assert(minmea_scan(",foo", "d", &direction) == true);
  95. ck_assert_int_eq(direction, 0);
  96. ck_assert(minmea_scan("N", "d", &direction) == true);
  97. ck_assert_int_eq(direction, 1);
  98. ck_assert(minmea_scan("S,foo", "d", &direction) == true);
  99. ck_assert_int_eq(direction, -1);
  100. ck_assert(minmea_scan("W", "d", &direction) == true);
  101. ck_assert_int_eq(direction, -1);
  102. ck_assert(minmea_scan("E,foo", "d", &direction) == true);
  103. ck_assert_int_eq(direction, 1);
  104. }
  105. END_TEST
  106. START_TEST(test_minmea_scan_f)
  107. {
  108. struct minmea_float f;
  109. ck_assert(minmea_scan("-", "f", &f) == false);
  110. ck_assert(minmea_scan("10-", "f", &f) == false);
  111. ck_assert(minmea_scan("+-10", "f", &f) == false);
  112. ck_assert(minmea_scan("12..45", "f", &f) == false);
  113. ck_assert(minmea_scan("blah", "f", &f) == false);
  114. ck_assert(minmea_scan("12.3.4", "f", &f) == false);
  115. ck_assert(minmea_scan(",", "f", &f) == true);
  116. ck_assert_int_eq(f.scale, 0);
  117. ck_assert(minmea_scan("", "f", &f) == true);
  118. ck_assert_int_eq(f.scale, 0);
  119. ck_assert(minmea_scan("42", "f", &f) == true);
  120. ck_assert_int_eq(f.value, 42);
  121. ck_assert_int_eq(f.scale, 1);
  122. ck_assert(minmea_scan("15.345", "f", &f) == true);
  123. ck_assert_int_eq(f.value, 15345);
  124. ck_assert_int_eq(f.scale, 1000);
  125. ck_assert(minmea_scan("-1.23,V", "f", &f) == true);
  126. ck_assert_int_eq(f.value, -123);
  127. ck_assert_int_eq(f.scale, 100);
  128. /* the guaranteed range is 32 bits which translates to +-180 degrees
  129. * with 5 decimal digits. make sure we support that. */
  130. ck_assert(minmea_scan("18000.00000", "f", &f) == true);
  131. ck_assert_int_eq(f.value, 1800000000);
  132. ck_assert_int_eq(f.scale, 100000);
  133. ck_assert(minmea_scan("-18000.00000", "f", &f) == true);
  134. ck_assert_int_eq(f.value, -1800000000);
  135. ck_assert_int_eq(f.scale, 100000);
  136. if (sizeof(int_least32_t) == 4) {
  137. /* fits in 32 bits */
  138. ck_assert(minmea_scan("2147483647", "f", &f) == true);
  139. ck_assert_int_eq(f.value, 2147483647);
  140. ck_assert_int_eq(f.scale, 1);
  141. /* doesn't fit, truncate precision */
  142. ck_assert(minmea_scan("2147483.648", "f", &f) == true);
  143. ck_assert_int_eq(f.value, 214748364);
  144. ck_assert_int_eq(f.scale, 100);
  145. /* doesn't fit, bail out */
  146. ck_assert(minmea_scan("2147483648", "f", &f) == false);
  147. } else if (sizeof(int_least32_t) == 8) {
  148. /* Casting to int64_t is ugly, but otherwise we get this on machines with 32-bit int_least32_t:
  149. * error: comparison is always false due to limited range of data type [-Werror=type-limits] */
  150. /* fits in 64 bits */
  151. ck_assert(minmea_scan("9223372036854775807", "f", &f) == true);
  152. ck_assert_int_eq((int64_t) f.value, 9223372036854775807LL);
  153. ck_assert_int_eq(f.scale, 1);
  154. /* doesn't fit, truncate precision */
  155. ck_assert(minmea_scan("9223372036854775.808", "f", &f) == true);
  156. ck_assert_int_eq((int64_t) f.value, 922337203685477580LL);
  157. ck_assert_int_eq(f.scale, 100);
  158. /* doesn't fit, bail out */
  159. ck_assert(minmea_scan("9223372036854775808", "f", &f) == false);
  160. } else {
  161. ck_abort_msg("your platform is esoteric. please fix this unit test.");
  162. }
  163. /* optional f.values */
  164. ck_assert(minmea_scan("foo", "_;f", &f) == true);
  165. ck_assert_int_eq(f.scale, 0);
  166. ck_assert(minmea_scan("foo,", "_;f", &f) == true);
  167. ck_assert_int_eq(f.scale, 0);
  168. ck_assert(minmea_scan("foo,12.3", "_;f", &f) == true);
  169. ck_assert_int_eq(f.value, 123);
  170. ck_assert_int_eq(f.scale, 10);
  171. /* accept spaces at the start of the field. some modules do this, unfortunately. */
  172. ck_assert(minmea_scan(" -1.23,V", "f", &f) == true);
  173. ck_assert_int_eq(f.value, -123);
  174. ck_assert_int_eq(f.scale, 100);
  175. ck_assert(minmea_scan(" -4.56,V", "f", &f) == true);
  176. ck_assert_int_eq(f.value, -456);
  177. ck_assert_int_eq(f.scale, 100);
  178. ck_assert(minmea_scan("-3.33 ,V", "f", &f) == false);
  179. ck_assert(minmea_scan(" -3.33 ,V", "f", &f) == false);
  180. ck_assert(minmea_scan("-3. 33,V", "f", &f) == false);
  181. ck_assert(minmea_scan("0 .0,V", "f", &f) == false);
  182. }
  183. END_TEST
  184. START_TEST(test_minmea_scan_i)
  185. {
  186. int value, extra;
  187. // valid parses
  188. ck_assert(minmea_scan("14", "i", &value) == true);
  189. ck_assert_int_eq(value, 14);
  190. ck_assert(minmea_scan("-1234", "i", &value) == true);
  191. ck_assert_int_eq(value, -1234);
  192. // empty field
  193. ck_assert(minmea_scan("", "i", &value) == true);
  194. ck_assert_int_eq(value, 0);
  195. // invalid value
  196. ck_assert(minmea_scan("foo", "i", &value) == false);
  197. // missing field
  198. ck_assert(minmea_scan("41", "ii", &value, &extra) == false);
  199. /* optional values */
  200. ck_assert(minmea_scan("10", "i;i", &value, &extra) == true);
  201. ck_assert_int_eq(value, 10);
  202. ck_assert(minmea_scan("20,30", "i;i", &value, &extra) == true);
  203. ck_assert_int_eq(value, 20);
  204. ck_assert_int_eq(extra, 30);
  205. ck_assert(minmea_scan("42,foo", "i;i", &value, &extra) == false);
  206. }
  207. END_TEST
  208. START_TEST(test_minmea_scan_s)
  209. {
  210. char value[MINMEA_MAX_LENGTH];
  211. ck_assert(minmea_scan(",bar,baz", "s", value) == true);
  212. ck_assert_str_eq(value, "");
  213. ck_assert(minmea_scan("foo,bar,baz", "s", value) == true);
  214. ck_assert_str_eq(value, "foo");
  215. ck_assert(minmea_scan("dummy", "_;s", value) == true);
  216. ck_assert_str_eq(value, "");
  217. ck_assert(minmea_scan("dummy,foo", "_;s", value) == true);
  218. ck_assert_str_eq(value, "foo");
  219. ck_assert(minmea_scan("dummy,", "_;s", value) == true);
  220. ck_assert_str_eq(value, "");
  221. }
  222. END_TEST
  223. START_TEST(test_minmea_scan_t)
  224. {
  225. char buf[7];
  226. buf[sizeof(buf)-1] = 0x42;
  227. ck_assert(minmea_scan("$GPRM,foo,bar,baz", "t", buf) == false);
  228. ck_assert(minmea_scan("GPRMC,foo,bar,baz", "t", buf) == false);
  229. ck_assert(minmea_scan("$GPRMC,foo,bar,baz", "t", buf) == true);
  230. ck_assert_str_eq(buf, "GPRMC");
  231. ck_assert(buf[sizeof(buf)-1] == 0x42);
  232. }
  233. END_TEST
  234. START_TEST(test_minmea_scan_D)
  235. {
  236. struct minmea_date d;
  237. ck_assert(minmea_scan("$GPXXX,3112", "_D", &d) == false);
  238. ck_assert(minmea_scan("$GPXXX,foobar", "_D", &d) == false);
  239. ck_assert(minmea_scan("$GPXXX,311299", "_D", &d) == true);
  240. ck_assert_int_eq(d.day, 31);
  241. ck_assert_int_eq(d.month, 12);
  242. ck_assert_int_eq(d.year, 99);
  243. ck_assert(minmea_scan("$GPXXX,,,,,,,,,nope", "_D", &d) == true);
  244. ck_assert_int_eq(d.day, -1);
  245. ck_assert_int_eq(d.month, -1);
  246. ck_assert_int_eq(d.year, -1);
  247. }
  248. END_TEST
  249. START_TEST(test_minmea_scan_T)
  250. {
  251. struct minmea_time t;
  252. ck_assert(minmea_scan("$GPXXX,2359", "_T", &t) == false);
  253. ck_assert(minmea_scan("$GPXXX,foobar", "_T", &t) == false);
  254. ck_assert(minmea_scan("$GPXXX,235960", "_T", &t) == true);
  255. ck_assert_int_eq(t.hours, 23);
  256. ck_assert_int_eq(t.minutes, 59);
  257. ck_assert_int_eq(t.seconds, 60);
  258. ck_assert_int_eq(t.microseconds, 0);
  259. ck_assert(minmea_scan("$GPXXX,213700.001", "_T", &t) == true);
  260. ck_assert_int_eq(t.hours, 21);
  261. ck_assert_int_eq(t.minutes, 37);
  262. ck_assert_int_eq(t.seconds, 0);
  263. ck_assert_int_eq(t.microseconds, 1000);
  264. ck_assert(minmea_scan("$GPXXX,,,,,,,nope", "_T", &t) == true);
  265. ck_assert_int_eq(t.hours, -1);
  266. ck_assert_int_eq(t.minutes, -1);
  267. ck_assert_int_eq(t.seconds, -1);
  268. ck_assert_int_eq(t.microseconds, -1);
  269. }
  270. END_TEST
  271. START_TEST(test_minmea_scan_complex1)
  272. {
  273. const char *sentence = "$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47\r\n";
  274. char type[6];
  275. struct minmea_time t;
  276. struct minmea_float latitude; int latitude_direction;
  277. struct minmea_float longitude; int longitude_direction;
  278. int fix_quality;
  279. int satellites;
  280. struct minmea_float hdop;
  281. struct minmea_float altitude; char altitude_units;
  282. struct minmea_float height; char height_units;
  283. ck_assert(minmea_scan(sentence, "tTfdfdiiffcfc__",
  284. type,
  285. &t,
  286. &latitude, &latitude_direction,
  287. &longitude, &longitude_direction,
  288. &fix_quality,
  289. &satellites,
  290. &hdop,
  291. &altitude, &altitude_units,
  292. &height, &height_units) == true);
  293. ck_assert_str_eq(type, "GPGGA");
  294. ck_assert_int_eq(t.hours, 12);
  295. ck_assert_int_eq(t.minutes, 35);
  296. ck_assert_int_eq(t.seconds, 19);
  297. ck_assert_int_eq(latitude.value, 4807038);
  298. ck_assert_int_eq(latitude.scale, 1000);
  299. ck_assert_int_eq(latitude_direction, 1);
  300. ck_assert_int_eq(longitude.value, 1131000);
  301. ck_assert_int_eq(longitude.scale, 1000);
  302. ck_assert_int_eq(longitude_direction, 1);
  303. ck_assert_int_eq(fix_quality, 1);
  304. ck_assert_int_eq(satellites, 8);
  305. ck_assert_int_eq(hdop.value, 9);
  306. ck_assert_int_eq(hdop.scale, 10);
  307. ck_assert_int_eq(altitude.value, 5454);
  308. ck_assert_int_eq(altitude.scale, 10);
  309. ck_assert_int_eq(altitude_units, 'M');
  310. ck_assert_int_eq(height.value, 469);
  311. ck_assert_int_eq(height.scale, 10);
  312. ck_assert_int_eq(height_units, 'M');
  313. }
  314. END_TEST
  315. START_TEST(test_minmea_scan_complex2)
  316. {
  317. const char *sentence = "$GPBWC,081837,,,,,,T,,M,,N,*13";
  318. char type[6];
  319. struct minmea_time t;
  320. struct minmea_float latitude; int latitude_direction;
  321. struct minmea_float longitude; int longitude_direction;
  322. struct minmea_float bearing_true; char bearing_true_mark;
  323. struct minmea_float bearing_magnetic; char bearing_magnetic_mark;
  324. struct minmea_float distance; char distance_units;
  325. char name[MINMEA_MAX_LENGTH];
  326. ck_assert(minmea_scan(sentence, "tTfdfdfcfcfcs",
  327. type,
  328. &t,
  329. &latitude, &latitude_direction,
  330. &longitude, &longitude_direction,
  331. &bearing_true, &bearing_true_mark,
  332. &bearing_magnetic, &bearing_magnetic_mark,
  333. &distance, &distance_units,
  334. name) == true);
  335. ck_assert_str_eq(type, "GPBWC");
  336. ck_assert_int_eq(t.hours, 8);
  337. ck_assert_int_eq(t.minutes, 18);
  338. ck_assert_int_eq(t.seconds, 37);
  339. ck_assert_int_eq(latitude.scale, 0);
  340. ck_assert_int_eq(latitude_direction, 0);
  341. ck_assert_int_eq(longitude.scale, 0);
  342. ck_assert_int_eq(longitude_direction, 0);
  343. ck_assert_int_eq(bearing_true.scale, 0);
  344. ck_assert_int_eq(bearing_true_mark, 'T');
  345. ck_assert_int_eq(bearing_magnetic.scale, 0);
  346. ck_assert_int_eq(bearing_magnetic_mark, 'M');
  347. ck_assert_int_eq(distance.scale, 0);
  348. ck_assert_int_eq(distance_units, 'N');
  349. ck_assert_str_eq(name, "");
  350. }
  351. END_TEST
  352. START_TEST(test_minmea_scan_complex3)
  353. {
  354. const char *sentence = "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58";
  355. char type[6];
  356. struct minmea_time t;
  357. struct minmea_float rms_deviation;
  358. struct minmea_float semi_major_deviation;
  359. struct minmea_float semi_minor_deviation;
  360. struct minmea_float semi_major_orientation;
  361. struct minmea_float latitude_error_deviation;
  362. struct minmea_float longitude_error_deviation;
  363. struct minmea_float altitude_error_deviation;
  364. ck_assert(minmea_scan(sentence, "tTfffffff",
  365. type,
  366. &t,
  367. &rms_deviation,
  368. &semi_major_deviation,
  369. &semi_minor_deviation,
  370. &semi_major_orientation,
  371. &latitude_error_deviation,
  372. &longitude_error_deviation,
  373. &altitude_error_deviation) == true);
  374. ck_assert_str_eq(type, "GPGST");
  375. ck_assert_int_eq(t.hours, 2);
  376. ck_assert_int_eq(t.minutes, 46);
  377. ck_assert_int_eq(t.seconds, 3);
  378. ck_assert_int_eq(t.microseconds, 0);
  379. ck_assert_int_eq(rms_deviation.value, 32);
  380. ck_assert_int_eq(rms_deviation.scale, 10);
  381. ck_assert_int_eq(semi_major_deviation.value, 66);
  382. ck_assert_int_eq(semi_major_deviation.scale, 10);
  383. ck_assert_int_eq(semi_minor_deviation.value, 47);
  384. ck_assert_int_eq(semi_minor_deviation.scale, 10);
  385. ck_assert_int_eq(semi_major_orientation.value, 473);
  386. ck_assert_int_eq(semi_major_orientation.scale, 10);
  387. ck_assert_int_eq(latitude_error_deviation.value, 58);
  388. ck_assert_int_eq(latitude_error_deviation.scale, 10);
  389. ck_assert_int_eq(longitude_error_deviation.value, 56);
  390. ck_assert_int_eq(longitude_error_deviation.scale, 10);
  391. ck_assert_int_eq(altitude_error_deviation.value, 220);
  392. ck_assert_int_eq(altitude_error_deviation.scale, 10);
  393. }
  394. END_TEST
  395. START_TEST(test_minmea_parse_rmc1)
  396. {
  397. const char *sentence = "$GPRMC,081836.75,A,3751.65,S,14507.36,E,000.0,360.0,130998,011.3,E";
  398. struct minmea_sentence_rmc frame = {};
  399. static const struct minmea_sentence_rmc expected = {
  400. .time = { 8, 18, 36, 750000 },
  401. .valid = true,
  402. .latitude = { -375165, 100 },
  403. .longitude = { 1450736, 100 },
  404. .speed = { 0, 10 },
  405. .course = { 3600, 10 },
  406. .date = { 13, 9, 98 },
  407. .variation = { 113, 10 },
  408. };
  409. ck_assert(minmea_check(sentence, false) == true);
  410. ck_assert(minmea_check(sentence, true) == false);
  411. ck_assert(minmea_parse_rmc(&frame, sentence) == true);
  412. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  413. }
  414. END_TEST
  415. START_TEST(test_minmea_parse_rmc2)
  416. {
  417. const char *sentence = "$GPRMC,,A,3751.65,N,14507.36,W,,,,,";
  418. struct minmea_sentence_rmc frame = {};
  419. static const struct minmea_sentence_rmc expected = {
  420. .time = { -1, -1, -1, -1 },
  421. .valid = true,
  422. .latitude = { 375165, 100 },
  423. .longitude = { -1450736, 100 },
  424. .date = { -1, -1, -1 },
  425. };
  426. ck_assert(minmea_check(sentence, false) == true);
  427. ck_assert(minmea_check(sentence, true) == false);
  428. ck_assert(minmea_parse_rmc(&frame, sentence) == true);
  429. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  430. }
  431. END_TEST
  432. START_TEST(test_minmea_parse_gga1)
  433. {
  434. const char *sentence = "$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47";
  435. struct minmea_sentence_gga frame = {};
  436. static const struct minmea_sentence_gga expected = {
  437. .time = { 12, 35, 19, 0 },
  438. .latitude = { 4807038, 1000 },
  439. .longitude = { 1131000, 1000 },
  440. .fix_quality = 1,
  441. .satellites_tracked = 8,
  442. .hdop = { 9, 10 },
  443. .altitude = { 5454, 10 },
  444. .altitude_units = 'M',
  445. .height = { 469, 10 },
  446. .height_units = 'M',
  447. .dgps_age = 0,
  448. };
  449. ck_assert(minmea_check(sentence, false) == true);
  450. ck_assert(minmea_check(sentence, true) == true);
  451. ck_assert(minmea_parse_gga(&frame, sentence) == true);
  452. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  453. }
  454. END_TEST
  455. START_TEST(test_minmea_parse_gst1)
  456. {
  457. const char *sentence = "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58";
  458. struct minmea_sentence_gst frame = {};
  459. struct minmea_sentence_gst expected = {
  460. .time = { 2, 46, 3, 0 },
  461. .rms_deviation = { 32, 10 },
  462. .semi_major_deviation = { 66, 10 },
  463. .semi_minor_deviation = { 47, 10 },
  464. .semi_major_orientation = { 473, 10 },
  465. .latitude_error_deviation = { 58, 10 },
  466. .longitude_error_deviation = { 56, 10 },
  467. .altitude_error_deviation = { 220, 10 },
  468. };
  469. ck_assert(minmea_check(sentence, false) == true);
  470. ck_assert(minmea_check(sentence, true) == true);
  471. ck_assert(minmea_parse_gst(&frame, sentence) == true);
  472. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  473. }
  474. END_TEST
  475. START_TEST(test_minmea_parse_gsa1)
  476. {
  477. const char *sentence = "$GPGSA,A,3,04,05,,09,12,,,24,,,,,2.5,1.3,2.1*39";
  478. struct minmea_sentence_gsa frame = {};
  479. static const struct minmea_sentence_gsa expected = {
  480. .mode = MINMEA_GPGSA_MODE_AUTO,
  481. .fix_type = MINMEA_GPGSA_FIX_3D,
  482. .sats = { 4, 5, 0, 9, 12, 0, 0, 24, 0, 0, 0, 0 },
  483. .pdop = { 25, 10 },
  484. .hdop = { 13, 10 },
  485. .vdop = { 21, 10 },
  486. };
  487. ck_assert(minmea_check(sentence, false) == true);
  488. ck_assert(minmea_check(sentence, true) == true);
  489. ck_assert(minmea_parse_gsa(&frame, sentence) == true);
  490. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  491. }
  492. END_TEST
  493. START_TEST(test_minmea_parse_gll1)
  494. {
  495. const char *sentence = "$GPGLL,3723.2475,N,12158.3416,W,161229.487,A,A*41";
  496. struct minmea_sentence_gll frame = {};
  497. struct minmea_sentence_gll expected = {
  498. .latitude = { 37232475, 10000 },
  499. .longitude = { -121583416, 10000 },
  500. .time = { 16, 12, 29, 487000 },
  501. .status = MINMEA_GLL_STATUS_DATA_VALID,
  502. .mode = MINMEA_GLL_MODE_AUTONOMOUS,
  503. };
  504. ck_assert(minmea_check(sentence, false) == true);
  505. ck_assert(minmea_check(sentence, true) == true);
  506. ck_assert(minmea_parse_gll(&frame, sentence) == true);
  507. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  508. }
  509. END_TEST
  510. START_TEST(test_minmea_parse_gll2)
  511. {
  512. const char *sentence = "$GPGLL,4916.45,N,12311.12,W,225444,A";
  513. struct minmea_sentence_gll frame = {};
  514. struct minmea_sentence_gll expected = {
  515. .latitude = { 491645, 100 },
  516. .longitude = { -1231112, 100 },
  517. .time = { 22, 54, 44 },
  518. .status = MINMEA_GLL_STATUS_DATA_VALID,
  519. .mode = 0,
  520. };
  521. ck_assert(minmea_check(sentence, false) == true);
  522. ck_assert(minmea_check(sentence, true) == false);
  523. ck_assert(minmea_parse_gll(&frame, sentence) == true);
  524. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  525. }
  526. END_TEST
  527. START_TEST(test_minmea_parse_gsv1)
  528. {
  529. const char *sentence = "$GPGSV,3,3,11,22,42,067,42,24,14,311,43,27,05,244,00,,,,*4D";
  530. struct minmea_sentence_gsv frame = {};
  531. static const struct minmea_sentence_gsv expected = {
  532. .total_msgs = 3,
  533. .msg_nr = 3,
  534. .total_sats = 11,
  535. .sats = {
  536. {
  537. .nr = 22,
  538. .elevation = 42,
  539. .azimuth = 67,
  540. .snr = 42
  541. },
  542. {
  543. .nr = 24,
  544. .elevation = 14,
  545. .azimuth = 311,
  546. .snr = 43
  547. },
  548. {
  549. .nr = 27,
  550. .elevation = 5,
  551. .azimuth = 244,
  552. .snr = 0
  553. },
  554. {
  555. .nr = 0,
  556. .elevation = 0,
  557. .azimuth = 0,
  558. .snr = 0
  559. }
  560. }
  561. };
  562. ck_assert(minmea_check(sentence, false) == true);
  563. ck_assert(minmea_check(sentence, true) == true);
  564. ck_assert(minmea_parse_gsv(&frame, sentence) == true);
  565. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  566. }
  567. END_TEST
  568. START_TEST(test_minmea_parse_gsv2)
  569. {
  570. const char *sentence = "$GPGSV,4,2,11,08,51,203,30,09,45,215,28*75";
  571. struct minmea_sentence_gsv frame = {};
  572. static const struct minmea_sentence_gsv expected = {
  573. .total_msgs = 4,
  574. .msg_nr = 2,
  575. .total_sats = 11,
  576. .sats = {
  577. {
  578. .nr = 8,
  579. .elevation = 51,
  580. .azimuth = 203,
  581. .snr = 30
  582. },
  583. {
  584. .nr = 9,
  585. .elevation = 45,
  586. .azimuth = 215,
  587. .snr = 28
  588. },
  589. {
  590. .nr = 0,
  591. .elevation = 0,
  592. .azimuth = 0,
  593. .snr = 0
  594. },
  595. {
  596. .nr = 0,
  597. .elevation = 0,
  598. .azimuth = 0,
  599. .snr = 0
  600. }
  601. }
  602. };
  603. ck_assert(minmea_check(sentence, false) == true);
  604. ck_assert(minmea_check(sentence, true) == true);
  605. ck_assert(minmea_parse_gsv(&frame, sentence) == true);
  606. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  607. }
  608. END_TEST
  609. START_TEST(test_minmea_parse_gsv3)
  610. {
  611. const char *sentence = "$GPGSV,4,4,13,39,31,170,27*40";
  612. struct minmea_sentence_gsv frame = {};
  613. static const struct minmea_sentence_gsv expected = {
  614. .total_msgs = 4,
  615. .msg_nr = 4,
  616. .total_sats = 13,
  617. .sats = {
  618. {
  619. .nr = 39,
  620. .elevation = 31,
  621. .azimuth = 170,
  622. .snr = 27
  623. },
  624. {
  625. .nr = 0,
  626. .elevation = 0,
  627. .azimuth = 0,
  628. .snr = 0
  629. },
  630. {
  631. .nr = 0,
  632. .elevation = 0,
  633. .azimuth = 0,
  634. .snr = 0
  635. },
  636. {
  637. .nr = 0,
  638. .elevation = 0,
  639. .azimuth = 0,
  640. .snr = 0
  641. }
  642. }
  643. };
  644. ck_assert(minmea_check(sentence, false) == true);
  645. ck_assert(minmea_check(sentence, true) == true);
  646. ck_assert(minmea_parse_gsv(&frame, sentence) == true);
  647. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  648. }
  649. END_TEST
  650. START_TEST(test_minmea_parse_gsv4)
  651. {
  652. const char *sentence = "$GPGSV,4,4,13*7B";
  653. struct minmea_sentence_gsv frame = {};
  654. static const struct minmea_sentence_gsv expected = {
  655. .total_msgs = 4,
  656. .msg_nr = 4,
  657. .total_sats = 13,
  658. .sats = {
  659. {
  660. .nr = 0,
  661. .elevation = 0,
  662. .azimuth = 0,
  663. .snr = 0
  664. },
  665. {
  666. .nr = 0,
  667. .elevation = 0,
  668. .azimuth = 0,
  669. .snr = 0
  670. },
  671. {
  672. .nr = 0,
  673. .elevation = 0,
  674. .azimuth = 0,
  675. .snr = 0
  676. },
  677. {
  678. .nr = 0,
  679. .elevation = 0,
  680. .azimuth = 0,
  681. .snr = 0
  682. }
  683. }
  684. };
  685. ck_assert(minmea_check(sentence, false) == true);
  686. ck_assert(minmea_check(sentence, true) == true);
  687. ck_assert(minmea_parse_gsv(&frame, sentence) == true);
  688. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  689. }
  690. END_TEST
  691. START_TEST(test_minmea_parse_gsv5)
  692. {
  693. const char *sentence = "$GPGSV,4,1,13,02,28,259,33,04,12,212,27,05,34,305,30,07,79,138,*7F";
  694. struct minmea_sentence_gsv frame = {};
  695. static const struct minmea_sentence_gsv expected = {
  696. .total_msgs = 4,
  697. .msg_nr = 1,
  698. .total_sats = 13,
  699. .sats = {
  700. {
  701. .nr = 2,
  702. .elevation = 28,
  703. .azimuth = 259,
  704. .snr = 33
  705. },
  706. {
  707. .nr = 4,
  708. .elevation = 12,
  709. .azimuth = 212,
  710. .snr = 27
  711. },
  712. {
  713. .nr = 5,
  714. .elevation = 34,
  715. .azimuth = 305,
  716. .snr = 30
  717. },
  718. {
  719. .nr = 7,
  720. .elevation = 79,
  721. .azimuth = 138,
  722. .snr = 0
  723. }
  724. }
  725. };
  726. ck_assert(minmea_check(sentence, false) == true);
  727. ck_assert(minmea_check(sentence, true) == true);
  728. ck_assert(minmea_parse_gsv(&frame, sentence) == true);
  729. ck_assert(!memcmp(&frame, &expected, sizeof(frame)));
  730. }
  731. END_TEST
  732. START_TEST(test_minmea_usage1)
  733. {
  734. const char *sentences[] = {
  735. "$GPRMC,081836,A,3751.65,S,14507.36,E,000.0,360.0,130998,011.3,E*62",
  736. "$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,46.9,M,,*47",
  737. "$GNGSA,A,3,04,05,,09,12,,,24,,,,,2.5,1.3,2.1",
  738. "$GPGLL,3723.2475,N,12158.3416,W,161229.487,A,A*41",
  739. "$GPGST,024603.00,3.2,6.6,4.7,47.3,5.8,5.6,22.0*58",
  740. NULL,
  741. };
  742. for (const char **sentence=sentences; *sentence; sentence++) {
  743. switch (minmea_sentence_id(*sentence, false)) {
  744. case MINMEA_SENTENCE_RMC: {
  745. struct minmea_sentence_rmc frame;
  746. ck_assert(minmea_parse_rmc(&frame, *sentence) == true);
  747. } break;
  748. case MINMEA_SENTENCE_GGA: {
  749. struct minmea_sentence_gga frame;
  750. ck_assert(minmea_parse_gga(&frame, *sentence) == true);
  751. } break;
  752. case MINMEA_SENTENCE_GSA: {
  753. struct minmea_sentence_gsa frame;
  754. ck_assert(minmea_parse_gsa(&frame, *sentence) == true);
  755. } break;
  756. case MINMEA_SENTENCE_GLL: {
  757. struct minmea_sentence_gll frame;
  758. ck_assert(minmea_parse_gll(&frame, *sentence) == true);
  759. } break;
  760. case MINMEA_SENTENCE_GST: {
  761. struct minmea_sentence_gst frame;
  762. ck_assert(minmea_parse_gst(&frame, *sentence) == true);
  763. } break;
  764. default: {
  765. } break;
  766. }
  767. char talker[3];
  768. char expected[3] = { (*sentence)[1], (*sentence)[2], '\0' };
  769. ck_assert(minmea_talker_id(talker, *sentence) == true);
  770. ck_assert_str_eq(talker, expected);
  771. }
  772. }
  773. END_TEST
  774. START_TEST(test_minmea_gettime)
  775. {
  776. struct minmea_date d = { 14, 2, 14 };
  777. struct minmea_time t = { 13, 0, 9, 123456 };
  778. struct timespec ts;
  779. ck_assert(minmea_gettime(&ts, &d, &t) == 0);
  780. ck_assert_int_eq(ts.tv_sec, 1392382809);
  781. ck_assert_int_eq(ts.tv_nsec, 123456000);
  782. d.year = -1;
  783. ck_assert(minmea_gettime(&ts, &d, &t) != 0);
  784. d.year = 2014;
  785. t.hours = -1;
  786. ck_assert(minmea_gettime(&ts, &d, &t) != 0);
  787. }
  788. END_TEST
  789. START_TEST(test_minmea_rescale)
  790. {
  791. /* basic and edge cases. */
  792. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { 42, 0 }, 3), 0);
  793. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { 1234, 10 }, 1), 123);
  794. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { 1235, 10 }, 1), 124);
  795. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { 1234, 10 }, 1000), 123400);
  796. /* round towards zero. */
  797. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { -1234, 10 }, 1), -123);
  798. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { -1235, 10 }, 1), -124);
  799. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { -1236, 10 }, 1), -124);
  800. /* shouldn't overflow on large numbers. */
  801. ck_assert_int_eq(minmea_rescale(&(struct minmea_float) { 510693608, 100000 }, 10000), 51069361);
  802. }
  803. END_TEST
  804. /* The float values used in tests should be exactly representable under IEEE754;
  805. * false negatives will occur otherwise. */
  806. #define assert_float_eq(x, y) ck_assert(fabsf((x) - (y)) <= 0.0f)
  807. START_TEST(test_minmea_float)
  808. {
  809. ck_assert(isnan(minmea_tofloat(&(struct minmea_float) { 42, 0 })));
  810. assert_float_eq(minmea_tofloat(&(struct minmea_float) { 7, 1 }), 7.0f);
  811. assert_float_eq(minmea_tofloat(&(struct minmea_float) { -200, 100 }), -2.0f);
  812. assert_float_eq(minmea_tofloat(&(struct minmea_float) { 15, 10 }), 1.5f);
  813. }
  814. END_TEST
  815. START_TEST(test_minmea_coord)
  816. {
  817. ck_assert(isnan(minmea_tocoord(&(struct minmea_float) { 42, 0 })));
  818. assert_float_eq(minmea_tocoord(&(struct minmea_float) { 4200, 1 }), 42.0f);
  819. assert_float_eq(minmea_tocoord(&(struct minmea_float) { 420000, 100 }), 42.0f);
  820. assert_float_eq(minmea_tocoord(&(struct minmea_float) { 423000, 100 }), 42.5f);
  821. }
  822. END_TEST
  823. static Suite *minmea_suite(void)
  824. {
  825. Suite *s = suite_create ("minmea");
  826. TCase *tc_check = tcase_create("minmea_check");
  827. tcase_add_test(tc_check, test_minmea_check);
  828. suite_add_tcase(s, tc_check);
  829. TCase *tc_scan = tcase_create("minmea_scan");
  830. tcase_add_test(tc_scan, test_minmea_scan_c);
  831. tcase_add_test(tc_scan, test_minmea_scan_d);
  832. tcase_add_test(tc_scan, test_minmea_scan_f);
  833. tcase_add_test(tc_scan, test_minmea_scan_i);
  834. tcase_add_test(tc_scan, test_minmea_scan_s);
  835. tcase_add_test(tc_scan, test_minmea_scan_t);
  836. tcase_add_test(tc_scan, test_minmea_scan_D);
  837. tcase_add_test(tc_scan, test_minmea_scan_T);
  838. tcase_add_test(tc_scan, test_minmea_scan_complex1);
  839. tcase_add_test(tc_scan, test_minmea_scan_complex2);
  840. tcase_add_test(tc_scan, test_minmea_scan_complex3);
  841. suite_add_tcase(s, tc_scan);
  842. TCase *tc_parse = tcase_create("minmea_parse");
  843. tcase_add_test(tc_parse, test_minmea_parse_rmc1);
  844. tcase_add_test(tc_parse, test_minmea_parse_rmc2);
  845. tcase_add_test(tc_parse, test_minmea_parse_gga1);
  846. tcase_add_test(tc_parse, test_minmea_parse_gsa1);
  847. tcase_add_test(tc_parse, test_minmea_parse_gll1);
  848. tcase_add_test(tc_parse, test_minmea_parse_gll2);
  849. tcase_add_test(tc_parse, test_minmea_parse_gst1);
  850. tcase_add_test(tc_parse, test_minmea_parse_gsv1);
  851. tcase_add_test(tc_parse, test_minmea_parse_gsv2);
  852. tcase_add_test(tc_parse, test_minmea_parse_gsv3);
  853. tcase_add_test(tc_parse, test_minmea_parse_gsv4);
  854. tcase_add_test(tc_parse, test_minmea_parse_gsv5);
  855. suite_add_tcase(s, tc_parse);
  856. TCase *tc_usage = tcase_create("minmea_usage");
  857. tcase_add_test(tc_usage, test_minmea_usage1);
  858. suite_add_tcase(s, tc_usage);
  859. TCase *tc_utils = tcase_create("minmea_utils");
  860. tcase_add_test(tc_utils, test_minmea_gettime);
  861. tcase_add_test(tc_utils, test_minmea_rescale);
  862. tcase_add_test(tc_utils, test_minmea_float);
  863. tcase_add_test(tc_utils, test_minmea_coord);
  864. suite_add_tcase(s, tc_utils);
  865. return s;
  866. }
  867. int main(void)
  868. {
  869. int number_failed;
  870. Suite *s = minmea_suite();
  871. SRunner *sr = srunner_create(s);
  872. srunner_run_all(sr, CK_NORMAL);
  873. number_failed = srunner_ntests_failed(sr);
  874. srunner_free(sr);
  875. return (number_failed == 0) ? EXIT_SUCCESS : EXIT_FAILURE;
  876. }
  877. /* vim: set ts=4 sw=4 et: */