driver_rtcm3.c 43 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423
  1. /*****************************************************************************
  2. This is a decoder for RTCM-104 3.x, a serial protocol used for
  3. broadcasting pseudorange corrections from differential-GPS reference
  4. stations. The applicable specification is RTCM 10403.1: RTCM Paper
  5. 177-2006-SC104-STD. This obsolesces the earlier RTCM-104 2.x
  6. specifications. The specification document is proprietary; ordering
  7. instructions are accessible from <http://www.rtcm.org/>
  8. under "Publications".
  9. Unike the RTCM 2.x protocol, RTCM3.x does not use the strange
  10. sliding-bit-window IS-GPS-200 protocol as a transport layer, but is a
  11. self-contained byte-oriented packet protocol. Packet recognition is
  12. handled in the GPSD packet-getter state machine; this code is
  13. concerned with unpacking the packets into well-behaved C structures,
  14. coping with odd field lengths and fields that may overlap byte
  15. boundaries. These report structures live in gps.h.
  16. Note that the unpacking this module does is probably useful only for
  17. RTCM reporting and diagnostic tools. It is not necessary when
  18. passing RTCM corrections to a GPS, which normally should just be
  19. passed an entire correction packet for processing by their internal
  20. firmware.
  21. Decodes of the following types have been verified: 1004, 1005, 1006,
  22. 1008, 1012, 1013, 1029. There is good reason to believe the 1007 code
  23. is correct, as it's identical to 1008 up to where it ends.
  24. The 1033 decode was arrived at by looking at an rtcminspect dump and noting
  25. that it carries an information superset of the 1008. There are additional
  26. Receiver and Firmware fields we're not certain to decode without access
  27. to an RTCM3 standard at revision 4 or later, but the guess in the code
  28. has been observed to correctly analyze a message with a nonempty Receiver
  29. field.
  30. This file is Copyright 2010 by the GPSD project
  31. SPDX-License-Identifier: BSD-2-clause
  32. *****************************************************************************/
  33. #include "gpsd_config.h" /* must be before all includes */
  34. #include <string.h>
  35. #include "gpsd.h"
  36. #include "bits.h"
  37. #ifdef RTCM104V3_ENABLE
  38. /* scaling constants for RTCM3 real number types */
  39. #define GPS_PSEUDORANGE_RESOLUTION 0.02 /* DF011 */
  40. #define PSEUDORANGE_DIFF_RESOLUTION 0.0005 /* DF012,DF042 */
  41. #define CARRIER_NOISE_RATIO_UNITS 0.25 /* DF015, DF045, DF50 */
  42. #define ANTENNA_POSITION_RESOLUTION 0.0001 /* DF025-027 */
  43. #define GLONASS_PSEUDORANGE_RESOLUTION 0.02 /* DF041 */
  44. #define ANTENNA_DEGREE_RESOLUTION 25e-6 /* DF062 */
  45. #define GPS_EPOCH_TIME_RESOLUTION 0.1 /* DF065 */
  46. #define PHASE_CORRECTION_RESOLUTION 0.5 /* DF069-070 */
  47. /* Other magic values */
  48. #define GPS_INVALID_PSEUDORANGE 0x80000 /* DF012, DF018 */
  49. #define GLONASS_INVALID_RANGEINCR 0x2000 /* DF047 */
  50. #define GLONASS_CHANNEL_BASE 7 /* DF040 */
  51. /* Large case statements make GNU indent very confused */
  52. /* *INDENT-OFF* */
  53. /* good source on message types:
  54. * https://software.rtcm-ntrip.org/export/HEAD/ntrip/trunk/BNC/src/bnchelp.html
  55. * Also look in the BNC source
  56. * and look at the tklib source: http://www.rtklib.com/
  57. */
  58. void rtcm3_unpack(const struct gps_context_t *context,
  59. struct rtcm3_t *rtcm, char *buf)
  60. /* break out the raw bits into the scaled report-structure fields */
  61. {
  62. unsigned int n, n2, n3, n4;
  63. int bitcount = 0;
  64. unsigned int i;
  65. signed long temp;
  66. bool unknown = true; // we don't know how to decode
  67. const char *unknown_name = NULL; // no decode, but maybe we know the name
  68. #define ugrab(width) (bitcount += width, ubits((unsigned char *)buf, \
  69. bitcount-width, width, false))
  70. #define sgrab(width) (bitcount += width, sbits((signed char *)buf, \
  71. bitcount-width, width, false))
  72. #define GPS_PSEUDORANGE(fld, len) \
  73. {temp = (unsigned long)ugrab(len); \
  74. if (temp == GPS_INVALID_PSEUDORANGE) \
  75. fld.pseudorange = 0; \
  76. else \
  77. fld.pseudorange = temp * GPS_PSEUDORANGE_RESOLUTION;}
  78. #define RANGEDIFF(fld, len) \
  79. temp = (long)sgrab(len); \
  80. if (temp == GPS_INVALID_PSEUDORANGE) \
  81. fld.rangediff = 0; \
  82. else \
  83. fld.rangediff = temp * PSEUDORANGE_DIFF_RESOLUTION;
  84. memset(rtcm, 0, sizeof(struct rtcm3_t));
  85. //assert(ugrab(8) == 0xD3);
  86. //assert(ugrab(6) == 0x00);
  87. ugrab(14);
  88. rtcm->length = (unsigned int)ugrab(10);
  89. rtcm->type = (unsigned int)ugrab(12);
  90. GPSD_LOG(LOG_RAW, &context->errout, "RTCM3: type %d payload length %d\n",
  91. rtcm->type, rtcm->length);
  92. // RTCM3 message type numbers start at 1001
  93. switch (rtcm->type) {
  94. case 1001:
  95. /* GPS Basic RTK, L1 Only */
  96. rtcm->rtcmtypes.rtcm3_1001.header.station_id = (unsigned int)ugrab(12);
  97. rtcm->rtcmtypes.rtcm3_1001.header.tow = (time_t)ugrab(30);
  98. rtcm->rtcmtypes.rtcm3_1001.header.sync = (bool)ugrab(1);
  99. rtcm->rtcmtypes.rtcm3_1001.header.satcount = (unsigned short)ugrab(5);
  100. rtcm->rtcmtypes.rtcm3_1001.header.smoothing = (bool)ugrab(1);
  101. rtcm->rtcmtypes.rtcm3_1001.header.interval = (unsigned short)ugrab(3);
  102. #define R1001 rtcm->rtcmtypes.rtcm3_1001.rtk_data[i]
  103. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1001.header.satcount; i++) {
  104. R1001.ident = (unsigned short)ugrab(6);
  105. R1001.L1.indicator = (unsigned char)ugrab(1);
  106. GPS_PSEUDORANGE(R1001.L1, 24);
  107. RANGEDIFF(R1001.L1, 20);
  108. R1001.L1.locktime = (unsigned char)sgrab(7);
  109. }
  110. #undef R1001
  111. unknown = false;
  112. break;
  113. case 1002:
  114. /* GPS Extended RTK, L1 Only */
  115. rtcm->rtcmtypes.rtcm3_1002.header.station_id = (unsigned int)ugrab(12);
  116. rtcm->rtcmtypes.rtcm3_1002.header.tow = (time_t)ugrab(30);
  117. rtcm->rtcmtypes.rtcm3_1002.header.sync = (bool)ugrab(1);
  118. rtcm->rtcmtypes.rtcm3_1002.header.satcount = (unsigned short)ugrab(5);
  119. rtcm->rtcmtypes.rtcm3_1002.header.smoothing = (bool)ugrab(1);
  120. rtcm->rtcmtypes.rtcm3_1002.header.interval = (unsigned short)ugrab(3);
  121. #define R1002 rtcm->rtcmtypes.rtcm3_1002.rtk_data[i]
  122. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1002.header.satcount; i++) {
  123. R1002.ident = (unsigned short)ugrab(6);
  124. R1002.L1.indicator = (unsigned char)ugrab(1);
  125. GPS_PSEUDORANGE(R1002.L1, 24);
  126. RANGEDIFF(R1002.L1, 20);
  127. R1002.L1.locktime = (unsigned char)sgrab(7);
  128. R1002.L1.ambiguity = (unsigned char)ugrab(8);
  129. R1002.L1.CNR = (ugrab(8)) * CARRIER_NOISE_RATIO_UNITS;
  130. }
  131. #undef R1002
  132. unknown = false;
  133. break;
  134. case 1003:
  135. /* GPS Basic RTK, L1 & L2 */
  136. rtcm->rtcmtypes.rtcm3_1003.header.station_id = (unsigned int)ugrab(12);
  137. rtcm->rtcmtypes.rtcm3_1003.header.tow = (time_t)ugrab(30);
  138. rtcm->rtcmtypes.rtcm3_1003.header.sync = (bool)ugrab(1);
  139. rtcm->rtcmtypes.rtcm3_1003.header.satcount = (unsigned short)ugrab(5);
  140. rtcm->rtcmtypes.rtcm3_1003.header.smoothing = (bool)ugrab(1);
  141. rtcm->rtcmtypes.rtcm3_1003.header.interval = (unsigned short)ugrab(3);
  142. #define R1003 rtcm->rtcmtypes.rtcm3_1003.rtk_data[i]
  143. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1003.header.satcount; i++) {
  144. R1003.ident = (unsigned short)ugrab(6);
  145. R1003.L1.indicator =
  146. (unsigned char)ugrab(1);
  147. GPS_PSEUDORANGE(R1003.L1, 24);
  148. RANGEDIFF(R1003.L1, 20);
  149. R1003.L1.locktime = (unsigned char)sgrab(7);
  150. R1003.L2.indicator = (unsigned char)ugrab(2);
  151. GPS_PSEUDORANGE(R1003.L2, 24);
  152. temp = (long)sgrab(20);
  153. if (temp == GPS_INVALID_PSEUDORANGE)
  154. R1003.L2.rangediff = 0;
  155. else
  156. R1003.L2.rangediff = temp * PSEUDORANGE_DIFF_RESOLUTION;
  157. R1003.L2.locktime = (unsigned char)sgrab(7);
  158. }
  159. #undef R1003
  160. unknown = false;
  161. break;
  162. case 1004:
  163. /* GPS Extended RTK, L1 & L2 */
  164. rtcm->rtcmtypes.rtcm3_1004.header.station_id = (unsigned int)ugrab(12);
  165. rtcm->rtcmtypes.rtcm3_1004.header.tow = (time_t)ugrab(30);
  166. rtcm->rtcmtypes.rtcm3_1004.header.sync = (bool)ugrab(1);
  167. rtcm->rtcmtypes.rtcm3_1004.header.satcount = (unsigned short)ugrab(5);
  168. rtcm->rtcmtypes.rtcm3_1004.header.smoothing = (bool)ugrab(1);
  169. rtcm->rtcmtypes.rtcm3_1004.header.interval = (unsigned short)ugrab(3);
  170. #define R1004 rtcm->rtcmtypes.rtcm3_1004.rtk_data[i]
  171. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1004.header.satcount; i++) {
  172. R1004.ident = (unsigned short)ugrab(6);
  173. R1004.L1.indicator = (bool)ugrab(1);
  174. GPS_PSEUDORANGE(R1004.L1, 24);
  175. RANGEDIFF(R1004.L1, 20);
  176. R1004.L1.locktime = (unsigned char)sgrab(7);
  177. R1004.L1.ambiguity = (unsigned char)ugrab(8);
  178. R1004.L1.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  179. R1004.L2.indicator = (unsigned char)ugrab(2);
  180. GPS_PSEUDORANGE(R1004.L2, 14);
  181. RANGEDIFF(R1004.L2, 20);
  182. R1004.L2.locktime = (unsigned char)sgrab(7);
  183. R1004.L2.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  184. }
  185. #undef R1004
  186. unknown = false;
  187. break;
  188. case 1005:
  189. /* Stationary Antenna Reference Point, No Height Information
  190. * 19 bytes */
  191. #define R1005 rtcm->rtcmtypes.rtcm3_1005
  192. R1005.station_id = (unsigned short)ugrab(12);
  193. ugrab(6); /* reserved */
  194. R1005.system = ugrab(3);
  195. R1005.reference_station = (bool)ugrab(1);
  196. R1005.ecef_x = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  197. R1005.single_receiver = ugrab(1);
  198. ugrab(1);
  199. R1005.ecef_y = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  200. ugrab(2);
  201. R1005.ecef_z = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  202. #undef R1005
  203. unknown = false;
  204. break;
  205. case 1006:
  206. /* Stationary Antenna Reference Point, with Height Information
  207. * 21 bytes */
  208. #define R1006 rtcm->rtcmtypes.rtcm3_1006
  209. R1006.station_id = (unsigned short)ugrab(12);
  210. (void)ugrab(6); /* reserved */
  211. R1006.system = ugrab(3);
  212. R1006.reference_station = (bool)ugrab(1);
  213. R1006.ecef_x = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  214. R1006.single_receiver = ugrab(1);
  215. ugrab(1);
  216. R1006.ecef_y = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  217. ugrab(2);
  218. R1006.ecef_z = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  219. R1006.height = ugrab(16) * ANTENNA_POSITION_RESOLUTION;
  220. #undef R1006
  221. unknown = false;
  222. break;
  223. case 1007:
  224. /* Antenna Description
  225. * 5 to 36 bytes */
  226. rtcm->rtcmtypes.rtcm3_1007.station_id = (unsigned short)ugrab(12);
  227. n = (unsigned long)ugrab(8);
  228. (void)memcpy(rtcm->rtcmtypes.rtcm3_1007.descriptor, buf + 7, n);
  229. rtcm->rtcmtypes.rtcm3_1007.descriptor[n] = '\0';
  230. bitcount += 8 * n;
  231. rtcm->rtcmtypes.rtcm3_1007.setup_id = ugrab(8);
  232. unknown = false;
  233. break;
  234. case 1008:
  235. /* Antenna Description & Serial Number
  236. * 6 to 68 bytes */
  237. rtcm->rtcmtypes.rtcm3_1008.station_id = (unsigned short)ugrab(12);
  238. n = (unsigned long)ugrab(8);
  239. (void)memcpy(rtcm->rtcmtypes.rtcm3_1008.descriptor, buf + 7, n);
  240. rtcm->rtcmtypes.rtcm3_1008.descriptor[n] = '\0';
  241. bitcount += 8 * n;
  242. rtcm->rtcmtypes.rtcm3_1008.setup_id = ugrab(8);
  243. n2 = (unsigned long)ugrab(8);
  244. (void)memcpy(rtcm->rtcmtypes.rtcm3_1008.serial, buf + 9 + n, n2);
  245. rtcm->rtcmtypes.rtcm3_1008.serial[n2] = '\0';
  246. //bitcount += 8 * n2;
  247. unknown = false;
  248. break;
  249. case 1009:
  250. /* GLONASS Basic RTK, L1 Only */
  251. rtcm->rtcmtypes.rtcm3_1009.header.station_id =
  252. (unsigned short)ugrab(12);
  253. rtcm->rtcmtypes.rtcm3_1009.header.tow = (time_t)ugrab(27);
  254. rtcm->rtcmtypes.rtcm3_1009.header.sync = (bool)ugrab(1);
  255. rtcm->rtcmtypes.rtcm3_1009.header.satcount = (unsigned short)ugrab(5);
  256. rtcm->rtcmtypes.rtcm3_1009.header.smoothing = (bool)ugrab(1);
  257. rtcm->rtcmtypes.rtcm3_1009.header.interval = (unsigned short)ugrab(3);
  258. #define R1009 rtcm->rtcmtypes.rtcm3_1009.rtk_data[i]
  259. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1009.header.satcount; i++) {
  260. R1009.ident = (unsigned short)ugrab(6);
  261. R1009.L1.indicator = (bool)ugrab(1);
  262. R1009.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  263. R1009.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  264. RANGEDIFF(R1009.L1, 20);
  265. R1009.L1.locktime = (unsigned char)sgrab(7);
  266. }
  267. #undef R1009
  268. unknown = false;
  269. break;
  270. case 1010:
  271. /* GLONASS Extended RTK, L1 Only */
  272. rtcm->rtcmtypes.rtcm3_1010.header.station_id =
  273. (unsigned short)ugrab(12);
  274. rtcm->rtcmtypes.rtcm3_1010.header.tow = (time_t)ugrab(27);
  275. rtcm->rtcmtypes.rtcm3_1010.header.sync = (bool)ugrab(1);
  276. rtcm->rtcmtypes.rtcm3_1010.header.satcount = (unsigned short)ugrab(5);
  277. rtcm->rtcmtypes.rtcm3_1010.header.smoothing = (bool)ugrab(1);
  278. rtcm->rtcmtypes.rtcm3_1010.header.interval = (unsigned short)ugrab(3);
  279. #define R1010 rtcm->rtcmtypes.rtcm3_1010.rtk_data[i]
  280. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1010.header.satcount; i++) {
  281. R1010.ident = (unsigned short)ugrab(6);
  282. R1010.L1.indicator = (bool)ugrab(1);
  283. R1010.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  284. R1010.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  285. RANGEDIFF(R1010.L1, 20);
  286. R1010.L1.locktime = (unsigned char)sgrab(7);
  287. R1010.L1.ambiguity = (unsigned char)ugrab(7);
  288. R1010.L1.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  289. }
  290. #undef R1010
  291. unknown = false;
  292. break;
  293. case 1011:
  294. /* GLONASS Basic RTK, L1 & L2 */
  295. rtcm->rtcmtypes.rtcm3_1011.header.station_id =
  296. (unsigned short)ugrab(12);
  297. rtcm->rtcmtypes.rtcm3_1011.header.tow = (time_t)ugrab(27);
  298. rtcm->rtcmtypes.rtcm3_1011.header.sync = (bool)ugrab(1);
  299. rtcm->rtcmtypes.rtcm3_1011.header.satcount = (unsigned short)ugrab(5);
  300. rtcm->rtcmtypes.rtcm3_1011.header.smoothing = (bool)ugrab(1);
  301. rtcm->rtcmtypes.rtcm3_1011.header.interval = (unsigned short)ugrab(3);
  302. #define R1011 rtcm->rtcmtypes.rtcm3_1011.rtk_data[i]
  303. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1011.header.satcount; i++) {
  304. R1011.ident = (unsigned short)ugrab(6);
  305. R1011.L1.indicator = (bool)ugrab(1);
  306. R1011.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  307. R1011.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  308. RANGEDIFF(R1011.L1, 20);
  309. R1011.L1.locktime = (unsigned char)sgrab(7);
  310. R1011.L1.ambiguity = (unsigned char)ugrab(7);
  311. R1011.L1.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  312. R1011.L2.indicator = (bool)ugrab(1);
  313. R1011.L2.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  314. R1011.L2.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  315. RANGEDIFF(R1011.L2, 20);
  316. R1011.L2.locktime = (unsigned char)sgrab(7);
  317. R1011.L2.ambiguity = (unsigned char)ugrab(7);
  318. R1011.L2.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  319. }
  320. #undef R1011
  321. unknown = false;
  322. break;
  323. case 1012:
  324. /* GLONASS Extended RTK, L1 & L2 */
  325. rtcm->rtcmtypes.rtcm3_1012.header.station_id =
  326. (unsigned short)ugrab(12);
  327. rtcm->rtcmtypes.rtcm3_1012.header.tow = (time_t)ugrab(27);
  328. rtcm->rtcmtypes.rtcm3_1012.header.sync = (bool)ugrab(1);
  329. rtcm->rtcmtypes.rtcm3_1012.header.satcount = (unsigned short)ugrab(5);
  330. rtcm->rtcmtypes.rtcm3_1012.header.smoothing = (bool)ugrab(1);
  331. rtcm->rtcmtypes.rtcm3_1012.header.interval = (unsigned short)ugrab(3);
  332. #define R1012 rtcm->rtcmtypes.rtcm3_1012.rtk_data[i]
  333. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1012.header.satcount; i++) {
  334. unsigned int rangeincr;
  335. R1012.ident = (unsigned short)ugrab(6);
  336. R1012.L1.indicator = (bool)ugrab(1);
  337. R1012.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  338. R1012.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  339. RANGEDIFF(R1012.L1, 20);
  340. R1012.L1.locktime = (unsigned char)ugrab(7);
  341. R1012.L1.ambiguity = (unsigned char)ugrab(7);
  342. R1012.L1.CNR = (unsigned char)ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  343. R1012.L2.indicator = (bool)ugrab(2);
  344. rangeincr = ugrab(14);
  345. if (rangeincr == GLONASS_INVALID_RANGEINCR)
  346. R1012.L2.pseudorange = 0;
  347. else
  348. R1012.L2.pseudorange = (rangeincr *
  349. GLONASS_PSEUDORANGE_RESOLUTION);
  350. RANGEDIFF(R1012.L2, 20);
  351. R1012.L2.locktime = (unsigned char)sgrab(7);
  352. R1012.L2.CNR = (unsigned char)ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  353. }
  354. #undef R1012
  355. unknown = false;
  356. break;
  357. case 1013:
  358. /* System Parameters */
  359. rtcm->rtcmtypes.rtcm3_1013.station_id = (unsigned short)ugrab(12);
  360. rtcm->rtcmtypes.rtcm3_1013.mjd = (unsigned short)ugrab(16);
  361. rtcm->rtcmtypes.rtcm3_1013.sod = (unsigned short)ugrab(17);
  362. rtcm->rtcmtypes.rtcm3_1013.ncount = (unsigned long)ugrab(5);
  363. rtcm->rtcmtypes.rtcm3_1013.leapsecs = (unsigned char)ugrab(8);
  364. #define R1013 rtcm->rtcmtypes.rtcm3_1013.announcements[i]
  365. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1013.ncount; i++) {
  366. R1013.id = (unsigned short)ugrab(12);
  367. R1013.sync = (bool)ugrab(1);
  368. R1013.interval = (unsigned short)ugrab(16);
  369. }
  370. #undef R1013
  371. unknown = false;
  372. break;
  373. case 1014:
  374. /* Network Auxiliary Station Data
  375. * coordinate difference between one Aux station and the master station
  376. */
  377. rtcm->rtcmtypes.rtcm3_1014.network_id = (int)ugrab(8);
  378. rtcm->rtcmtypes.rtcm3_1014.subnetwork_id = (int)ugrab(4);
  379. rtcm->rtcmtypes.rtcm3_1014.stationcount = (char)ugrab(5);
  380. rtcm->rtcmtypes.rtcm3_1014.master_id = (int)ugrab(12);
  381. rtcm->rtcmtypes.rtcm3_1014.aux_id = (int)ugrab(12);
  382. rtcm->rtcmtypes.rtcm3_1014.d_lat =
  383. (unsigned short)ugrab(20) * ANTENNA_DEGREE_RESOLUTION;
  384. rtcm->rtcmtypes.rtcm3_1014.d_lon =
  385. (unsigned short)ugrab(21) * ANTENNA_DEGREE_RESOLUTION;
  386. rtcm->rtcmtypes.rtcm3_1014.d_alt = (unsigned short)ugrab(23) / 1000;
  387. unknown = false;
  388. break;
  389. case 1015:
  390. /* RTCM 3.1
  391. * GPS Ionospheric Correction Differences for all satellites
  392. * between the master station and one auxiliary station
  393. * 9 bytes minimum
  394. */
  395. unknown_name = "GPS Ionospheric Correction Differences";
  396. break;
  397. case 1016:
  398. /* RTCM 3.1
  399. * GPS Geometric Correction Differences for all satellites between
  400. * the master station and one auxiliary station.
  401. * 9 bytes minimum
  402. */
  403. unknown_name = "GPS Geometric Correction Differences";
  404. break;
  405. case 1017:
  406. /* RTCM 3.1
  407. * GPS Combined Geometric and Ionospheric Correction Differences
  408. * for all satellites between one Aux station and the master station
  409. * (same content as both types 1015 and 1016 together, but less size)
  410. * 9 bytes minimum
  411. */
  412. unknown_name = "GPS Combined Geometric and Ionospheric "
  413. "Correction Differences";
  414. break;
  415. case 1018:
  416. /* RTCM 3.1
  417. * Reserved for alternative Ionospheric Correction Difference Message
  418. */
  419. unknown_name = "Reserved for alternative Ionospheric Correction "
  420. "Differences";
  421. break;
  422. case 1019:
  423. /* RTCM 3.1 - 1020
  424. * GPS Ephemeris
  425. * 62 bytes
  426. */
  427. /* TODO: rtklib has C code for this one. */
  428. unknown_name = "GPS Ephemeris";
  429. break;
  430. case 1020:
  431. /* RTCM 3.1 - 1020
  432. * GLONASS Ephemeris
  433. * 45 bytes
  434. */
  435. /* TODO: rtklib has C code for this one. */
  436. unknown_name = "GLO Ephemeris";
  437. break;
  438. case 1021:
  439. /* RTCM 3.1
  440. * Helmert / Abridged Molodenski Transformation parameters
  441. */
  442. unknown_name = "Helmert / Abridged Molodenski Transformation "
  443. "parameters";
  444. break;
  445. case 1022:
  446. /* RTCM 3.1
  447. * Molodenski-Badekas transformation parameters
  448. */
  449. unknown_name = "Molodenski-Badekas transformation parameters";
  450. break;
  451. case 1023:
  452. /* RTCM 3.1
  453. * Residuals Ellipsoidal Grid Representation
  454. */
  455. unknown_name = "Residuals Ellipsoidal Grid Representation";
  456. break;
  457. case 1024:
  458. /* RTCM 3.1
  459. * Residuals Plane Grid Representation
  460. */
  461. unknown_name = "Residuals Plane Grid Representation";
  462. break;
  463. case 1025:
  464. /* RTCM 3.1
  465. * Projection Parameters, Projection Types other than LCC2SP
  466. */
  467. unknown_name = "Projection Parameters, Projection Types other "
  468. "than LCC2SP";
  469. break;
  470. case 1026:
  471. /* RTCM 3.1
  472. * Projection Parameters, Projection Type LCC2SP
  473. * (Lambert Conic Conformal)
  474. */
  475. unknown_name = "Projection Parameters, Projection Type LCC2SP";
  476. break;
  477. case 1027:
  478. /* RTCM 3.1
  479. * Projection Parameters, Projection Type OM (Oblique Mercator)
  480. */
  481. unknown_name = "Projection Parameters, Projection Type OM";
  482. break;
  483. case 1028:
  484. /* RTCM 3.1
  485. * Reserved for global to plate fixed transformation
  486. */
  487. unknown_name = "Reserved, Global to Plate Transformation";
  488. break;
  489. case 1029:
  490. /* Text in UTF8 format
  491. * 9 bytes minimum
  492. * (max. 127 multibyte characters and max. 255 bytes)
  493. */
  494. rtcm->rtcmtypes.rtcm3_1029.station_id = (unsigned short)ugrab(12);
  495. rtcm->rtcmtypes.rtcm3_1029.mjd = (unsigned short)ugrab(16);
  496. rtcm->rtcmtypes.rtcm3_1029.sod = (unsigned short)ugrab(17);
  497. rtcm->rtcmtypes.rtcm3_1029.len = (unsigned long)ugrab(7);
  498. rtcm->rtcmtypes.rtcm3_1029.unicode_units = (size_t)ugrab(8);
  499. (void)memcpy(rtcm->rtcmtypes.rtcm3_1029.text,
  500. buf + 12, rtcm->rtcmtypes.rtcm3_1029.unicode_units);
  501. unknown = false;
  502. break;
  503. case 1030:
  504. /* RTCM 3.1
  505. * GPS Network RTK Residual Message
  506. */
  507. unknown_name = "GPS Network RTK Residual";
  508. break;
  509. case 1031:
  510. /* RTCM 3.1
  511. * GLONASS Network RTK Residual Message
  512. */
  513. unknown_name = "GLONASS Network RTK Residual";
  514. break;
  515. case 1032:
  516. /* RTCM 3.1
  517. * Physical Reference Station Position message
  518. */
  519. unknown_name = "Physical Reference Station Position";
  520. break;
  521. case 1033: /* see note in header */
  522. /* Receiver and Antenna Descriptor
  523. * Type1033 is a combined Message Types 1007 and 1008
  524. * and hence contains antenna descriptor and serial number
  525. * as well as receiver descriptor and serial number.
  526. */
  527. /* TODO: rtklib has C code for this one. */
  528. rtcm->rtcmtypes.rtcm3_1033.station_id = (unsigned short)ugrab(12);
  529. n = (unsigned long)ugrab(8);
  530. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.descriptor, buf + 7, n);
  531. rtcm->rtcmtypes.rtcm3_1033.descriptor[n] = '\0';
  532. bitcount += 8 * n;
  533. rtcm->rtcmtypes.rtcm3_1033.setup_id = ugrab(8);
  534. n2 = (unsigned long)ugrab(8);
  535. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.serial, buf + 9 + n, n2);
  536. rtcm->rtcmtypes.rtcm3_1033.serial[n2] = '\0';
  537. bitcount += 8 * n2;
  538. n3 = (unsigned long)ugrab(8);
  539. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.receiver, buf + 10+n+n2, n3);
  540. rtcm->rtcmtypes.rtcm3_1033.receiver[n3] = '\0';
  541. bitcount += 8 * n3;
  542. n4 = (unsigned long)ugrab(8);
  543. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.firmware, buf + 11+n+n2+n3, n3);
  544. rtcm->rtcmtypes.rtcm3_1033.firmware[n4] = '\0';
  545. //bitcount += 8 * n4;
  546. // TODO: next is receiver serial number
  547. unknown = false;
  548. break;
  549. case 1034:
  550. /* RTCM 3.2
  551. * GPS Network FKP Gradient Message
  552. */
  553. unknown_name = "GPS Network FKP Gradient";
  554. break;
  555. case 1035:
  556. /* RTCM 3.2
  557. * GLONASS Network FKP Gradient Message
  558. */
  559. unknown_name = "GLO Network FKP Gradient";
  560. break;
  561. case 1037:
  562. /* RTCM 3.2
  563. * GLONASS Ionospheric Correction Differences
  564. */
  565. unknown_name = "GLO Ionospheric Correction Differences";
  566. break;
  567. case 1038:
  568. /* RTCM 3.2
  569. * GLONASS Geometric Correction Differences
  570. */
  571. unknown_name = "GLO Geometric Correction Differences";
  572. break;
  573. case 1039:
  574. /* RTCM 3.2
  575. * GLONASS Combined Geometric and Ionospheric Correction Differences
  576. */
  577. unknown_name = "GLONASS Combined Geometric and Ionospheric "
  578. "Correction Differences";
  579. break;
  580. case 1042:
  581. /* RTCM 3.x - 1043
  582. * BeiDou Ephemeris
  583. * length ?
  584. */
  585. unknown_name = "BD Ephemeris";
  586. break;
  587. case 1043:
  588. /* RTCM 3.x - 1043
  589. * SBAS Ephemeris
  590. * length 29
  591. */
  592. unknown_name = "SBAS Ephemeris";
  593. break;
  594. case 1044:
  595. /* RTCM 3.x - 1044
  596. * QZSS ephemeris
  597. * length 61
  598. */
  599. /* TODO: rtklib has C code for this one. */
  600. unknown_name = "QZSS Ephemeris";
  601. break;
  602. case 1045:
  603. /* RTCM 3.2 - 1045
  604. * Galileo F/NAV Ephemeris Data
  605. * 64 bytes
  606. */
  607. /* TODO: rtklib has C code for this one. */
  608. unknown_name = "GAL F/NAV Ephemeris Data";
  609. break;
  610. case 1046:
  611. /* RTCM 3.x - 1046
  612. * Galileo I/NAV Ephemeris Data
  613. * length 63
  614. */
  615. /* TODO: rtklib has C code for this one. */
  616. unknown_name = "GAL I/NAV Ephemeris Data";
  617. break;
  618. case 1057:
  619. /* RTCM 3.2
  620. * SSR GPS Orbit Correction
  621. */
  622. unknown_name = "SSR GPS Orbit Correction";
  623. break;
  624. case 1058:
  625. /* RTCM 3.2
  626. * SSR GPS Clock Correction
  627. */
  628. unknown_name = "SSR GPS Clock Correction";
  629. break;
  630. case 1059:
  631. /* RTCM 3.2
  632. * SSR GPS Code Bias
  633. */
  634. unknown_name = "SSR GPS Code Bias";
  635. break;
  636. case 1060:
  637. /* RTCM 3.2
  638. * SSR GPS Combined Orbit and Clock Correction
  639. */
  640. unknown_name = "SSR GPS Combined Orbit and Clock Correction";
  641. break;
  642. case 1061:
  643. /* RTCM 3.2
  644. * SSR GPS URA
  645. */
  646. unknown_name = "SSR GPS URA";
  647. break;
  648. case 1062:
  649. /* RTCM 3.2
  650. * SSR GPS High Rate Clock Correction
  651. */
  652. unknown_name = "SSR GPS High Rate Clock Correction";
  653. break;
  654. case 1063:
  655. /* RTCM 3.2
  656. * SSR GLO Orbit Correction
  657. */
  658. unknown_name = "SSR GLO Orbit Correction";
  659. break;
  660. case 1064:
  661. /* RTCM 3.2
  662. * SSR GLO Clock Correction
  663. */
  664. unknown_name = "SSR GLO Clock Correction";
  665. break;
  666. case 1065:
  667. /* RTCM 3.2
  668. * SSR GLO Code Correction
  669. */
  670. unknown_name = "SSR GLO ode Correction";
  671. break;
  672. case 1066:
  673. /* RTCM 3.2
  674. * SSR GLO Combined Orbit and Clock Correction
  675. */
  676. unknown_name = "SSR GLO Combined Orbit and Clock Correction";
  677. break;
  678. case 1067:
  679. /* RTCM 3.2
  680. * SSR GLO URA
  681. */
  682. unknown_name = "SSR GLO URA";
  683. break;
  684. case 1068:
  685. /* RTCM 3.2
  686. * SSR GPS High Rate Clock Correction
  687. */
  688. unknown_name = "SSR GLO High Rate Clock Correction";
  689. break;
  690. case 1070:
  691. /* RTCM 3.x
  692. * Reserved for MSM
  693. */
  694. unknown_name = "Reserved for MSM";
  695. break;
  696. case 1071:
  697. /* RTCM 3.2
  698. * GPS Multi Signal Message 1
  699. */
  700. unknown_name = "GPS Multi Signal Message 1";
  701. break;
  702. case 1072:
  703. /* RTCM 3.2
  704. * GPS Multi Signal Message 2
  705. */
  706. unknown_name = "GPS Multi Signal Message 2";
  707. break;
  708. case 1073:
  709. /* RTCM 3.2
  710. * GPS Multi Signal Message 3
  711. */
  712. unknown_name = "GPS Multi Signal Message 3";
  713. break;
  714. case 1074:
  715. /* RTCM 3.2
  716. * GPS Multi Signal Message 4
  717. */
  718. unknown_name = "GPS Multi Signal Message 4";
  719. break;
  720. case 1075:
  721. /* RTCM 3.2
  722. * GPS Multi Signal Message 5
  723. */
  724. unknown_name = "GPS Multi Signal Message 5";
  725. break;
  726. case 1076:
  727. /* RTCM 3.2
  728. * GPS Multi Signal Message 6
  729. */
  730. unknown_name = "GPS Multi Signal Message 6";
  731. break;
  732. case 1077:
  733. /* RTCM 3.2 - 1077
  734. * GPS Multi Signal Message 7
  735. * Full GPS pseudo-ranges, carrier phases, Doppler and
  736. * signal strength (high resolution)
  737. * length 438
  738. */
  739. /* TODO: rtklib has C code for this one. */
  740. unknown_name = "GPS MSM7";
  741. break;
  742. case 1078:
  743. /* RTCM 3.x
  744. * Reserved for MSM
  745. */
  746. unknown_name = "Reserved for MSM";
  747. break;
  748. case 1079:
  749. /* RTCM 3.x
  750. * Reserved for MSM
  751. */
  752. unknown_name = "Reserved for MSM";
  753. break;
  754. case 1080:
  755. /* RTCM 3.x
  756. * Reserved for MSM
  757. */
  758. unknown_name = "Reserved for MSM";
  759. break;
  760. case 1081:
  761. /* RTCM 3.2
  762. * GLONASS Multi Signal Message 1
  763. */
  764. unknown_name = "GLO Multi Signal Message 1";
  765. break;
  766. case 1082:
  767. /* RTCM 3.2
  768. * GLONASS Multi Signal Message 2
  769. */
  770. unknown_name = "GLO Multi Signal Message 2";
  771. break;
  772. case 1083:
  773. /* RTCM 3.2
  774. * GLONASS Multi Signal Message 4
  775. */
  776. unknown_name = "GLO Multi Signal Message 3";
  777. break;
  778. case 1084:
  779. /* RTCM 3.2
  780. * GLONASS Multi Signal Message 4
  781. */
  782. unknown_name = "GLO Multi Signal Message 4";
  783. break;
  784. case 1085:
  785. /* RTCM 3.2
  786. * GLONASS Multi Signal Message 5
  787. */
  788. unknown_name = "GLO Multi Signal Message 5";
  789. break;
  790. case 1086:
  791. /* RTCM 3.2
  792. * GLONASS Multi Signal Message 6
  793. */
  794. unknown_name = "GLO Multi Signal Message 6";
  795. break;
  796. case 1087:
  797. /* RTCM 3.2 - 1087
  798. * GLONASS Multi Signal Message 7
  799. * Full GLONASS pseudo-ranges, carrier phases, Doppler and
  800. * signal strength (high resolution)
  801. * length 417 or 427
  802. */
  803. /* TODO: rtklib has C code for this one. */
  804. unknown_name = "GLO Multi Signal Message 7";
  805. break;
  806. case 1088:
  807. /* RTCM 3.x
  808. * Reserved for MSM
  809. */
  810. unknown_name = "Reserved for MSM";
  811. break;
  812. case 1089:
  813. /* RTCM 3.x
  814. * Reserved for MSM
  815. */
  816. unknown_name = "Reserved for MSM";
  817. break;
  818. case 1090:
  819. /* RTCM 3.x
  820. * Reserved for MSM
  821. */
  822. unknown_name = "Reserved for MSM";
  823. break;
  824. case 1091:
  825. /* RTCM 3.2
  826. * Galileo Multi Signal Message 1
  827. */
  828. unknown_name = "GAL Multi Signal Message 1";
  829. break;
  830. case 1092:
  831. /* RTCM 3.2
  832. * Galileo Multi Signal Message 2
  833. */
  834. unknown_name = "GAL Multi Signal Message 2";
  835. break;
  836. case 1093:
  837. /* RTCM 3.2
  838. * Galileo Multi Signal Message 3
  839. */
  840. unknown_name = "GAL Multi Signal Message 3";
  841. break;
  842. case 1094:
  843. /* RTCM 3.2
  844. * Galileo Multi Signal Message 4
  845. */
  846. unknown_name = "GAL Multi Signal Message 4";
  847. break;
  848. case 1095:
  849. /* RTCM 3.2
  850. * Galileo Multi Signal Message 5
  851. */
  852. unknown_name = "GAL Multi Signal Message 5";
  853. break;
  854. case 1096:
  855. /* RTCM 3.2
  856. * Galileo Multi Signal Message 6
  857. */
  858. unknown_name = "GAL Multi Signal Message 6";
  859. break;
  860. case 1097:
  861. /* RTCM 3.2 - 1097
  862. * Galileo Multi Signal Message 7
  863. * Full Galileo pseudo-ranges, carrier phases, Doppler and
  864. * signal strength (high resolution)
  865. * length 96
  866. */
  867. /* TODO: rtklib has C code for this one. */
  868. unknown_name = "GAL Multi Signal Message 7";
  869. break;
  870. case 1098:
  871. /* RTCM 3.x
  872. * Reserved for MSM
  873. */
  874. unknown_name = "Reserved for MSM";
  875. break;
  876. case 1099:
  877. /* RTCM 3.x
  878. * Reserved for MSM
  879. */
  880. unknown_name = "Reserved for MSM";
  881. break;
  882. case 1100:
  883. /* RTCM 3.x
  884. * Reserved for MSM
  885. */
  886. unknown_name = "Reserved for MSM";
  887. break;
  888. case 1101:
  889. /* RTCM 3.3
  890. * SBAS Multi Signal Message 1
  891. */
  892. unknown_name = "SBAS Multi Signal Message 1";
  893. break;
  894. case 1102:
  895. /* RTCM 3.3
  896. * SBAS Multi Signal Message 2
  897. */
  898. unknown_name = "SBAS Multi Signal Message 2";
  899. break;
  900. case 1103:
  901. /* RTCM 3.3
  902. * SBAS Multi Signal Message 3
  903. */
  904. unknown_name = "SBAS Multi Signal Message 3";
  905. break;
  906. case 1104:
  907. /* RTCM 3.3
  908. * SBAS Multi Signal Message 4
  909. */
  910. unknown_name = "SBAS Multi Signal Message 4";
  911. break;
  912. case 1105:
  913. /* RTCM 3.3
  914. * SBAS Multi Signal Message 5
  915. */
  916. unknown_name = "SBAS Multi Signal Message 5";
  917. break;
  918. case 1106:
  919. /* RTCM 3.3
  920. * SBAS Multi Signal Message 6
  921. */
  922. unknown_name = "SBAS Multi Signal Message 6";
  923. break;
  924. case 1107:
  925. /* RTCM 3.3 - 1107
  926. * 'Multiple Signal Message
  927. * Full SBAS pseudo-ranges, carrier phases, Doppler and
  928. * signal strength (high resolution)
  929. * length 96
  930. */
  931. /* TODO: rtklib has C code for this one. */
  932. unknown_name = "SBAS Multi Signal Message 7";
  933. break;
  934. case 1108:
  935. /* RTCM 3.x
  936. * Reserved for MSM
  937. */
  938. unknown_name = "Reserved for MSM";
  939. break;
  940. case 1109:
  941. /* RTCM 3.x
  942. * Reserved for MSM
  943. */
  944. unknown_name = "Reserved for MSM";
  945. break;
  946. case 1110:
  947. /* RTCM 3.x
  948. * Reserved for MSM
  949. */
  950. unknown_name = "Reserved for MSM";
  951. break;
  952. case 1111:
  953. /* RTCM 3.3
  954. * QZSS Multi Signal Message 1
  955. */
  956. unknown_name = "QZSS Multi Signal Message 1";
  957. break;
  958. case 1112:
  959. /* RTCM 3.3
  960. * QZSS Multi Signal Message 2
  961. */
  962. unknown_name = "QZSS Multi Signal Message 2";
  963. break;
  964. case 1113:
  965. /* RTCM 3.3
  966. * QZSS Multi Signal Message 3
  967. */
  968. unknown_name = "QZSS Multi Signal Message 3";
  969. break;
  970. case 1114:
  971. /* RTCM 3.3
  972. * QZSS Multi Signal Message 4
  973. */
  974. unknown_name = "QZSS Multi Signal Message 4";
  975. break;
  976. case 1115:
  977. /* RTCM 3.3
  978. * QZSS Multi Signal Message 5
  979. */
  980. unknown_name = "QZSS Multi Signal Message 5";
  981. break;
  982. case 1116:
  983. /* RTCM 3.3
  984. * QZSS Multi Signal Message 6
  985. */
  986. unknown_name = "QZSS Multi Signal Message 6";
  987. break;
  988. case 1117:
  989. /* RTCM 3.3
  990. * QZSS Multi Signal Message 7
  991. */
  992. unknown_name = "QZSS Multi Signal Message 7";
  993. break;
  994. case 1118:
  995. /* RTCM 3.x
  996. * Reserved for MSM
  997. */
  998. unknown_name = "Reserved for MSM";
  999. break;
  1000. case 1119:
  1001. /* RTCM 3.x
  1002. * Reserved for MSM
  1003. */
  1004. unknown_name = "Reserved for MSM";
  1005. break;
  1006. case 1120:
  1007. /* RTCM 3.x
  1008. * Reserved for MSM
  1009. */
  1010. unknown_name = "Reserved for MSM";
  1011. break;
  1012. case 1121:
  1013. /* RTCM 3.2 A.1
  1014. * BD Multi Signal Message 1
  1015. */
  1016. unknown_name = "BD Multi Signal Message 1";
  1017. break;
  1018. case 1122:
  1019. /* RTCM 3.2 A.1
  1020. * BD Multi Signal Message 2
  1021. */
  1022. unknown_name = "BD Multi Signal Message 2";
  1023. break;
  1024. case 1123:
  1025. /* RTCM 3.2 A.1
  1026. * BD Multi Signal Message 3
  1027. */
  1028. unknown_name = "BD Multi Signal Message 3";
  1029. break;
  1030. case 1124:
  1031. /* RTCM 3.2 A.1
  1032. * BD Multi Signal Message 4
  1033. */
  1034. unknown_name = "BD Multi Signal Message 4";
  1035. break;
  1036. case 1125:
  1037. /* RTCM 3.2 A.1
  1038. * BeiDou Multi Signal Message 5
  1039. */
  1040. unknown_name = "BD Multi Signal Message 5";
  1041. break;
  1042. case 1126:
  1043. /* RTCM 3.2 A.1
  1044. * BeiDou Multi Signal Message 6
  1045. */
  1046. unknown_name = "BD Multi Signal Message 6";
  1047. break;
  1048. case 1127:
  1049. /* RTCM 3.2 A.1
  1050. * BeiDou Multi Signal Message 7
  1051. */
  1052. unknown_name = "BD Multi Signal Message 7";
  1053. break;
  1054. case 1128:
  1055. /* RTCM 3.x
  1056. * Reserved for MSM
  1057. */
  1058. unknown_name = "Reserved for MSM";
  1059. break;
  1060. case 1229:
  1061. /* RTCM 3.x
  1062. * Reserved for MSM
  1063. */
  1064. unknown_name = "Reserved for MSM";
  1065. break;
  1066. case 1230:
  1067. /* RTCM 3.2
  1068. * GLONASS L1 and L2, C/A and P, Code-Phase Biases.
  1069. */
  1070. unknown_name = "GLO L1 and L2 Code-Phase Biases";
  1071. unknown = false;
  1072. rtcm->rtcmtypes.rtcm3_1230.station_id = (unsigned short)ugrab(12);
  1073. rtcm->rtcmtypes.rtcm3_1230.bias_indicator = (unsigned char)ugrab(1);
  1074. (void)ugrab(1); /* reserved */
  1075. rtcm->rtcmtypes.rtcm3_1230.signals_mask = (unsigned char)ugrab(3);
  1076. // actual mask order is undocumented...
  1077. if (1 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1078. rtcm->rtcmtypes.rtcm3_1230.l1_ca_bias = ugrab(16);
  1079. }
  1080. if (2 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1081. rtcm->rtcmtypes.rtcm3_1230.l1_p_bias = ugrab(16);
  1082. }
  1083. if (4 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1084. rtcm->rtcmtypes.rtcm3_1230.l2_ca_bias = ugrab(16);
  1085. }
  1086. if (8 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1087. rtcm->rtcmtypes.rtcm3_1230.l2_p_bias = ugrab(16);
  1088. }
  1089. break;
  1090. case 4072:
  1091. /* RTCM 3.x
  1092. * u-blox Proprietary
  1093. * Mitsubishi Electric Corp Proprietary
  1094. * 4072.0 Reference station PVT (u-blox proprietary)
  1095. * 4072.1 Additional reference station information (u-blox proprietary)
  1096. */
  1097. unknown_name = "u-blox Proprietary";
  1098. break;
  1099. case 4073:
  1100. /* RTCM 3.x
  1101. * Unicore Communications Proprietary
  1102. */
  1103. unknown_name = "Alberding GmbH Proprietary";
  1104. break;
  1105. case 4075:
  1106. /* RTCM 3.x
  1107. * Alberding GmbH Proprietary
  1108. */
  1109. unknown_name = "Alberding GmbH Proprietary";
  1110. break;
  1111. case 4076:
  1112. /* RTCM 3.x
  1113. * International GNSS Service Proprietary
  1114. */
  1115. unknown_name = "International GNSS Service Proprietary";
  1116. break;
  1117. case 4077:
  1118. /* RTCM 3.x
  1119. * Hemisphere GNSS Proprietary
  1120. */
  1121. unknown_name = "Hemisphere GNSS Proprietary";
  1122. break;
  1123. case 4078:
  1124. /* RTCM 3.x
  1125. * ComNav Technology Proprietary
  1126. */
  1127. unknown_name = "ComNav Technology Proprietary";
  1128. break;
  1129. case 4079:
  1130. /* RTCM 3.x
  1131. * SubCarrier Systems Corp Proprietary
  1132. */
  1133. unknown_name = "SubCarrier Systems Corp Proprietary";
  1134. break;
  1135. case 4080:
  1136. /* RTCM 3.x
  1137. * NavCom Technology, Inc.
  1138. */
  1139. unknown_name = "NavCom Technology, Inc.";
  1140. break;
  1141. case 4081:
  1142. /* RTCM 3.x
  1143. * Seoul National Universtiry GNSS Lab Proprietary
  1144. */
  1145. unknown_name = "Seoul National Universtiry GNSS Lab Proprietery";
  1146. break;
  1147. case 4082:
  1148. /* RTCM 3.x
  1149. * Cooperative Research Centre for Spatial Information Proprietary
  1150. */
  1151. unknown_name = "Cooperative Research Centre for Spatial Information "
  1152. "Proprietary";
  1153. break;
  1154. case 4083:
  1155. /* RTCM 3.x
  1156. * German Aerospace Center Proprietary
  1157. */
  1158. unknown_name = "German Aerospace Center Proprietary";
  1159. break;
  1160. case 4084:
  1161. /* RTCM 3.x
  1162. * Geodetics Inc Proprietary
  1163. */
  1164. unknown_name = "Geodetics Inc Proprietary";
  1165. break;
  1166. case 4085:
  1167. /* RTCM 3.x
  1168. * European GNSS Supervisory Authority Proprietary
  1169. */
  1170. unknown_name = "European GNSS Supervisory Authority Proprietary";
  1171. break;
  1172. case 4086:
  1173. /* RTCM 3.x
  1174. * InPosition GmbH Proprietary
  1175. */
  1176. unknown_name = "InPosition GmbH Proprietary";
  1177. break;
  1178. case 4087:
  1179. /* RTCM 3.x
  1180. * Fugro Proprietary
  1181. */
  1182. unknown_name = "Fugro Proprietary";
  1183. break;
  1184. case 4088:
  1185. /* RTCM 3.x
  1186. * IfEN GmbH Proprietary
  1187. */
  1188. unknown_name = "IfEN GmbH Proprietary";
  1189. break;
  1190. case 4089:
  1191. /* RTCM 3.x
  1192. * Septentrio Satellite Navigation Proprietary
  1193. */
  1194. unknown_name = "Septentrio Satellite Navigation Proprietary";
  1195. break;
  1196. case 4090:
  1197. /* RTCM 3.x
  1198. * Geo++ Proprietary
  1199. */
  1200. unknown_name = "Geo++ Proprietary";
  1201. break;
  1202. case 4091:
  1203. /* RTCM 3.x
  1204. * Topcon Positioning Systems Proprietary
  1205. */
  1206. unknown_name = "Topcon Positioning Systems Proprietary";
  1207. break;
  1208. case 4092:
  1209. /* RTCM 3.x
  1210. * Leica Geosystems Proprietary
  1211. */
  1212. unknown_name = "Leica Geosystems Proprietary";
  1213. break;
  1214. case 4093:
  1215. /* RTCM 3.x
  1216. * NovAtel Proprietary
  1217. */
  1218. unknown_name = "NovAtel Pr.orietary";
  1219. break;
  1220. case 4094:
  1221. /* RTCM 3.x
  1222. * Trimble Proprietary
  1223. */
  1224. unknown_name = "Trimble Proprietary";
  1225. break;
  1226. case 4095:
  1227. /* RTCM 3.x
  1228. * Ashtech/Magellan Proprietary
  1229. */
  1230. unknown_name = "Ashtech/Magellan Proprietary";
  1231. break;
  1232. default:
  1233. break;
  1234. }
  1235. #undef RANGEDIFF
  1236. #undef GPS_PSEUDORANGE
  1237. #undef sgrab
  1238. #undef ugrab
  1239. if ( unknown ) {
  1240. /*
  1241. * Leader bytes, message length, and checksum won't be copied.
  1242. * The first 12 bits of the copied payload will be the type field.
  1243. */
  1244. memcpy(rtcm->rtcmtypes.data, buf+3, rtcm->length);
  1245. if (NULL == unknown_name) {
  1246. GPSD_LOG(LOG_PROG, &context->errout,
  1247. "RTCM3: unknown type %d, length %d\n",
  1248. rtcm->type, rtcm->length);
  1249. } else {
  1250. GPSD_LOG(LOG_PROG, &context->errout,
  1251. "RTCM3: %s (type %d), length %d\n",
  1252. unknown_name, rtcm->type, rtcm->length);
  1253. }
  1254. }
  1255. }
  1256. /* *INDENT-ON* */
  1257. #endif /* RTCM104V3_ENABLE */
  1258. // vim: set expandtab shiftwidth=4