Coverage Report

Created: 2025-03-14 06:42

/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