driver_rtcm3.c 67 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018
  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 "../include/gpsd_config.h" // must be before all includes
  34. #include <string.h>
  35. #include "../include/gpsd.h"
  36. #include "../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, DF050
  42. #define ANTENNA_POSITION_RESOLUTION 0.0001 // DF025, DF026, DF027
  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. // DF069, DF070, DF192, DF193, DF194, DF195
  47. #define PHASE_CORRECTION_RESOLUTION 0.5
  48. // DF156, DF157, DF158, DF166, DF167, DF168, DF169, DF196, DF197
  49. #define TRANSLATION_MM_RESOLUTION 0.001
  50. #define VALIDITY_RESOLUTION 2.0 // DF152, DF153, DF154, DF155
  51. #define SCALE_PPM_RESOLUTION 1e-5 // DF162
  52. #define ROTATION_ARCSEC_RESOLUTION 2e-5 // DF159, DF160, DF161
  53. // DF171, DF172, DF176, DF177, DF178, DF179, DF183, DF184, DF185, DF186
  54. #define PROJ_ORIGIN_RESOLUTION 11e-9
  55. #define DEG_ARCSEC_RESOLUTION 3600
  56. #define CM_RESOLUTION 0.01 // DF198
  57. #define RES_ARCSEC_RESOLUTION 3e-5 // DF199, DF200
  58. // Other magic values
  59. #define GPS_INVALID_PSEUDORANGE 0x80000 // DF012, DF018
  60. #define GLONASS_INVALID_RANGEINCR 0x2000 // DF047
  61. #define GLONASS_CHANNEL_BASE 7 // DF040
  62. // Large case statements make GNU indent very confused
  63. // *INDENT-OFF*
  64. /* good source on message types:
  65. * https://software.rtcm-ntrip.org/export/HEAD/ntrip/trunk/BNC/src/bnchelp.html
  66. * Also look in the BNC source
  67. * and look at the tklib source: http://www.rtklib.com/
  68. */
  69. #define ugrab(width) (bitcount += width, ubits((unsigned char *)buf, \
  70. bitcount - width, width, false))
  71. #define sgrab(width) (bitcount += width, sbits((signed char *)buf, \
  72. bitcount - width, width, false))
  73. /* decode 1015/1016/1017 header
  74. * they share a common header
  75. * TODO: rtklib has C code for these.
  76. *
  77. * Return: false if decoded
  78. * true if runt
  79. */
  80. static bool rtcm3_101567(const struct gps_context_t *context,
  81. struct rtcm3_t *rtcm, char *buf)
  82. {
  83. int bitcount = 36; // 8 preamble, 6 zero, 10 length, 12 type
  84. if (22 > rtcm->length) {
  85. // need 76 bits, 9.5 bytes
  86. rtcm->length = 0; // set to zero to prevent JSON decode
  87. GPSD_LOG(LOG_WARN, &context->errout,
  88. "RTCM3: rtcm3_101567_msm() type %d runt length %d ",
  89. rtcm->type, rtcm->length);
  90. return true;
  91. }
  92. // 1015, 1016, and 1017 all use the 1015 struct
  93. rtcm->rtcmtypes.rtcm3_1015.header.network_id = (unsigned)ugrab(12);
  94. rtcm->rtcmtypes.rtcm3_1015.header.subnetwork_id = (unsigned )ugrab(4);
  95. rtcm->rtcmtypes.rtcm3_1015.header.tow = (time_t)ugrab(23);
  96. rtcm->rtcmtypes.rtcm3_1015.header.multimesg = (bool)ugrab(1);
  97. rtcm->rtcmtypes.rtcm3_1015.header.master_id = (unsigned)ugrab(12);
  98. rtcm->rtcmtypes.rtcm3_1015.header.aux_id = (unsigned)ugrab(12);
  99. rtcm->rtcmtypes.rtcm3_1015.header.satcount = (unsigned char)ugrab(4);
  100. // (long long)tow for 32 bit machines.
  101. GPSD_LOG(LOG_PROG, &context->errout, "RTCM3: rtcm3_10567(%u) "
  102. "network_id %u subnetwork_id %u tow %lld multimesg %u "
  103. "master_id %u aux_id %u satcount %u",
  104. rtcm->type,
  105. rtcm->rtcmtypes.rtcm3_1015.header.network_id,
  106. rtcm->rtcmtypes.rtcm3_1015.header.subnetwork_id,
  107. (long long)rtcm->rtcmtypes.rtcm3_1015.header.tow,
  108. rtcm->rtcmtypes.rtcm3_1015.header.multimesg,
  109. rtcm->rtcmtypes.rtcm3_1015.header.master_id,
  110. rtcm->rtcmtypes.rtcm3_1015.header.aux_id,
  111. rtcm->rtcmtypes.rtcm3_1015.header.satcount);
  112. return false;
  113. }
  114. /* decode MSM header
  115. * MSM1 to MSM7 share a common header
  116. * TODO: rtklib has C code for these.
  117. *
  118. * Return: false if decoded
  119. * true if runt, or error
  120. */
  121. static bool rtcm3_decode_msm(const struct gps_context_t *context,
  122. struct rtcm3_t *rtcm, char *buf)
  123. {
  124. int bitcount = 36; // 8 preamble, 6 zero, 10 length, 12 type
  125. unsigned n_sig = 0, n_sat = 0, n_cell = 0;
  126. uint64_t sat_mask;
  127. uint32_t sig_mask;
  128. unsigned i;
  129. if (22 > rtcm->length) {
  130. // need 169 bits, 21.125 bytes
  131. rtcm->length = 0; // set to zero to prevent JSON decode
  132. GPSD_LOG(LOG_WARN, &context->errout,
  133. "RTCM3: rtcm3_decode_msm() type %d runt length %d ",
  134. rtcm->type, rtcm->length);
  135. return true;
  136. }
  137. rtcm->rtcmtypes.rtcm3_msm.station_id = ugrab(12);
  138. rtcm->rtcmtypes.rtcm3_msm.tow = (time_t)ugrab(30);
  139. rtcm->rtcmtypes.rtcm3_msm.sync = ugrab(1);
  140. rtcm->rtcmtypes.rtcm3_msm.IODS = ugrab(3);
  141. bitcount += 7; // skip 7 reserved bits, DF001
  142. rtcm->rtcmtypes.rtcm3_msm.steering = ugrab(2);
  143. rtcm->rtcmtypes.rtcm3_msm.ext_clk = ugrab(2);
  144. rtcm->rtcmtypes.rtcm3_msm.smoothing = ugrab(1);
  145. rtcm->rtcmtypes.rtcm3_msm.interval = ugrab(3);
  146. // FIXME: rtcm->rtcmtypes.rtcm3_msm.sat_mask = ugrab(64);
  147. // ugrab(56) is max, can't do 64, so stack it
  148. rtcm->rtcmtypes.rtcm3_msm.sat_mask = ugrab(32) << 32;
  149. rtcm->rtcmtypes.rtcm3_msm.sat_mask |= ugrab(32);
  150. rtcm->rtcmtypes.rtcm3_msm.sig_mask = ugrab(32);
  151. // count satellites
  152. sat_mask = rtcm->rtcmtypes.rtcm3_msm.sat_mask;
  153. while (sat_mask) {
  154. n_sat += sat_mask & 1;
  155. sat_mask >>= 1;
  156. }
  157. // count signals
  158. sig_mask = rtcm->rtcmtypes.rtcm3_msm.sig_mask;
  159. while (sig_mask) {
  160. n_sig += sig_mask & 1;
  161. sig_mask >>= 1;
  162. }
  163. // determine cells
  164. n_cell = n_sat * n_sig;
  165. rtcm->rtcmtypes.rtcm3_msm.n_sat = n_sat;
  166. rtcm->rtcmtypes.rtcm3_msm.n_sig = n_sig;
  167. rtcm->rtcmtypes.rtcm3_msm.n_cell = n_cell;
  168. if (0 == n_sat ||
  169. 64 < n_cell) {
  170. GPSD_LOG(LOG_WARN, &context->errout,
  171. "RTCM3: rtcm3_decode_msm(%u) interval %u sat_mask x%llx "
  172. "sig_mask x%x invalid n_cell %u\n",
  173. rtcm->type,
  174. rtcm->rtcmtypes.rtcm3_msm.interval,
  175. (unsigned long long)rtcm->rtcmtypes.rtcm3_msm.sat_mask,
  176. rtcm->rtcmtypes.rtcm3_msm.sig_mask,
  177. n_cell);
  178. return false;
  179. }
  180. // cell_mask is variable length! ugrab() width max is 56
  181. if (56 >= n_cell) {
  182. rtcm->rtcmtypes.rtcm3_msm.cell_mask = ugrab(n_cell);
  183. } else {
  184. // 57 to 64, breaks ugrab(), workaround it...
  185. rtcm->rtcmtypes.rtcm3_msm.cell_mask = ugrab(56);
  186. rtcm->rtcmtypes.rtcm3_msm.cell_mask <<= n_cell - 56;
  187. rtcm->rtcmtypes.rtcm3_msm.cell_mask |= ugrab(n_cell - 56);
  188. }
  189. // Decode Satellite Data
  190. // Decode DF397 (MSM 4-7)
  191. if (4 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  192. 5 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  193. 6 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  194. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  195. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_sat; i++) {
  196. rtcm->rtcmtypes.rtcm3_msm.sat[i].rr_ms = ugrab(8);
  197. }
  198. }
  199. // Decode Extended Info (MSM 5+7)
  200. if (5 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  201. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  202. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_sat; i++) {
  203. rtcm->rtcmtypes.rtcm3_msm.sat[i].ext_info = ugrab(4);
  204. }
  205. }
  206. // Decode DF398 (MSM 1-7)
  207. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_sat; i++) {
  208. rtcm->rtcmtypes.rtcm3_msm.sat[i].rr_m1 = ugrab(10);
  209. };
  210. // Decode DF399 (MSM 5+7)
  211. if (5 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  212. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  213. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_sat; i++) {
  214. rtcm->rtcmtypes.rtcm3_msm.sat[i].rates_rphr = ugrab(14);
  215. }
  216. }
  217. // Decode Signal Data
  218. // Decode DF400 (MSM 1,3,4,5) resp. DF405 (MSM 6+7)
  219. if (1 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  220. 3 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  221. 4 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  222. 5 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  223. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  224. rtcm->rtcmtypes.rtcm3_msm.sig[i].pseudo_r = sgrab(15);
  225. }
  226. } else if (6 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  227. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  228. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  229. rtcm->rtcmtypes.rtcm3_msm.sig[i].pseudo_r = sgrab(20);
  230. }
  231. }
  232. // Decode DF401 (MSM 2,3,4,5) resp. DF406 (MSM 6+7)
  233. if (2 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  234. 3 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  235. 4 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  236. 5 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  237. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  238. rtcm->rtcmtypes.rtcm3_msm.sig[i].phase_r = sgrab(22);
  239. }
  240. } else if (6 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  241. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  242. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  243. rtcm->rtcmtypes.rtcm3_msm.sig[i].phase_r = sgrab(24);
  244. }
  245. }
  246. // Decode DF402 (MSM 2,3,4,5) resp. DF407 (MSM 6+7)
  247. if (2 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  248. 3 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  249. 4 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  250. 5 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  251. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  252. rtcm->rtcmtypes.rtcm3_msm.sig[i].lti = ugrab(4);
  253. }
  254. } else if (6 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  255. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  256. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  257. rtcm->rtcmtypes.rtcm3_msm.sig[i].lti = ugrab(10);
  258. }
  259. }
  260. // Decode DF420 (MSM 2-7)
  261. if (2 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  262. 3 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  263. 4 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  264. 5 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  265. 6 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  266. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  267. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  268. rtcm->rtcmtypes.rtcm3_msm.sig[i].half_amb = ugrab(1);
  269. }
  270. }
  271. // Decode DF403 (MSM 4+5) resp. DF408 (MSM 6+7)
  272. if (4 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  273. 5 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  274. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  275. rtcm->rtcmtypes.rtcm3_msm.sig[i].cnr = ugrab(6);
  276. }
  277. } else if (6 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  278. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  279. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  280. rtcm->rtcmtypes.rtcm3_msm.sig[i].cnr = ugrab(10);
  281. }
  282. }
  283. // Decode DF404 (MSM 5+7)
  284. if (5 == rtcm->rtcmtypes.rtcm3_msm.msm ||
  285. 7 == rtcm->rtcmtypes.rtcm3_msm.msm) {
  286. for (i = 0; i < rtcm->rtcmtypes.rtcm3_msm.n_cell; i++) {
  287. rtcm->rtcmtypes.rtcm3_msm.sig[i].cnr = sgrab(15);
  288. }
  289. }
  290. // (long long)tow for 32 bit machines.
  291. GPSD_LOG(LOG_PROG, &context->errout, "RTCM3: rtcm3_decode_msm(%u) "
  292. "gnssid %u MSM%u id %u tow %lld sync %u IODS %u "
  293. "steering %u ext_clk %u smoothing %u interval %u "
  294. "sat_mask x%llx sig_mask x%lx cell_mask %llx\n",
  295. rtcm->type,
  296. rtcm->rtcmtypes.rtcm3_msm.gnssid,
  297. rtcm->rtcmtypes.rtcm3_msm.msm,
  298. rtcm->rtcmtypes.rtcm3_msm.station_id,
  299. (long long)rtcm->rtcmtypes.rtcm3_msm.tow,
  300. rtcm->rtcmtypes.rtcm3_msm.sync,
  301. rtcm->rtcmtypes.rtcm3_msm.IODS,
  302. rtcm->rtcmtypes.rtcm3_msm.steering,
  303. rtcm->rtcmtypes.rtcm3_msm.ext_clk,
  304. rtcm->rtcmtypes.rtcm3_msm.smoothing,
  305. rtcm->rtcmtypes.rtcm3_msm.interval,
  306. (long long unsigned)rtcm->rtcmtypes.rtcm3_msm.sat_mask,
  307. (long unsigned)rtcm->rtcmtypes.rtcm3_msm.sig_mask,
  308. (long long unsigned)rtcm->rtcmtypes.rtcm3_msm.cell_mask);
  309. return false;
  310. }
  311. /* break out the raw bits into the scaled report-structure fields
  312. *
  313. * Return: void
  314. */
  315. void rtcm3_unpack(const struct gps_context_t *context,
  316. struct rtcm3_t *rtcm, char *buf)
  317. {
  318. unsigned n, n2, n3, n4;
  319. int bitcount = 0;
  320. unsigned i;
  321. signed long temp;
  322. bool unknown = true; // we don't know how to decode
  323. const char *unknown_name = NULL; // no decode, but maybe we know the name
  324. unsigned preamble, mbz; // preamble 0xd3, and must be zero
  325. #define GPS_PSEUDORANGE(fld, len) \
  326. {temp = (unsigned long)ugrab(len); \
  327. if (temp == GPS_INVALID_PSEUDORANGE) { \
  328. fld.pseudorange = 0; \
  329. } else { \
  330. fld.pseudorange = temp * GPS_PSEUDORANGE_RESOLUTION;} \
  331. }
  332. #define RANGEDIFF(fld, len) \
  333. temp = (long)sgrab(len); \
  334. if (temp == GPS_INVALID_PSEUDORANGE) { \
  335. fld.rangediff = 0; \
  336. } else { \
  337. fld.rangediff = temp * PSEUDORANGE_DIFF_RESOLUTION; \
  338. }
  339. memset(rtcm, 0, sizeof(struct rtcm3_t));
  340. // check preamble and zero bits
  341. preamble = ugrab(8);
  342. mbz = ugrab(6);
  343. if (0xD3 != preamble ||
  344. 0 != mbz) {
  345. GPSD_LOG(LOG_WARN, &context->errout,
  346. "RTCM3: invalid preamble x%2x or mbz x%x\n",
  347. preamble, mbz);
  348. }
  349. rtcm->length = (unsigned)ugrab(10);
  350. if (2 > rtcm->length) {
  351. // ignore zero payload messages, they do not evan have type
  352. // need 2 bytes just to read 10 bit type.
  353. return;
  354. }
  355. rtcm->type = (unsigned)ugrab(12);
  356. GPSD_LOG(LOG_RAW, &context->errout,
  357. "RTCM3: type %d payload length %d bitcount %d\n",
  358. rtcm->type, rtcm->length, bitcount);
  359. // RTCM3 message type numbers start at 1001
  360. switch (rtcm->type) {
  361. case 1001:
  362. // GPS Basic RTK, L1 Only
  363. rtcm->rtcmtypes.rtcm3_1001.header.station_id = (unsigned)ugrab(12);
  364. rtcm->rtcmtypes.rtcm3_1001.header.tow = (time_t)ugrab(30);
  365. rtcm->rtcmtypes.rtcm3_1001.header.sync = (bool)ugrab(1);
  366. rtcm->rtcmtypes.rtcm3_1001.header.satcount = (unsigned short)ugrab(5);
  367. rtcm->rtcmtypes.rtcm3_1001.header.smoothing = (bool)ugrab(1);
  368. rtcm->rtcmtypes.rtcm3_1001.header.interval = (unsigned short)ugrab(3);
  369. #define R1001 rtcm->rtcmtypes.rtcm3_1001.rtk_data[i]
  370. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1001.header.satcount; i++) {
  371. R1001.ident = (unsigned short)ugrab(6);
  372. R1001.L1.indicator = (unsigned char)ugrab(1);
  373. GPS_PSEUDORANGE(R1001.L1, 24);
  374. RANGEDIFF(R1001.L1, 20);
  375. R1001.L1.locktime = (unsigned char)sgrab(7);
  376. }
  377. #undef R1001
  378. unknown = false;
  379. break;
  380. case 1002:
  381. // GPS Extended RTK, L1 Only
  382. rtcm->rtcmtypes.rtcm3_1002.header.station_id = (unsigned)ugrab(12);
  383. rtcm->rtcmtypes.rtcm3_1002.header.tow = (time_t)ugrab(30);
  384. rtcm->rtcmtypes.rtcm3_1002.header.sync = (bool)ugrab(1);
  385. rtcm->rtcmtypes.rtcm3_1002.header.satcount = (unsigned short)ugrab(5);
  386. rtcm->rtcmtypes.rtcm3_1002.header.smoothing = (bool)ugrab(1);
  387. rtcm->rtcmtypes.rtcm3_1002.header.interval = (unsigned short)ugrab(3);
  388. #define R1002 rtcm->rtcmtypes.rtcm3_1002.rtk_data[i]
  389. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1002.header.satcount; i++) {
  390. R1002.ident = (unsigned short)ugrab(6);
  391. R1002.L1.indicator = (unsigned char)ugrab(1);
  392. GPS_PSEUDORANGE(R1002.L1, 24);
  393. RANGEDIFF(R1002.L1, 20);
  394. R1002.L1.locktime = (unsigned char)sgrab(7);
  395. R1002.L1.ambiguity = (unsigned char)ugrab(8);
  396. R1002.L1.CNR = (ugrab(8)) * CARRIER_NOISE_RATIO_UNITS;
  397. }
  398. #undef R1002
  399. unknown = false;
  400. break;
  401. case 1003:
  402. // GPS Basic RTK, L1 & L2
  403. rtcm->rtcmtypes.rtcm3_1003.header.station_id = (unsigned)ugrab(12);
  404. rtcm->rtcmtypes.rtcm3_1003.header.tow = (time_t)ugrab(30);
  405. rtcm->rtcmtypes.rtcm3_1003.header.sync = (bool)ugrab(1);
  406. rtcm->rtcmtypes.rtcm3_1003.header.satcount = (unsigned short)ugrab(5);
  407. rtcm->rtcmtypes.rtcm3_1003.header.smoothing = (bool)ugrab(1);
  408. rtcm->rtcmtypes.rtcm3_1003.header.interval = (unsigned short)ugrab(3);
  409. #define R1003 rtcm->rtcmtypes.rtcm3_1003.rtk_data[i]
  410. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1003.header.satcount; i++) {
  411. R1003.ident = (unsigned short)ugrab(6);
  412. R1003.L1.indicator = (unsigned char)ugrab(1);
  413. GPS_PSEUDORANGE(R1003.L1, 24);
  414. RANGEDIFF(R1003.L1, 20);
  415. R1003.L1.locktime = (unsigned char)sgrab(7);
  416. R1003.L2.indicator = (unsigned char)ugrab(2);
  417. GPS_PSEUDORANGE(R1003.L2, 24);
  418. temp = (long)sgrab(20);
  419. if (temp == GPS_INVALID_PSEUDORANGE) {
  420. R1003.L2.rangediff = 0;
  421. } else {
  422. R1003.L2.rangediff = temp * PSEUDORANGE_DIFF_RESOLUTION;
  423. }
  424. R1003.L2.locktime = (unsigned char)sgrab(7);
  425. }
  426. #undef R1003
  427. unknown = false;
  428. break;
  429. case 1004:
  430. // GPS Extended RTK, L1 & L2
  431. rtcm->rtcmtypes.rtcm3_1004.header.station_id = (unsigned)ugrab(12);
  432. rtcm->rtcmtypes.rtcm3_1004.header.tow = (time_t)ugrab(30);
  433. rtcm->rtcmtypes.rtcm3_1004.header.sync = (bool)ugrab(1);
  434. rtcm->rtcmtypes.rtcm3_1004.header.satcount = (unsigned short)ugrab(5);
  435. rtcm->rtcmtypes.rtcm3_1004.header.smoothing = (bool)ugrab(1);
  436. rtcm->rtcmtypes.rtcm3_1004.header.interval = (unsigned short)ugrab(3);
  437. #define R1004 rtcm->rtcmtypes.rtcm3_1004.rtk_data[i]
  438. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1004.header.satcount; i++) {
  439. R1004.ident = (unsigned short)ugrab(6);
  440. R1004.L1.indicator = (bool)ugrab(1);
  441. GPS_PSEUDORANGE(R1004.L1, 24);
  442. RANGEDIFF(R1004.L1, 20);
  443. R1004.L1.locktime = (unsigned char)sgrab(7);
  444. R1004.L1.ambiguity = (unsigned char)ugrab(8);
  445. R1004.L1.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  446. R1004.L2.indicator = (unsigned char)ugrab(2);
  447. GPS_PSEUDORANGE(R1004.L2, 14);
  448. RANGEDIFF(R1004.L2, 20);
  449. R1004.L2.locktime = (unsigned char)sgrab(7);
  450. R1004.L2.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  451. }
  452. #undef R1004
  453. unknown = false;
  454. break;
  455. case 1005:
  456. /* Stationary Antenna Reference Point, No Height Information
  457. * 19 bytes */
  458. #define R1005 rtcm->rtcmtypes.rtcm3_1005
  459. R1005.station_id = (unsigned short)ugrab(12);
  460. ugrab(6); // reserved
  461. R1005.system = ugrab(3);
  462. R1005.reference_station = (bool)ugrab(1);
  463. R1005.ecef_x = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  464. R1005.single_receiver = ugrab(1);
  465. ugrab(1);
  466. R1005.ecef_y = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  467. ugrab(2);
  468. R1005.ecef_z = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  469. #undef R1005
  470. unknown = false;
  471. break;
  472. case 1006:
  473. /* Stationary Antenna Reference Point, with Height Information
  474. * 21 bytes */
  475. #define R1006 rtcm->rtcmtypes.rtcm3_1006
  476. R1006.station_id = (unsigned short)ugrab(12);
  477. (void)ugrab(6); // reserved
  478. R1006.system = ugrab(3);
  479. R1006.reference_station = (bool)ugrab(1);
  480. R1006.ecef_x = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  481. R1006.single_receiver = ugrab(1);
  482. ugrab(1);
  483. R1006.ecef_y = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  484. ugrab(2);
  485. R1006.ecef_z = sgrab(38) * ANTENNA_POSITION_RESOLUTION;
  486. R1006.height = ugrab(16) * ANTENNA_POSITION_RESOLUTION;
  487. #undef R1006
  488. unknown = false;
  489. break;
  490. case 1007:
  491. /* Antenna Description
  492. * 5 to 36 bytes */
  493. rtcm->rtcmtypes.rtcm3_1007.station_id = (unsigned short)ugrab(12);
  494. n = (unsigned long)ugrab(8);
  495. (void)memcpy(rtcm->rtcmtypes.rtcm3_1007.descriptor, buf + 7, n);
  496. rtcm->rtcmtypes.rtcm3_1007.descriptor[n] = '\0';
  497. bitcount += 8 * n;
  498. rtcm->rtcmtypes.rtcm3_1007.setup_id = ugrab(8);
  499. unknown = false;
  500. break;
  501. case 1008:
  502. /* Antenna Description & Serial Number
  503. * 6 to 68 bytes */
  504. rtcm->rtcmtypes.rtcm3_1008.station_id = (unsigned short)ugrab(12);
  505. n = (unsigned long)ugrab(8);
  506. (void)memcpy(rtcm->rtcmtypes.rtcm3_1008.descriptor, buf + 7, n);
  507. rtcm->rtcmtypes.rtcm3_1008.descriptor[n] = '\0';
  508. bitcount += 8 * n;
  509. rtcm->rtcmtypes.rtcm3_1008.setup_id = ugrab(8);
  510. n2 = (unsigned long)ugrab(8);
  511. (void)memcpy(rtcm->rtcmtypes.rtcm3_1008.serial, buf + 9 + n, n2);
  512. rtcm->rtcmtypes.rtcm3_1008.serial[n2] = '\0';
  513. // bitcount += 8 * n2;
  514. unknown = false;
  515. break;
  516. case 1009:
  517. // GLONASS Basic RTK, L1 Only
  518. rtcm->rtcmtypes.rtcm3_1009.header.station_id =
  519. (unsigned short)ugrab(12);
  520. rtcm->rtcmtypes.rtcm3_1009.header.tow = (time_t)ugrab(27);
  521. rtcm->rtcmtypes.rtcm3_1009.header.sync = (bool)ugrab(1);
  522. rtcm->rtcmtypes.rtcm3_1009.header.satcount = (unsigned short)ugrab(5);
  523. rtcm->rtcmtypes.rtcm3_1009.header.smoothing = (bool)ugrab(1);
  524. rtcm->rtcmtypes.rtcm3_1009.header.interval = (unsigned short)ugrab(3);
  525. #define R1009 rtcm->rtcmtypes.rtcm3_1009.rtk_data[i]
  526. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1009.header.satcount; i++) {
  527. R1009.ident = (unsigned short)ugrab(6);
  528. R1009.L1.indicator = (bool)ugrab(1);
  529. R1009.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  530. R1009.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  531. RANGEDIFF(R1009.L1, 20);
  532. R1009.L1.locktime = (unsigned char)sgrab(7);
  533. }
  534. #undef R1009
  535. unknown = false;
  536. break;
  537. case 1010:
  538. // GLONASS Extended RTK, L1 Only
  539. rtcm->rtcmtypes.rtcm3_1010.header.station_id =
  540. (unsigned short)ugrab(12);
  541. rtcm->rtcmtypes.rtcm3_1010.header.tow = (time_t)ugrab(27);
  542. rtcm->rtcmtypes.rtcm3_1010.header.sync = (bool)ugrab(1);
  543. rtcm->rtcmtypes.rtcm3_1010.header.satcount = (unsigned short)ugrab(5);
  544. rtcm->rtcmtypes.rtcm3_1010.header.smoothing = (bool)ugrab(1);
  545. rtcm->rtcmtypes.rtcm3_1010.header.interval = (unsigned short)ugrab(3);
  546. #define R1010 rtcm->rtcmtypes.rtcm3_1010.rtk_data[i]
  547. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1010.header.satcount; i++) {
  548. R1010.ident = (unsigned short)ugrab(6);
  549. R1010.L1.indicator = (bool)ugrab(1);
  550. R1010.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  551. R1010.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  552. RANGEDIFF(R1010.L1, 20);
  553. R1010.L1.locktime = (unsigned char)sgrab(7);
  554. R1010.L1.ambiguity = (unsigned char)ugrab(7);
  555. R1010.L1.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  556. }
  557. #undef R1010
  558. unknown = false;
  559. break;
  560. case 1011:
  561. // GLONASS Basic RTK, L1 & L2
  562. rtcm->rtcmtypes.rtcm3_1011.header.station_id =
  563. (unsigned short)ugrab(12);
  564. rtcm->rtcmtypes.rtcm3_1011.header.tow = (time_t)ugrab(27);
  565. rtcm->rtcmtypes.rtcm3_1011.header.sync = (bool)ugrab(1);
  566. rtcm->rtcmtypes.rtcm3_1011.header.satcount = (unsigned short)ugrab(5);
  567. rtcm->rtcmtypes.rtcm3_1011.header.smoothing = (bool)ugrab(1);
  568. rtcm->rtcmtypes.rtcm3_1011.header.interval = (unsigned short)ugrab(3);
  569. #define R1011 rtcm->rtcmtypes.rtcm3_1011.rtk_data[i]
  570. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1011.header.satcount; i++) {
  571. R1011.ident = (unsigned short)ugrab(6);
  572. R1011.L1.indicator = (bool)ugrab(1);
  573. R1011.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  574. R1011.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  575. RANGEDIFF(R1011.L1, 20);
  576. R1011.L1.locktime = (unsigned char)sgrab(7);
  577. R1011.L1.ambiguity = (unsigned char)ugrab(7);
  578. R1011.L1.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  579. R1011.L2.indicator = (bool)ugrab(1);
  580. R1011.L2.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  581. R1011.L2.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  582. RANGEDIFF(R1011.L2, 20);
  583. R1011.L2.locktime = (unsigned char)sgrab(7);
  584. R1011.L2.ambiguity = (unsigned char)ugrab(7);
  585. R1011.L2.CNR = ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  586. }
  587. #undef R1011
  588. unknown = false;
  589. break;
  590. case 1012:
  591. // GLONASS Extended RTK, L1 & L2
  592. rtcm->rtcmtypes.rtcm3_1012.header.station_id =
  593. (unsigned short)ugrab(12);
  594. rtcm->rtcmtypes.rtcm3_1012.header.tow = (time_t)ugrab(27);
  595. rtcm->rtcmtypes.rtcm3_1012.header.sync = (bool)ugrab(1);
  596. rtcm->rtcmtypes.rtcm3_1012.header.satcount = (unsigned short)ugrab(5);
  597. rtcm->rtcmtypes.rtcm3_1012.header.smoothing = (bool)ugrab(1);
  598. rtcm->rtcmtypes.rtcm3_1012.header.interval = (unsigned short)ugrab(3);
  599. #define R1012 rtcm->rtcmtypes.rtcm3_1012.rtk_data[i]
  600. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1012.header.satcount; i++) {
  601. unsigned rangeincr;
  602. R1012.ident = (unsigned short)ugrab(6);
  603. R1012.L1.indicator = (bool)ugrab(1);
  604. R1012.L1.channel = (short)ugrab(5) - GLONASS_CHANNEL_BASE;
  605. R1012.L1.pseudorange = ugrab(25) * GLONASS_PSEUDORANGE_RESOLUTION;
  606. RANGEDIFF(R1012.L1, 20);
  607. R1012.L1.locktime = (unsigned char)ugrab(7);
  608. R1012.L1.ambiguity = (unsigned char)ugrab(7);
  609. R1012.L1.CNR = (unsigned char)ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  610. R1012.L2.indicator = (bool)ugrab(2);
  611. rangeincr = ugrab(14);
  612. if (rangeincr == GLONASS_INVALID_RANGEINCR) {
  613. R1012.L2.pseudorange = 0;
  614. } else {
  615. R1012.L2.pseudorange = (rangeincr *
  616. GLONASS_PSEUDORANGE_RESOLUTION);
  617. }
  618. RANGEDIFF(R1012.L2, 20);
  619. R1012.L2.locktime = (unsigned char)sgrab(7);
  620. R1012.L2.CNR = (unsigned char)ugrab(8) * CARRIER_NOISE_RATIO_UNITS;
  621. }
  622. #undef R1012
  623. unknown = false;
  624. break;
  625. case 1013:
  626. // System Parameters
  627. rtcm->rtcmtypes.rtcm3_1013.station_id = (unsigned short)ugrab(12);
  628. rtcm->rtcmtypes.rtcm3_1013.mjd = (unsigned short)ugrab(16);
  629. rtcm->rtcmtypes.rtcm3_1013.sod = (unsigned short)ugrab(17);
  630. rtcm->rtcmtypes.rtcm3_1013.ncount = (unsigned long)ugrab(5);
  631. rtcm->rtcmtypes.rtcm3_1013.leapsecs = (unsigned char)ugrab(8);
  632. #define R1013 rtcm->rtcmtypes.rtcm3_1013.announcements[i]
  633. for (i = 0; i < rtcm->rtcmtypes.rtcm3_1013.ncount; i++) {
  634. R1013.id = (unsigned short)ugrab(12);
  635. R1013.sync = (bool)ugrab(1);
  636. R1013.interval = (unsigned short)ugrab(16);
  637. }
  638. #undef R1013
  639. unknown = false;
  640. break;
  641. case 1014:
  642. /* Network Auxiliary Station Data
  643. * coordinate difference between one Aux station and the master station
  644. */
  645. rtcm->rtcmtypes.rtcm3_1014.network_id = (int)ugrab(8);
  646. rtcm->rtcmtypes.rtcm3_1014.subnetwork_id = (int)ugrab(4);
  647. rtcm->rtcmtypes.rtcm3_1014.stationcount = (char)ugrab(5);
  648. rtcm->rtcmtypes.rtcm3_1014.master_id = (int)ugrab(12);
  649. rtcm->rtcmtypes.rtcm3_1014.aux_id = (int)ugrab(12);
  650. rtcm->rtcmtypes.rtcm3_1014.d_lat =
  651. (unsigned short)ugrab(20) * ANTENNA_DEGREE_RESOLUTION;
  652. rtcm->rtcmtypes.rtcm3_1014.d_lon =
  653. (unsigned short)ugrab(21) * ANTENNA_DEGREE_RESOLUTION;
  654. rtcm->rtcmtypes.rtcm3_1014.d_alt = (unsigned short)ugrab(23) / 1000;
  655. unknown = false;
  656. break;
  657. case 1015:
  658. /* RTCM 3.1
  659. * GPS Ionospheric Correction Differences for all satellites
  660. * between the master station and one auxiliary station
  661. * 9 bytes minimum
  662. */
  663. unknown = rtcm3_101567(context, rtcm, buf);
  664. unknown_name = "GPS Ionospheric Correction Differences";
  665. break;
  666. case 1016:
  667. /* RTCM 3.1
  668. * GPS Geometric Correction Differences for all satellites between
  669. * the master station and one auxiliary station.
  670. * 9 bytes minimum
  671. */
  672. unknown = rtcm3_101567(context, rtcm, buf);
  673. unknown_name = "GPS Geometric Correction Differences";
  674. break;
  675. case 1017:
  676. /* RTCM 3.1
  677. * GPS Combined Geometric and Ionospheric Correction Differences
  678. * for all satellites between one Aux station and the master station
  679. * (same content as both types 1015 and 1016 together, but less size)
  680. * 9 bytes minimum
  681. */
  682. unknown = rtcm3_101567(context, rtcm, buf);
  683. unknown_name = "GPS Combined Geometric and Ionospheric "
  684. "Correction Differences";
  685. break;
  686. case 1018:
  687. /* RTCM 3.1
  688. * Reserved for alternative Ionospheric Correction Difference Message
  689. */
  690. unknown_name = "Reserved for alternative Ionospheric Correction "
  691. "Differences";
  692. break;
  693. case 1019:
  694. /* RTCM 3.1 - 1020
  695. * GPS Ephemeris
  696. * 62 bytes
  697. */
  698. // TODO: rtklib has C code for this one.
  699. unknown_name = "GPS Ephemeris";
  700. break;
  701. case 1020:
  702. /* RTCM 3.1 - 1020
  703. * GLONASS Ephemeris
  704. * 45 bytes
  705. */
  706. // TODO: rtklib has C code for this one.
  707. unknown_name = "GLO Ephemeris";
  708. break;
  709. case 1021:
  710. /* RTCM 3.1
  711. * Helmert / Abridged Molodenski Transformation parameters
  712. */
  713. /* unknown_name = "Helmert / Abridged Molodenski Transformation "
  714. "parameters";*/
  715. // Set Source-Name
  716. n = (unsigned)ugrab(5);
  717. if ((sizeof(rtcm->rtcmtypes.rtcm3_1021.src_name) -1) <= n) {
  718. // paranoia
  719. n = sizeof(rtcm->rtcmtypes.rtcm3_1021.src_name) - 1;
  720. }
  721. for (i = 0; i < n; i++) {
  722. rtcm->rtcmtypes.rtcm3_1021.src_name[i] = (char)ugrab(8);
  723. }
  724. rtcm->rtcmtypes.rtcm3_1021.src_name[n] = '\0';
  725. // Set Target-Name
  726. n2 = (unsigned)ugrab(5);
  727. if ((sizeof(rtcm->rtcmtypes.rtcm3_1021.tar_name) - 1) <= n2) {
  728. // paranoia
  729. n2 = sizeof(rtcm->rtcmtypes.rtcm3_1021.tar_name) - 1;
  730. }
  731. for (i = 0; i < n2; i++) {
  732. rtcm->rtcmtypes.rtcm3_1021.tar_name[i] = (char)ugrab(8);
  733. }
  734. rtcm->rtcmtypes.rtcm3_1021.tar_name[n2] = '\0';
  735. rtcm->rtcmtypes.rtcm3_1021.sys_id_num = (unsigned)ugrab(8);
  736. #define R1021 rtcm->rtcmtypes.rtcm3_1021.ut_tr_msg_id[i]
  737. for (i = 0; i < RTCM3_DF148_SIZE; i++) {
  738. R1021 = (bool)ugrab(1);
  739. }
  740. #undef R1021
  741. rtcm->rtcmtypes.rtcm3_1021.plate_number = (unsigned)ugrab(5);
  742. rtcm->rtcmtypes.rtcm3_1021.computation_id = (unsigned)ugrab(4);
  743. rtcm->rtcmtypes.rtcm3_1021.height_id = (unsigned)ugrab(2);
  744. rtcm->rtcmtypes.rtcm3_1021.lat_origin = sgrab(19) *
  745. VALIDITY_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  746. rtcm->rtcmtypes.rtcm3_1021.lon_origin = sgrab(20) *
  747. VALIDITY_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  748. rtcm->rtcmtypes.rtcm3_1021.lat_extension = sgrab(14) *
  749. VALIDITY_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  750. rtcm->rtcmtypes.rtcm3_1021.lon_extension = sgrab(14) *
  751. VALIDITY_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  752. rtcm->rtcmtypes.rtcm3_1021.x_trans = sgrab(23) *
  753. TRANSLATION_MM_RESOLUTION;
  754. rtcm->rtcmtypes.rtcm3_1021.y_trans = sgrab(23) *
  755. TRANSLATION_MM_RESOLUTION;
  756. rtcm->rtcmtypes.rtcm3_1021.z_trans = sgrab(23) *
  757. TRANSLATION_MM_RESOLUTION;
  758. rtcm->rtcmtypes.rtcm3_1021.x_rot = sgrab(32) *
  759. ROTATION_ARCSEC_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  760. rtcm->rtcmtypes.rtcm3_1021.y_rot = sgrab(32) *
  761. ROTATION_ARCSEC_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  762. rtcm->rtcmtypes.rtcm3_1021.z_rot = sgrab(32) *
  763. ROTATION_ARCSEC_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  764. rtcm->rtcmtypes.rtcm3_1021.ds = sgrab(25) * SCALE_PPM_RESOLUTION;
  765. rtcm->rtcmtypes.rtcm3_1021.add_as = sgrab(24) *
  766. TRANSLATION_MM_RESOLUTION;
  767. rtcm->rtcmtypes.rtcm3_1021.add_bs = sgrab(25) *
  768. TRANSLATION_MM_RESOLUTION;
  769. rtcm->rtcmtypes.rtcm3_1021.add_at = sgrab(24) *
  770. TRANSLATION_MM_RESOLUTION;
  771. rtcm->rtcmtypes.rtcm3_1021.add_bt = sgrab(25) *
  772. TRANSLATION_MM_RESOLUTION;
  773. rtcm->rtcmtypes.rtcm3_1021.quality_hori = (unsigned)ugrab(3);
  774. rtcm->rtcmtypes.rtcm3_1021.quality_vert = (unsigned)ugrab(3);
  775. unknown = false;
  776. break;
  777. case 1022:
  778. /* RTCM 3.1
  779. * Molodenski-Badekas transformation parameters
  780. */
  781. unknown_name = "Molodenski-Badekas transformation parameters";
  782. break;
  783. case 1023:
  784. /* RTCM 3.1
  785. * Residuals Ellipsoidal Grid Representation
  786. */
  787. // unknown_name = "Residuals Ellipsoidal Grid Representation";
  788. rtcm->rtcmtypes.rtcm3_1023.sys_id_num = (unsigned)ugrab(8);
  789. rtcm->rtcmtypes.rtcm3_1023.shift_id_hori = (bool)ugrab(1);
  790. rtcm->rtcmtypes.rtcm3_1023.shift_id_vert = (bool)ugrab(1);
  791. rtcm->rtcmtypes.rtcm3_1023.lat_origin = sgrab(21) *
  792. PHASE_CORRECTION_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  793. rtcm->rtcmtypes.rtcm3_1023.lon_origin = sgrab(22) *
  794. PHASE_CORRECTION_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  795. rtcm->rtcmtypes.rtcm3_1023.lat_extension = (unsigned)ugrab(12) *
  796. PHASE_CORRECTION_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  797. rtcm->rtcmtypes.rtcm3_1023.lon_extension = (unsigned)ugrab(12) *
  798. PHASE_CORRECTION_RESOLUTION / DEG_ARCSEC_RESOLUTION;
  799. rtcm->rtcmtypes.rtcm3_1023.lat_mean = sgrab(8) *
  800. TRANSLATION_MM_RESOLUTION;
  801. rtcm->rtcmtypes.rtcm3_1023.lon_mean = sgrab(8) *
  802. TRANSLATION_MM_RESOLUTION;
  803. rtcm->rtcmtypes.rtcm3_1023.hgt_mean = sgrab(15) * CM_RESOLUTION;
  804. #define R1023 rtcm->rtcmtypes.rtcm3_1023.residuals[i]
  805. for (i = 0; i < RTCM3_GRID_SIZE; i++) {
  806. R1023.lat_res = sgrab(9) * RES_ARCSEC_RESOLUTION;
  807. R1023.lon_res = sgrab(9) * RES_ARCSEC_RESOLUTION;
  808. R1023.hgt_res = sgrab(9) * TRANSLATION_MM_RESOLUTION;
  809. }
  810. #undef R1023
  811. rtcm->rtcmtypes.rtcm3_1023.interp_meth_id_hori = (unsigned)ugrab(2);
  812. rtcm->rtcmtypes.rtcm3_1023.interp_meth_id_vert = (unsigned)ugrab(2);
  813. rtcm->rtcmtypes.rtcm3_1023.grd_qual_id_hori = (unsigned)ugrab(3);
  814. rtcm->rtcmtypes.rtcm3_1023.grd_qual_id_vert = (unsigned)ugrab(3);
  815. rtcm->rtcmtypes.rtcm3_1023.mjd = (unsigned short)ugrab(16);
  816. unknown = false;
  817. break;
  818. case 1024:
  819. /* RTCM 3.1
  820. * Residuals Plane Grid Representation
  821. */
  822. unknown_name = "Residuals Plane Grid Representation";
  823. break;
  824. case 1025:
  825. /* RTCM 3.1
  826. * Projection Parameters, Projection Types other than LCC2SP
  827. */
  828. /* unknown_name = "Projection Parameters, Projection Types other "
  829. "than LCC2SP"; */
  830. rtcm->rtcmtypes.rtcm3_1025.sys_id_num = (unsigned short)ugrab(8);
  831. rtcm->rtcmtypes.rtcm3_1025.projection_type = (unsigned short)ugrab(6);
  832. rtcm->rtcmtypes.rtcm3_1025.lat_origin = sgrab(34) *
  833. PROJ_ORIGIN_RESOLUTION;
  834. rtcm->rtcmtypes.rtcm3_1025.lon_origin = sgrab(35) *
  835. PROJ_ORIGIN_RESOLUTION;
  836. rtcm->rtcmtypes.rtcm3_1025.add_sno = (unsigned)ugrab(30) *
  837. SCALE_PPM_RESOLUTION;
  838. rtcm->rtcmtypes.rtcm3_1025.false_east = (unsigned)ugrab(36) *
  839. TRANSLATION_MM_RESOLUTION;
  840. rtcm->rtcmtypes.rtcm3_1025.false_north = ugrab(35) *
  841. TRANSLATION_MM_RESOLUTION;
  842. unknown = false;
  843. break;
  844. case 1026:
  845. /* RTCM 3.1
  846. * Projection Parameters, Projection Type LCC2SP
  847. * (Lambert Conic Conformal)
  848. */
  849. unknown_name = "Projection Parameters, Projection Type LCC2SP";
  850. break;
  851. case 1027:
  852. /* RTCM 3.1
  853. * Projection Parameters, Projection Type OM (Oblique Mercator)
  854. */
  855. unknown_name = "Projection Parameters, Projection Type OM";
  856. break;
  857. case 1028:
  858. /* RTCM 3.1
  859. * Reserved for global to plate fixed transformation
  860. */
  861. unknown_name = "Reserved, Global to Plate Transformation";
  862. break;
  863. case 1029:
  864. /* Text in UTF8 format
  865. * 9 bytes minimum
  866. * (max. 127 multibyte characters and max. 255 bytes)
  867. */
  868. rtcm->rtcmtypes.rtcm3_1029.station_id = (unsigned short)ugrab(12);
  869. rtcm->rtcmtypes.rtcm3_1029.mjd = (unsigned short)ugrab(16);
  870. rtcm->rtcmtypes.rtcm3_1029.sod = (unsigned short)ugrab(17);
  871. rtcm->rtcmtypes.rtcm3_1029.len = (unsigned long)ugrab(7);
  872. rtcm->rtcmtypes.rtcm3_1029.unicode_units = (size_t)ugrab(8);
  873. (void)memcpy(rtcm->rtcmtypes.rtcm3_1029.text,
  874. buf + 12, rtcm->rtcmtypes.rtcm3_1029.unicode_units);
  875. unknown = false;
  876. break;
  877. case 1030:
  878. /* RTCM 3.1
  879. * GPS Network RTK Residual Message
  880. */
  881. unknown_name = "GPS Network RTK Residual";
  882. break;
  883. case 1031:
  884. /* RTCM 3.1
  885. * GLONASS Network RTK Residual Message
  886. */
  887. unknown_name = "GLONASS Network RTK Residual";
  888. break;
  889. case 1032:
  890. /* RTCM 3.1
  891. * Physical Reference Station Position message
  892. */
  893. unknown_name = "Physical Reference Station Position";
  894. break;
  895. case 1033: // see note in header
  896. /* Receiver and Antenna Descriptor
  897. * Type1033 is a combined Message Types 1007 and 1008
  898. * and hence contains antenna descriptor and serial number
  899. * as well as receiver descriptor and serial number.
  900. */
  901. // TODO: rtklib has C code for this one.
  902. rtcm->rtcmtypes.rtcm3_1033.station_id = (unsigned short)ugrab(12);
  903. n = (unsigned long)ugrab(8);
  904. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.descriptor, buf + 7, n);
  905. rtcm->rtcmtypes.rtcm3_1033.descriptor[n] = '\0';
  906. bitcount += 8 * n;
  907. rtcm->rtcmtypes.rtcm3_1033.setup_id = ugrab(8);
  908. n2 = (unsigned long)ugrab(8);
  909. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.serial, buf + 9 + n, n2);
  910. rtcm->rtcmtypes.rtcm3_1033.serial[n2] = '\0';
  911. bitcount += 8 * n2;
  912. n3 = (unsigned long)ugrab(8);
  913. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.receiver, buf + 10+n+n2, n3);
  914. rtcm->rtcmtypes.rtcm3_1033.receiver[n3] = '\0';
  915. bitcount += 8 * n3;
  916. n4 = (unsigned long)ugrab(8);
  917. (void)memcpy(rtcm->rtcmtypes.rtcm3_1033.firmware, buf + 11+n+n2+n3, n3);
  918. rtcm->rtcmtypes.rtcm3_1033.firmware[n4] = '\0';
  919. // bitcount += 8 * n4;
  920. // TODO: next is receiver serial number
  921. unknown = false;
  922. break;
  923. case 1034:
  924. /* RTCM 3.2
  925. * GPS Network FKP Gradient Message
  926. */
  927. unknown_name = "GPS Network FKP Gradient";
  928. break;
  929. case 1035:
  930. /* RTCM 3.2
  931. * GLONASS Network FKP Gradient Message
  932. */
  933. unknown_name = "GLO Network FKP Gradient";
  934. break;
  935. case 1037:
  936. /* RTCM 3.2
  937. * GLONASS Ionospheric Correction Differences
  938. */
  939. unknown_name = "GLO Ionospheric Correction Differences";
  940. break;
  941. case 1038:
  942. /* RTCM 3.2
  943. * GLONASS Geometric Correction Differences
  944. */
  945. unknown_name = "GLO Geometric Correction Differences";
  946. break;
  947. case 1039:
  948. /* RTCM 3.2
  949. * GLONASS Combined Geometric and Ionospheric Correction Differences
  950. */
  951. unknown_name = "GLONASS Combined Geometric and Ionospheric "
  952. "Correction Differences";
  953. break;
  954. case 1042:
  955. /* RTCM 3.x - 1043
  956. * BeiDou Ephemeris
  957. * length ?
  958. */
  959. unknown_name = "BD Ephemeris";
  960. break;
  961. case 1043:
  962. /* RTCM 3.x - 1043
  963. * SBAS Ephemeris
  964. * length 29
  965. */
  966. unknown_name = "SBAS Ephemeris";
  967. break;
  968. case 1044:
  969. /* RTCM 3.x - 1044
  970. * QZSS ephemeris
  971. * length 61
  972. */
  973. // TODO: rtklib has C code for this one.
  974. unknown_name = "QZSS Ephemeris";
  975. break;
  976. case 1045:
  977. /* RTCM 3.2 - 1045
  978. * Galileo F/NAV Ephemeris Data
  979. * 64 bytes
  980. */
  981. // TODO: rtklib has C code for this one.
  982. unknown_name = "GAL F/NAV Ephemeris Data";
  983. break;
  984. case 1046:
  985. /* RTCM 3.x - 1046
  986. * Galileo I/NAV Ephemeris Data
  987. * length 63
  988. */
  989. // TODO: rtklib has C code for this one.
  990. unknown_name = "GAL I/NAV Ephemeris Data";
  991. break;
  992. case 1057:
  993. /* RTCM 3.2
  994. * SSR GPS Orbit Correction
  995. */
  996. unknown_name = "SSR GPS Orbit Correction";
  997. break;
  998. case 1058:
  999. /* RTCM 3.2
  1000. * SSR GPS Clock Correction
  1001. */
  1002. unknown_name = "SSR GPS Clock Correction";
  1003. break;
  1004. case 1059:
  1005. /* RTCM 3.2
  1006. * SSR GPS Code Bias
  1007. */
  1008. unknown_name = "SSR GPS Code Bias";
  1009. break;
  1010. case 1060:
  1011. /* RTCM 3.2
  1012. * SSR GPS Combined Orbit and Clock Correction
  1013. */
  1014. unknown_name = "SSR GPS Combined Orbit and Clock Correction";
  1015. break;
  1016. case 1061:
  1017. /* RTCM 3.2
  1018. * SSR GPS URA
  1019. */
  1020. unknown_name = "SSR GPS URA";
  1021. break;
  1022. case 1062:
  1023. /* RTCM 3.2
  1024. * SSR GPS High Rate Clock Correction
  1025. */
  1026. unknown_name = "SSR GPS High Rate Clock Correction";
  1027. break;
  1028. case 1063:
  1029. /* RTCM 3.2
  1030. * SSR GLO Orbit Correction
  1031. */
  1032. unknown_name = "SSR GLO Orbit Correction";
  1033. break;
  1034. case 1064:
  1035. /* RTCM 3.2
  1036. * SSR GLO Clock Correction
  1037. */
  1038. unknown_name = "SSR GLO Clock Correction";
  1039. break;
  1040. case 1065:
  1041. /* RTCM 3.2
  1042. * SSR GLO Code Correction
  1043. */
  1044. unknown_name = "SSR GLO ode Correction";
  1045. break;
  1046. case 1066:
  1047. /* RTCM 3.2
  1048. * SSR GLO Combined Orbit and Clock Correction
  1049. */
  1050. unknown_name = "SSR GLO Combined Orbit and Clock Correction";
  1051. break;
  1052. case 1067:
  1053. /* RTCM 3.2
  1054. * SSR GLO URA
  1055. */
  1056. unknown_name = "SSR GLO URA";
  1057. break;
  1058. case 1068:
  1059. /* RTCM 3.2
  1060. * SSR GPS High Rate Clock Correction
  1061. */
  1062. unknown_name = "SSR GLO High Rate Clock Correction";
  1063. break;
  1064. case 1070:
  1065. /* RTCM 3.x
  1066. * Reserved for MSM
  1067. */
  1068. unknown_name = "Reserved for MSM";
  1069. break;
  1070. case 1071:
  1071. /* RTCM 3.2
  1072. * GPS Multi Signal Message 1
  1073. */
  1074. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GPS;
  1075. rtcm->rtcmtypes.rtcm3_msm.msm = 1;
  1076. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1077. unknown_name = "GPS MSM 1";
  1078. break;
  1079. case 1072:
  1080. /* RTCM 3.2
  1081. * GPS Multi Signal Message 2
  1082. */
  1083. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GPS;
  1084. rtcm->rtcmtypes.rtcm3_msm.msm = 2;
  1085. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1086. unknown_name = "GPS MSM 2";
  1087. break;
  1088. case 1073:
  1089. /* RTCM 3.2
  1090. * GPS Multi Signal Message 3
  1091. */
  1092. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GPS;
  1093. rtcm->rtcmtypes.rtcm3_msm.msm = 3;
  1094. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1095. unknown_name = "GPS MSM 3";
  1096. break;
  1097. case 1074:
  1098. /* RTCM 3.2
  1099. * GPS Multi Signal Message 4
  1100. */
  1101. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GPS;
  1102. rtcm->rtcmtypes.rtcm3_msm.msm = 4;
  1103. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1104. unknown_name = "GPS MSM 4";
  1105. break;
  1106. case 1075:
  1107. /* RTCM 3.2
  1108. * GPS Multi Signal Message 5
  1109. */
  1110. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GPS;
  1111. rtcm->rtcmtypes.rtcm3_msm.msm = 5;
  1112. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1113. unknown_name = "GPS MSM 5";
  1114. break;
  1115. case 1076:
  1116. /* RTCM 3.2
  1117. * GPS Multi Signal Message 6
  1118. */
  1119. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GPS;
  1120. rtcm->rtcmtypes.rtcm3_msm.msm = 6;
  1121. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1122. unknown_name = "GPS MSM 6";
  1123. break;
  1124. case 1077:
  1125. /* RTCM 3.2 - 1077
  1126. * GPS Multi Signal Message 7
  1127. * Full GPS pseudo-ranges, carrier phases, Doppler and
  1128. * signal strength (high resolution)
  1129. * min length 438
  1130. */
  1131. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GPS;
  1132. rtcm->rtcmtypes.rtcm3_msm.msm = 7;
  1133. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1134. unknown_name = "GPS MSM7";
  1135. break;
  1136. case 1078:
  1137. /* RTCM 3.x
  1138. * Reserved for MSM
  1139. */
  1140. unknown_name = "Reserved for MSM";
  1141. break;
  1142. case 1079:
  1143. /* RTCM 3.x
  1144. * Reserved for MSM
  1145. */
  1146. unknown_name = "Reserved for MSM";
  1147. break;
  1148. case 1080:
  1149. /* RTCM 3.x
  1150. * Reserved for MSM
  1151. */
  1152. unknown_name = "Reserved for MSM";
  1153. break;
  1154. case 1081:
  1155. /* RTCM 3.2
  1156. * GLONASS Multi Signal Message 1
  1157. */
  1158. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GLO;
  1159. rtcm->rtcmtypes.rtcm3_msm.msm = 1;
  1160. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1161. unknown_name = "GLO MSM 1";
  1162. break;
  1163. case 1082:
  1164. /* RTCM 3.2
  1165. * GLONASS Multi Signal Message 2
  1166. */
  1167. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GLO;
  1168. rtcm->rtcmtypes.rtcm3_msm.msm = 2;
  1169. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1170. unknown_name = "GLO MSM 2";
  1171. break;
  1172. case 1083:
  1173. /* RTCM 3.2
  1174. * GLONASS Multi Signal Message 4
  1175. */
  1176. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GLO;
  1177. rtcm->rtcmtypes.rtcm3_msm.msm = 3;
  1178. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1179. unknown_name = "GLO MSM 3";
  1180. break;
  1181. case 1084:
  1182. /* RTCM 3.2
  1183. * GLONASS Multi Signal Message 4
  1184. */
  1185. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GLO;
  1186. rtcm->rtcmtypes.rtcm3_msm.msm = 4;
  1187. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1188. unknown_name = "GLO MSM 4";
  1189. break;
  1190. case 1085:
  1191. /* RTCM 3.2
  1192. * GLONASS Multi Signal Message 5
  1193. */
  1194. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GLO;
  1195. rtcm->rtcmtypes.rtcm3_msm.msm = 5;
  1196. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1197. unknown_name = "GLO MSM 5";
  1198. break;
  1199. case 1086:
  1200. /* RTCM 3.2
  1201. * GLONASS Multi Signal Message 6
  1202. */
  1203. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GLO;
  1204. rtcm->rtcmtypes.rtcm3_msm.msm = 6;
  1205. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1206. unknown_name = "GLO MSM 6";
  1207. break;
  1208. case 1087:
  1209. /* RTCM 3.2 - 1087
  1210. * GLONASS Multi Signal Message 7
  1211. * Full GLONASS pseudo-ranges, carrier phases, Doppler and
  1212. * signal strength (high resolution)
  1213. * length 417 or 427
  1214. */
  1215. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GLO;
  1216. rtcm->rtcmtypes.rtcm3_msm.msm = 7;
  1217. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1218. unknown_name = "GLO MSM 7";
  1219. break;
  1220. case 1088:
  1221. /* RTCM 3.x
  1222. * Reserved for MSM
  1223. */
  1224. unknown_name = "Reserved for MSM";
  1225. break;
  1226. case 1089:
  1227. /* RTCM 3.x
  1228. * Reserved for MSM
  1229. */
  1230. unknown_name = "Reserved for MSM";
  1231. break;
  1232. case 1090:
  1233. /* RTCM 3.x
  1234. * Reserved for MSM
  1235. */
  1236. unknown_name = "Reserved for MSM";
  1237. break;
  1238. case 1091:
  1239. /* RTCM 3.2
  1240. * Galileo Multi Signal Message 1
  1241. */
  1242. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GAL;
  1243. rtcm->rtcmtypes.rtcm3_msm.msm = 1;
  1244. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1245. unknown_name = "GAL MSM 1";
  1246. break;
  1247. case 1092:
  1248. /* RTCM 3.2
  1249. * Galileo Multi Signal Message 2
  1250. */
  1251. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GAL;
  1252. rtcm->rtcmtypes.rtcm3_msm.msm = 2;
  1253. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1254. unknown_name = "GAL MSM 2";
  1255. break;
  1256. case 1093:
  1257. /* RTCM 3.2
  1258. * Galileo Multi Signal Message 3
  1259. */
  1260. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GAL;
  1261. rtcm->rtcmtypes.rtcm3_msm.msm = 3;
  1262. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1263. unknown_name = "GAL MSM 3";
  1264. break;
  1265. case 1094:
  1266. /* RTCM 3.2
  1267. * Galileo Multi Signal Message 4
  1268. */
  1269. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GAL;
  1270. rtcm->rtcmtypes.rtcm3_msm.msm = 4;
  1271. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1272. unknown_name = "GAL MSM 4";
  1273. break;
  1274. case 1095:
  1275. /* RTCM 3.2
  1276. * Galileo Multi Signal Message 5
  1277. */
  1278. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GAL;
  1279. rtcm->rtcmtypes.rtcm3_msm.msm = 5;
  1280. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1281. unknown_name = "GAL MSM 5";
  1282. break;
  1283. case 1096:
  1284. /* RTCM 3.2
  1285. * Galileo Multi Signal Message 6
  1286. */
  1287. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GAL;
  1288. rtcm->rtcmtypes.rtcm3_msm.msm = 6;
  1289. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1290. unknown_name = "GAL MSM 6";
  1291. break;
  1292. case 1097:
  1293. /* RTCM 3.2 - 1097
  1294. * Galileo Multi Signal Message 7
  1295. * Full Galileo pseudo-ranges, carrier phases, Doppler and
  1296. * signal strength (high resolution)
  1297. * length 96
  1298. */
  1299. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_GAL;
  1300. rtcm->rtcmtypes.rtcm3_msm.msm = 7;
  1301. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1302. unknown_name = "GAL MSM 7";
  1303. break;
  1304. case 1098:
  1305. /* RTCM 3.x
  1306. * Reserved for MSM
  1307. */
  1308. unknown_name = "Reserved for MSM";
  1309. break;
  1310. case 1099:
  1311. /* RTCM 3.x
  1312. * Reserved for MSM
  1313. */
  1314. unknown_name = "Reserved for MSM";
  1315. break;
  1316. case 1100:
  1317. /* RTCM 3.x
  1318. * Reserved for MSM
  1319. */
  1320. unknown_name = "Reserved for MSM";
  1321. break;
  1322. case 1101:
  1323. /* RTCM 3.3
  1324. * SBAS Multi Signal Message 1
  1325. */
  1326. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_SBAS;
  1327. rtcm->rtcmtypes.rtcm3_msm.msm = 1;
  1328. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1329. unknown_name = "SBAS MSM 1";
  1330. break;
  1331. case 1102:
  1332. /* RTCM 3.3
  1333. * SBAS Multi Signal Message 2
  1334. */
  1335. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_SBAS;
  1336. rtcm->rtcmtypes.rtcm3_msm.msm = 2;
  1337. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1338. unknown_name = "SBAS MSM 2";
  1339. break;
  1340. case 1103:
  1341. /* RTCM 3.3
  1342. * SBAS Multi Signal Message 3
  1343. */
  1344. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_SBAS;
  1345. rtcm->rtcmtypes.rtcm3_msm.msm = 3;
  1346. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1347. unknown_name = "SBAS MSM 3";
  1348. break;
  1349. case 1104:
  1350. /* RTCM 3.3
  1351. * SBAS Multi Signal Message 4
  1352. */
  1353. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_SBAS;
  1354. rtcm->rtcmtypes.rtcm3_msm.msm = 4;
  1355. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1356. unknown_name = "SBAS MSM 4";
  1357. break;
  1358. case 1105:
  1359. /* RTCM 3.3
  1360. * SBAS Multi Signal Message 5
  1361. */
  1362. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_SBAS;
  1363. rtcm->rtcmtypes.rtcm3_msm.msm = 5;
  1364. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1365. unknown_name = "SBAS MSM 5";
  1366. break;
  1367. case 1106:
  1368. /* RTCM 3.3
  1369. * SBAS Multi Signal Message 6
  1370. */
  1371. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_SBAS;
  1372. rtcm->rtcmtypes.rtcm3_msm.msm = 6;
  1373. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1374. unknown_name = "SBAS MSM 6";
  1375. break;
  1376. case 1107:
  1377. /* RTCM 3.3 - 1107
  1378. * 'Multiple Signal Message
  1379. * Full SBAS pseudo-ranges, carrier phases, Doppler and
  1380. * signal strength (high resolution)
  1381. * length 96
  1382. */
  1383. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_SBAS;
  1384. rtcm->rtcmtypes.rtcm3_msm.msm = 7;
  1385. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1386. unknown_name = "SBAS MSM 7";
  1387. break;
  1388. case 1108:
  1389. /* RTCM 3.x
  1390. * Reserved for MSM
  1391. */
  1392. unknown_name = "Reserved for MSM";
  1393. break;
  1394. case 1109:
  1395. /* RTCM 3.x
  1396. * Reserved for MSM
  1397. */
  1398. unknown_name = "Reserved for MSM";
  1399. break;
  1400. case 1110:
  1401. /* RTCM 3.x
  1402. * Reserved for MSM
  1403. */
  1404. unknown_name = "Reserved for MSM";
  1405. break;
  1406. case 1111:
  1407. /* RTCM 3.3
  1408. * QZSS Multi Signal Message 1
  1409. */
  1410. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_QZSS;
  1411. rtcm->rtcmtypes.rtcm3_msm.msm = 1;
  1412. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1413. unknown_name = "QZSS MSM 1";
  1414. break;
  1415. case 1112:
  1416. /* RTCM 3.3
  1417. * QZSS Multi Signal Message 2
  1418. */
  1419. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_QZSS;
  1420. rtcm->rtcmtypes.rtcm3_msm.msm = 2;
  1421. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1422. unknown_name = "QZSS MSM 2";
  1423. break;
  1424. case 1113:
  1425. /* RTCM 3.3
  1426. * QZSS Multi Signal Message 3
  1427. */
  1428. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_QZSS;
  1429. rtcm->rtcmtypes.rtcm3_msm.msm = 3;
  1430. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1431. unknown_name = "QZSS MSM 3";
  1432. break;
  1433. case 1114:
  1434. /* RTCM 3.3
  1435. * QZSS Multi Signal Message 4
  1436. */
  1437. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_QZSS;
  1438. rtcm->rtcmtypes.rtcm3_msm.msm = 4;
  1439. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1440. unknown_name = "QZSS MSM 4";
  1441. break;
  1442. case 1115:
  1443. /* RTCM 3.3
  1444. * QZSS Multi Signal Message 5
  1445. */
  1446. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_QZSS;
  1447. rtcm->rtcmtypes.rtcm3_msm.msm = 5;
  1448. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1449. unknown_name = "QZSS MSM 5";
  1450. break;
  1451. case 1116:
  1452. /* RTCM 3.3
  1453. * QZSS Multi Signal Message 6
  1454. */
  1455. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_QZSS;
  1456. rtcm->rtcmtypes.rtcm3_msm.msm = 6;
  1457. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1458. unknown_name = "QZSS MSM 6";
  1459. break;
  1460. case 1117:
  1461. /* RTCM 3.3
  1462. * QZSS Multi Signal Message 7
  1463. */
  1464. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_QZSS;
  1465. rtcm->rtcmtypes.rtcm3_msm.msm = 7;
  1466. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1467. unknown_name = "QZSS MSM 7";
  1468. break;
  1469. case 1118:
  1470. /* RTCM 3.x
  1471. * Reserved for MSM
  1472. */
  1473. unknown_name = "Reserved for MSM";
  1474. break;
  1475. case 1119:
  1476. /* RTCM 3.x
  1477. * Reserved for MSM
  1478. */
  1479. unknown_name = "Reserved for MSM";
  1480. break;
  1481. case 1120:
  1482. /* RTCM 3.x
  1483. * Reserved for MSM
  1484. */
  1485. unknown_name = "Reserved for MSM";
  1486. break;
  1487. case 1121:
  1488. /* RTCM 3.2 A.1
  1489. * BD Multi Signal Message 1
  1490. */
  1491. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_BD;
  1492. rtcm->rtcmtypes.rtcm3_msm.msm = 1;
  1493. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1494. unknown_name = "BD MSM 1";
  1495. break;
  1496. case 1122:
  1497. /* RTCM 3.2 A.1
  1498. * BD Multi Signal Message 2
  1499. */
  1500. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_BD;
  1501. rtcm->rtcmtypes.rtcm3_msm.msm = 2;
  1502. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1503. unknown_name = "BD MSM 2";
  1504. break;
  1505. case 1123:
  1506. /* RTCM 3.2 A.1
  1507. * BD Multi Signal Message 3
  1508. */
  1509. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_BD;
  1510. rtcm->rtcmtypes.rtcm3_msm.msm = 3;
  1511. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1512. unknown_name = "BD MSM 3";
  1513. break;
  1514. case 1124:
  1515. /* RTCM 3.2 A.1
  1516. * BD Multi Signal Message 4
  1517. */
  1518. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_BD;
  1519. rtcm->rtcmtypes.rtcm3_msm.msm = 4;
  1520. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1521. unknown_name = "BD MSM 4";
  1522. break;
  1523. case 1125:
  1524. /* RTCM 3.2 A.1
  1525. * BeiDou Multi Signal Message 5
  1526. */
  1527. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_BD;
  1528. rtcm->rtcmtypes.rtcm3_msm.msm = 5;
  1529. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1530. unknown_name = "BD MSM 5";
  1531. break;
  1532. case 1126:
  1533. /* RTCM 3.2 A.1
  1534. * BeiDou Multi Signal Message 6
  1535. */
  1536. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_BD;
  1537. rtcm->rtcmtypes.rtcm3_msm.msm = 6;
  1538. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1539. unknown_name = "BD MSM 6";
  1540. break;
  1541. case 1127:
  1542. /* RTCM 3.2 A.1
  1543. * BeiDou Multi Signal Message 7
  1544. */
  1545. rtcm->rtcmtypes.rtcm3_msm.gnssid = GNSSID_BD;
  1546. rtcm->rtcmtypes.rtcm3_msm.msm = 7;
  1547. unknown = rtcm3_decode_msm(context, rtcm, buf);
  1548. unknown_name = "BD MSM 7";
  1549. break;
  1550. case 1128:
  1551. /* RTCM 3.x
  1552. * Reserved for MSM
  1553. */
  1554. unknown_name = "Reserved for MSM";
  1555. break;
  1556. case 1229:
  1557. /* RTCM 3.x
  1558. * Reserved for MSM
  1559. */
  1560. unknown_name = "Reserved for MSM";
  1561. break;
  1562. case 1230:
  1563. /* RTCM 3.2
  1564. * GLONASS L1 and L2, C/A and P, Code-Phase Biases.
  1565. */
  1566. unknown_name = "GLO L1 and L2 Code-Phase Biases";
  1567. unknown = false;
  1568. rtcm->rtcmtypes.rtcm3_1230.station_id = (unsigned short)ugrab(12);
  1569. rtcm->rtcmtypes.rtcm3_1230.bias_indicator = (unsigned char)ugrab(1);
  1570. (void)ugrab(1); // reserved
  1571. rtcm->rtcmtypes.rtcm3_1230.signals_mask = (unsigned char)ugrab(3);
  1572. // actual mask order is undocumented...
  1573. if (1 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1574. rtcm->rtcmtypes.rtcm3_1230.l1_ca_bias = ugrab(16);
  1575. }
  1576. if (2 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1577. rtcm->rtcmtypes.rtcm3_1230.l1_p_bias = ugrab(16);
  1578. }
  1579. if (4 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1580. rtcm->rtcmtypes.rtcm3_1230.l2_ca_bias = ugrab(16);
  1581. }
  1582. if (8 & rtcm->rtcmtypes.rtcm3_1230.signals_mask) {
  1583. rtcm->rtcmtypes.rtcm3_1230.l2_p_bias = ugrab(16);
  1584. }
  1585. break;
  1586. // Message Types 4001 — 4060 Are Reserved
  1587. case 4062:
  1588. /* RTCM 3.3
  1589. * Geely Proprietary
  1590. */
  1591. unknown_name = "Geely Proprietary";
  1592. break;
  1593. case 4063:
  1594. /* RTCM 3.3
  1595. * CHC Navigation (CHCNAV) Proprietary
  1596. */
  1597. unknown_name = "CHC Navigation (CHCNAV) Proprietary";
  1598. break;
  1599. case 4064:
  1600. /* RTCM 3.3
  1601. * NTLab Proprietary
  1602. */
  1603. unknown_name = "NTLab Proprietary";
  1604. break;
  1605. case 4065:
  1606. /* RTCM 3.3
  1607. * Allystar Technology (Shenzhen) Co. Ltd. Proprietary
  1608. */
  1609. unknown_name = "Allystar Technology (Shenzhen) Co. Ltd. Proprietary";
  1610. break;
  1611. case 4066:
  1612. /* RTCM 3.3
  1613. * Lantmateriet Proprietary
  1614. */
  1615. unknown_name = "Lantmateriet Proprietary";
  1616. break;
  1617. case 4067:
  1618. /* RTCM 3.x
  1619. * China Transport telecommunications & Information Center Proprietary
  1620. */
  1621. unknown_name = "China Transport telecommunications & Information "
  1622. "Center Proprietary";
  1623. break;
  1624. case 4068:
  1625. /* RTCM 3.3
  1626. * Qianxun Location Networks Co. Ltd Proprietary
  1627. */
  1628. unknown_name = "Qianxun Location Networks Co. Ltd Proprietary";
  1629. break;
  1630. case 4069:
  1631. /* RTCM 3.3
  1632. * VERIPOS Ltd Proprietary
  1633. */
  1634. unknown_name = "VERIPOS Ltd Proprietary";
  1635. break;
  1636. case 4070:
  1637. /* RTCM 3.3
  1638. * Wuhan MengXin Technology
  1639. */
  1640. unknown_name = "Wuhan MengXin Technology Proprietary";
  1641. break;
  1642. case 4071:
  1643. /* RTCM 3.3
  1644. * Wuhan Navigation and LBS
  1645. */
  1646. unknown_name = "Wuhan Navigation and LBS Proprietary";
  1647. break;
  1648. case 4072:
  1649. /* RTCM 3.x
  1650. * u-blox Proprietary
  1651. * Mitsubishi Electric Corp Proprietary
  1652. * 4072.0 Reference station PVT (u-blox proprietary)
  1653. * 4072.1 Additional reference station information (u-blox proprietary)
  1654. */
  1655. unknown_name = "u-blox Proprietary";
  1656. break;
  1657. case 4073:
  1658. /* RTCM 3.x
  1659. * Unicore Communications Proprietary
  1660. */
  1661. unknown_name = "Alberding GmbH Proprietary";
  1662. break;
  1663. case 4075:
  1664. /* RTCM 3.x
  1665. * Alberding GmbH Proprietary
  1666. */
  1667. unknown_name = "Alberding GmbH Proprietary";
  1668. break;
  1669. case 4076:
  1670. /* RTCM 3.x
  1671. * International GNSS Service Proprietary
  1672. */
  1673. unknown_name = "International GNSS Service Proprietary";
  1674. break;
  1675. case 4077:
  1676. /* RTCM 3.x
  1677. * Hemisphere GNSS Proprietary
  1678. */
  1679. unknown_name = "Hemisphere GNSS Proprietary";
  1680. break;
  1681. case 4078:
  1682. /* RTCM 3.x
  1683. * ComNav Technology Proprietary
  1684. */
  1685. unknown_name = "ComNav Technology Proprietary";
  1686. break;
  1687. case 4079:
  1688. /* RTCM 3.x
  1689. * SubCarrier Systems Corp Proprietary
  1690. */
  1691. unknown_name = "SubCarrier Systems Corp Proprietary";
  1692. break;
  1693. case 4080:
  1694. /* RTCM 3.x
  1695. * NavCom Technology, Inc.
  1696. */
  1697. unknown_name = "NavCom Technology, Inc.";
  1698. break;
  1699. case 4081:
  1700. /* RTCM 3.x
  1701. * Seoul National Universtiry GNSS Lab Proprietary
  1702. */
  1703. unknown_name = "Seoul National Universtiry GNSS Lab Proprietery";
  1704. break;
  1705. case 4082:
  1706. /* RTCM 3.x
  1707. * Cooperative Research Centre for Spatial Information Proprietary
  1708. */
  1709. unknown_name = "Cooperative Research Centre for Spatial Information "
  1710. "Proprietary";
  1711. break;
  1712. case 4083:
  1713. /* RTCM 3.x
  1714. * German Aerospace Center Proprietary
  1715. */
  1716. unknown_name = "German Aerospace Center Proprietary";
  1717. break;
  1718. case 4084:
  1719. /* RTCM 3.x
  1720. * Geodetics Inc Proprietary
  1721. */
  1722. unknown_name = "Geodetics Inc Proprietary";
  1723. break;
  1724. case 4085:
  1725. /* RTCM 3.x
  1726. * European GNSS Supervisory Authority Proprietary
  1727. */
  1728. unknown_name = "European GNSS Supervisory Authority Proprietary";
  1729. break;
  1730. case 4086:
  1731. /* RTCM 3.x
  1732. * InPosition GmbH Proprietary
  1733. */
  1734. unknown_name = "InPosition GmbH Proprietary";
  1735. break;
  1736. case 4087:
  1737. /* RTCM 3.x
  1738. * Fugro Proprietary
  1739. */
  1740. unknown_name = "Fugro Proprietary";
  1741. break;
  1742. case 4088:
  1743. /* RTCM 3.x
  1744. * IfEN GmbH Proprietary
  1745. */
  1746. unknown_name = "IfEN GmbH Proprietary";
  1747. break;
  1748. case 4089:
  1749. /* RTCM 3.x
  1750. * Septentrio Satellite Navigation Proprietary
  1751. */
  1752. unknown_name = "Septentrio Satellite Navigation Proprietary";
  1753. break;
  1754. case 4090:
  1755. /* RTCM 3.x
  1756. * Geo++ Proprietary
  1757. */
  1758. unknown_name = "Geo++ Proprietary";
  1759. break;
  1760. case 4091:
  1761. /* RTCM 3.x
  1762. * Topcon Positioning Systems Proprietary
  1763. */
  1764. unknown_name = "Topcon Positioning Systems Proprietary";
  1765. break;
  1766. case 4092:
  1767. /* RTCM 3.x
  1768. * Leica Geosystems Proprietary
  1769. */
  1770. unknown_name = "Leica Geosystems Proprietary";
  1771. break;
  1772. case 4093:
  1773. /* RTCM 3.x
  1774. * NovAtel Proprietary
  1775. */
  1776. unknown_name = "NovAtel Pr.orietary";
  1777. break;
  1778. case 4094:
  1779. /* RTCM 3.x
  1780. * Trimble Proprietary
  1781. */
  1782. unknown_name = "Trimble Proprietary";
  1783. break;
  1784. case 4095:
  1785. /* RTCM 3.x
  1786. * Ashtech/Magellan Proprietary
  1787. */
  1788. unknown_name = "Ashtech/Magellan Proprietary";
  1789. break;
  1790. default:
  1791. break;
  1792. }
  1793. #undef RANGEDIFF
  1794. #undef GPS_PSEUDORANGE
  1795. #undef sgrab
  1796. #undef ugrab
  1797. if (unknown) {
  1798. /*
  1799. * Leader bytes, message length, and checksum won't be copied.
  1800. * The first 12 bits of the copied payload will be the type field.
  1801. */
  1802. memcpy(rtcm->rtcmtypes.data, buf + 3, rtcm->length);
  1803. if (NULL == unknown_name) {
  1804. GPSD_LOG(LOG_PROG, &context->errout,
  1805. "RTCM3: unknown type %d, length %d\n",
  1806. rtcm->type, rtcm->length);
  1807. } else {
  1808. GPSD_LOG(LOG_PROG, &context->errout,
  1809. "RTCM3: %s (type %d), length %d\n",
  1810. unknown_name, rtcm->type, rtcm->length);
  1811. }
  1812. }
  1813. }
  1814. // *INDENT-ON*
  1815. #endif // RTCM104V3_ENABLE
  1816. // vim: set expandtab shiftwidth=4