/src/gpsd/gpsd-3.25.1~dev/libgps/rtcm3_json.c
Line | Count | Source |
1 | | /**************************************************************************** |
2 | | |
3 | | NAME |
4 | | rtcm3_json.c - deserialize RTCM3 JSON |
5 | | |
6 | | DESCRIPTION |
7 | | This module uses the generic JSON parser to get data from RTCM3 |
8 | | representations to libgps structures. |
9 | | |
10 | | PERMISSIONS |
11 | | This file is Copyright by the GPSD project |
12 | | SPDX-License-Identifier: BSD-2-clause |
13 | | |
14 | | ***************************************************************************/ |
15 | | |
16 | | #include "../include/gpsd_config.h" // must be before all includes |
17 | | |
18 | | #include <math.h> |
19 | | #include <stddef.h> |
20 | | #include <stdio.h> |
21 | | #include <string.h> |
22 | | |
23 | | #include "../include/gpsd.h" |
24 | | #include "../include/gps_json.h" |
25 | | |
26 | | int json_rtcm3_read(const char *buf, |
27 | | char *path, size_t pathlen, struct rtcm3_t *rtcm3, |
28 | | const char **endptr) |
29 | 137 | { |
30 | 137 | static char *stringptrs[NITEMS(rtcm3->rtcmtypes.data)]; |
31 | 137 | static char stringstore[sizeof(rtcm3->rtcmtypes.data) * 2]; |
32 | 137 | static int stringcount; |
33 | | |
34 | | // *INDENT-OFF* |
35 | 137 | #define RTCM3_HEADER \ |
36 | 1.37k | {"class", t_check, .dflt.check = "RTCM3"}, \ |
37 | 1.37k | {"type", t_uinteger, .addr.uinteger = &rtcm3->type}, \ |
38 | 1.37k | {"device", t_string, .addr.string = path, .len = pathlen}, \ |
39 | 1.37k | {"length", t_uinteger, .addr.uinteger = &rtcm3->length}, |
40 | | |
41 | 137 | int status = 0, satcount = 0; |
42 | | |
43 | 3.56k | #define RTCM3FIELD(type, fld) STRUCTOBJECT(struct rtcm3_ ## type ## _t, fld) |
44 | 137 | const struct json_attr_t rtcm1001_satellite[] = { |
45 | 137 | {"ident", t_uinteger, RTCM3FIELD(1001, ident)}, |
46 | 137 | {"ind", t_uinteger, RTCM3FIELD(1001, L1.indicator)}, |
47 | 137 | {"prange", t_real, RTCM3FIELD(1001, L1.pseudorange)}, |
48 | 137 | {"delta", t_real, RTCM3FIELD(1001, L1.rangediff)}, |
49 | 137 | {"lockt", t_uinteger, RTCM3FIELD(1001, L1.locktime)}, |
50 | 137 | {NULL}, |
51 | 137 | }; |
52 | | |
53 | 137 | const struct json_attr_t rtcm1002_satellite[] = { |
54 | 137 | {"ident", t_uinteger, RTCM3FIELD(1002, ident)}, |
55 | 137 | {"ind", t_uinteger, RTCM3FIELD(1002, L1.indicator)}, |
56 | 137 | {"prange", t_real, RTCM3FIELD(1002, L1.pseudorange)}, |
57 | 137 | {"delta", t_real, RTCM3FIELD(1002, L1.rangediff)}, |
58 | 137 | {"lockt", t_uinteger, RTCM3FIELD(1002, L1.locktime)}, |
59 | 137 | {"amb", t_uinteger, RTCM3FIELD(1002, L1.ambiguity)}, |
60 | 137 | {"CNR", t_real, RTCM3FIELD(1002, L1.CNR)}, |
61 | 137 | {NULL}, |
62 | 137 | }; |
63 | | |
64 | 137 | const struct json_attr_t rtcm1009_satellite[] = { |
65 | 137 | {"ident", t_uinteger, RTCM3FIELD(1009, ident)}, |
66 | 137 | {"ind", t_uinteger, RTCM3FIELD(1009, L1.indicator)}, |
67 | 137 | {"channel", t_uinteger, RTCM3FIELD(1009, L1.channel)}, |
68 | 137 | {"prange", t_real, RTCM3FIELD(1009, L1.pseudorange)}, |
69 | 137 | {"delta", t_real, RTCM3FIELD(1009, L1.rangediff)}, |
70 | 137 | {"lockt", t_uinteger, RTCM3FIELD(1009, L1.locktime)}, |
71 | 137 | {NULL}, |
72 | 137 | }; |
73 | | |
74 | 137 | const struct json_attr_t rtcm1010_satellite[] = { |
75 | 137 | {"ident", t_uinteger, RTCM3FIELD(1010, ident)}, |
76 | 137 | {"ind", t_uinteger, RTCM3FIELD(1010, L1.indicator)}, |
77 | 137 | {"channel", t_uinteger, RTCM3FIELD(1010, L1.channel)}, |
78 | 137 | {"prange", t_real, RTCM3FIELD(1010, L1.pseudorange)}, |
79 | 137 | {"delta", t_real, RTCM3FIELD(1010, L1.rangediff)}, |
80 | 137 | {"lockt", t_uinteger, RTCM3FIELD(1010, L1.locktime)}, |
81 | 137 | {"amb", t_uinteger, RTCM3FIELD(1010, L1.ambiguity)}, |
82 | 137 | {"CNR", t_real, RTCM3FIELD(1010, L1.CNR)}, |
83 | 137 | {NULL}, |
84 | 137 | }; |
85 | 137 | #undef RTCM3FIELD |
86 | | |
87 | 685 | #define R1001 &rtcm3->rtcmtypes.rtcm3_1001.header |
88 | 137 | const struct json_attr_t json_rtcm1001[] = { |
89 | 137 | RTCM3_HEADER |
90 | 137 | {"station_id", t_uinteger, .addr.uinteger = R1001.station_id}, |
91 | 137 | {"tow", t_uinteger, .addr.uinteger = (unsigned int *)R1001.tow}, |
92 | 137 | {"sync", t_boolean, .addr.boolean = R1001.sync}, |
93 | 137 | {"smoothing", t_boolean, .addr.boolean = R1001.smoothing}, |
94 | 137 | {"interval", t_uinteger, .addr.uinteger = R1001.interval}, |
95 | 137 | {"satellites", t_array, |
96 | 137 | STRUCTARRAY(rtcm3->rtcmtypes.rtcm3_1001.rtk_data, |
97 | 137 | rtcm1001_satellite, &satcount)}, |
98 | 137 | {NULL}, |
99 | 137 | }; |
100 | 137 | #undef R1001 |
101 | | |
102 | 685 | #define R1002 &rtcm3->rtcmtypes.rtcm3_1002.header |
103 | 137 | const struct json_attr_t json_rtcm1002[] = { |
104 | 137 | RTCM3_HEADER |
105 | 137 | {"station_id", t_uinteger, .addr.uinteger = R1002.station_id}, |
106 | 137 | {"tow", t_uinteger, .addr.uinteger = (unsigned int *)R1002.tow}, |
107 | 137 | {"sync", t_boolean, .addr.boolean = R1002.sync}, |
108 | 137 | {"smoothing", t_boolean, .addr.boolean = R1002.smoothing}, |
109 | 137 | {"interval", t_uinteger, .addr.uinteger = R1002.interval}, |
110 | 137 | {"satellites", t_array, |
111 | 137 | STRUCTARRAY(rtcm3->rtcmtypes.rtcm3_1002.rtk_data, |
112 | 137 | rtcm1002_satellite, &satcount)}, |
113 | 137 | {NULL}, |
114 | 137 | }; |
115 | 137 | #undef R1002 |
116 | | |
117 | 548 | #define R1007 rtcm3->rtcmtypes.rtcm3_1007 |
118 | 137 | const struct json_attr_t json_rtcm1007[] = { |
119 | 137 | RTCM3_HEADER |
120 | 137 | {"station_id", t_uinteger, .addr.uinteger = &R1007.station_id}, |
121 | 137 | {"desc", t_string, .addr.string = R1007.descriptor, |
122 | 137 | .len = sizeof(R1007.descriptor)}, |
123 | 137 | {"setup_id", t_uinteger, .addr.uinteger = &R1007.setup_id}, |
124 | 137 | {NULL}, |
125 | 137 | }; |
126 | 137 | #undef R1002 |
127 | | |
128 | 822 | #define R1008 rtcm3->rtcmtypes.rtcm3_1008 |
129 | 137 | const struct json_attr_t json_rtcm1008[] = { |
130 | 137 | RTCM3_HEADER |
131 | 137 | {"station_id", t_uinteger, .addr.uinteger = &R1008.station_id}, |
132 | 137 | {"desc", t_string, .addr.string = R1008.descriptor, |
133 | 137 | .len = sizeof(R1008.descriptor)}, |
134 | 137 | {"setup_id", t_uinteger, .addr.uinteger = &R1008.setup_id}, |
135 | 137 | {"serial", t_string, .addr.string = R1008.serial, |
136 | 137 | .len = sizeof(R1008.serial)}, |
137 | 137 | {NULL}, |
138 | 137 | }; |
139 | 137 | #undef R1008 |
140 | | |
141 | 685 | #define R1009 &rtcm3->rtcmtypes.rtcm3_1009.header |
142 | 137 | const struct json_attr_t json_rtcm1009[] = { |
143 | 137 | RTCM3_HEADER |
144 | 137 | {"station_id", t_uinteger, .addr.uinteger = R1009.station_id}, |
145 | 137 | {"tow", t_uinteger, .addr.uinteger = (unsigned int *)R1009.tow}, |
146 | 137 | {"sync", t_boolean, .addr.boolean = R1009.sync}, |
147 | 137 | {"smoothing", t_boolean, .addr.boolean = R1009.smoothing}, |
148 | 137 | {"interval", t_uinteger, .addr.uinteger = R1009.interval}, |
149 | 137 | {"satellites", t_array, |
150 | 137 | STRUCTARRAY(rtcm3->rtcmtypes.rtcm3_1009.rtk_data, |
151 | 137 | rtcm1009_satellite, &satcount)}, |
152 | 137 | {NULL}, |
153 | 137 | }; |
154 | 137 | #undef R1010 |
155 | | |
156 | 685 | #define R1010 &rtcm3->rtcmtypes.rtcm3_1010.header |
157 | 137 | const struct json_attr_t json_rtcm1010[] = { |
158 | 137 | RTCM3_HEADER |
159 | 137 | {"station_id", t_uinteger, .addr.uinteger = R1010.station_id}, |
160 | 137 | {"tow", t_uinteger, .addr.uinteger = (unsigned int *)R1010.tow}, |
161 | 137 | {"sync", t_boolean, .addr.boolean = R1010.sync}, |
162 | 137 | {"smoothing", t_boolean, .addr.boolean = R1010.smoothing}, |
163 | 137 | {"interval", t_uinteger, .addr.uinteger = R1010.interval}, |
164 | 137 | {"satellites", t_array, |
165 | 137 | STRUCTARRAY(rtcm3->rtcmtypes.rtcm3_1010.rtk_data, |
166 | 137 | rtcm1010_satellite, &satcount)}, |
167 | 137 | {NULL}, |
168 | 137 | }; |
169 | 137 | #undef R1010 |
170 | | |
171 | 1.09k | #define R1014 &rtcm3->rtcmtypes.rtcm3_1014 |
172 | 137 | const struct json_attr_t json_rtcm1014[] = { |
173 | 137 | RTCM3_HEADER |
174 | 137 | {"netid", t_uinteger, .addr.uinteger = R1014.network_id}, |
175 | 137 | {"subnetid", t_uinteger, .addr.uinteger = R1014.subnetwork_id}, |
176 | 137 | {"statcount", t_uinteger, .addr.uinteger = R1014.stationcount}, |
177 | 137 | {"master", t_uinteger, .addr.uinteger = R1014.master_id}, |
178 | 137 | {"aux", t_uinteger, .addr.uinteger = R1014.aux_id}, |
179 | 137 | {"lat", t_real, .addr.real = R1014.d_lat}, |
180 | 137 | {"lon", t_real, .addr.real = R1014.d_lon}, |
181 | 137 | {"alt", t_real, .addr.real = R1014.d_alt}, |
182 | 137 | {NULL}, |
183 | 137 | }; |
184 | 137 | #undef R1014 |
185 | | |
186 | 1.37k | #define R1033 rtcm3->rtcmtypes.rtcm3_1033 |
187 | 137 | const struct json_attr_t json_rtcm1033[] = { |
188 | 137 | RTCM3_HEADER |
189 | 137 | {"station_id", t_uinteger, .addr.uinteger = &R1033.station_id}, |
190 | 137 | {"desc", t_string, .addr.string = R1033.descriptor, |
191 | 137 | .len = sizeof(R1033.descriptor)}, |
192 | 137 | {"setup_id", t_uinteger, .addr.uinteger = &R1033.setup_id}, |
193 | 137 | {"serial", t_string, .addr.string = R1033.serial, |
194 | 137 | .len = sizeof(R1033.serial)}, |
195 | 137 | {"receiver", t_string, .addr.string = R1033.receiver, |
196 | 137 | .len = sizeof(R1033.receiver)}, |
197 | 137 | {"firmware", t_string, .addr.string = R1033.firmware, |
198 | 137 | .len = sizeof(R1033.firmware)}, |
199 | 137 | {NULL}, |
200 | 137 | }; |
201 | 137 | #undef R1033 |
202 | | |
203 | 959 | #define R1230 rtcm3->rtcmtypes.rtcm3_1230 |
204 | 137 | const struct json_attr_t json_rtcm1230[] = { |
205 | 137 | RTCM3_HEADER |
206 | 137 | {"station_id", t_uinteger, .addr.uinteger = &R1230.station_id}, |
207 | 137 | {"bi", t_ubyte, .addr.ubyte = &R1230.bias_indicator}, |
208 | 137 | {"sm", t_ubyte, .addr.ubyte = &R1230.signals_mask}, |
209 | 137 | {"l1ca", t_integer, .addr.integer = &R1230.l1_ca_bias, |
210 | 137 | .dflt.integer = 0}, |
211 | 137 | {"l1p", t_integer, .addr.integer = &R1230.l1_p_bias, |
212 | 137 | .dflt.integer = 0}, |
213 | 137 | {"l2ca", t_integer, .addr.integer = &R1230.l2_ca_bias, |
214 | 137 | .dflt.integer = 0}, |
215 | 137 | {"l2p", t_integer, .addr.integer = &R1230.l2_p_bias, |
216 | 137 | .dflt.integer = 0}, |
217 | 137 | {NULL}, |
218 | 137 | }; |
219 | 137 | #undef R1033 |
220 | | |
221 | 137 | const struct json_attr_t json_rtcm3_fallback[] = { |
222 | 137 | RTCM3_HEADER |
223 | 137 | {"data", t_array, .addr.array.element_type = t_string, |
224 | 137 | .addr.array.arr.strings.ptrs = stringptrs, |
225 | 137 | .addr.array.arr.strings.store = stringstore, |
226 | 137 | .addr.array.arr.strings.storelen = sizeof(stringstore), |
227 | 137 | .addr.array.count = &stringcount, |
228 | 137 | .addr.array.maxlen = NITEMS(stringptrs)}, |
229 | 137 | {NULL}, |
230 | 137 | }; |
231 | | |
232 | 137 | #undef RTCM3_HEADER |
233 | | // *INDENT-ON* |
234 | | |
235 | 137 | memset(rtcm3, '\0', sizeof(struct rtcm3_t)); |
236 | | |
237 | 137 | if (strstr(buf, "\"type\":1001,") != NULL) { |
238 | 5 | status = json_read_object(buf, json_rtcm1001, endptr); |
239 | 5 | if (status == 0) |
240 | 1 | rtcm3->rtcmtypes.rtcm3_1001.header.satcount = |
241 | 1 | (unsigned short)satcount; |
242 | 132 | } else if (strstr(buf, "\"type\":1002,") != NULL) { |
243 | 6 | status = json_read_object(buf, json_rtcm1002, endptr); |
244 | 6 | if (status == 0) |
245 | 1 | rtcm3->rtcmtypes.rtcm3_1002.header.satcount = |
246 | 1 | (unsigned short)satcount; |
247 | 126 | } else if (strstr(buf, "\"type\":1007,") != NULL) { |
248 | 1 | status = json_read_object(buf, json_rtcm1007, endptr); |
249 | 125 | } else if (strstr(buf, "\"type\":1008,") != NULL) { |
250 | 1 | status = json_read_object(buf, json_rtcm1008, endptr); |
251 | 124 | } else if (strstr(buf, "\"type\":1009,") != NULL) { |
252 | 1 | status = json_read_object(buf, json_rtcm1009, endptr); |
253 | 123 | } else if (strstr(buf, "\"type\":1010,") != NULL) { |
254 | 1 | status = json_read_object(buf, json_rtcm1010, endptr); |
255 | 122 | } else if (strstr(buf, "\"type\":1014,") != NULL) { |
256 | 1 | status = json_read_object(buf, json_rtcm1014, endptr); |
257 | 121 | } else if (strstr(buf, "\"type\":1033,") != NULL) { |
258 | 1 | status = json_read_object(buf, json_rtcm1033, endptr); |
259 | 120 | } else if (strstr(buf, "\"type\":1230,") != NULL) { |
260 | 22 | status = json_read_object(buf, json_rtcm1230, endptr); |
261 | 98 | } else { |
262 | 98 | int n; |
263 | 98 | status = json_read_object(buf, json_rtcm3_fallback, endptr); |
264 | 65.8k | for (n = 0; n < NITEMS(rtcm3->rtcmtypes.data); n++) { |
265 | 65.8k | if (n >= stringcount) { |
266 | 63.8k | rtcm3->rtcmtypes.data[n] = '\0'; |
267 | 63.8k | } else { |
268 | 1.91k | unsigned int u; |
269 | 1.91k | int fldcount = sscanf(stringptrs[n], "0x%02x\n", &u); |
270 | 1.91k | if (fldcount != 1) |
271 | 34 | return JSON_ERR_MISC; |
272 | 1.87k | else |
273 | 1.87k | rtcm3->rtcmtypes.data[n] = (char)u; |
274 | 1.91k | } |
275 | 65.8k | } |
276 | 98 | } |
277 | 103 | return status; |
278 | 137 | } |
279 | | |
280 | | // rtcm3_json.c ends here |
281 | | // vim: set expandtab shiftwidth=4 |