projects / project / uqmi.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
commands: make `struct blob_buf status` public
[project/uqmi.git] / commands-nas.c
1 /*
2 * uqmi -- tiny QMI support implementation
3 *
4 * Copyright (C) 2014-2015 Felix Fietkau <nbd@openwrt.org>
5 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the
18 * Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
19 * Boston, MA 02110-1301 USA.
20 */
21
22 #include "qmi-message.h"
23 #include "commands.h"
24
25 static struct qmi_nas_get_tx_rx_info_request tx_rx_req;
26 static struct qmi_nas_set_system_selection_preference_request sel_req;
27 static struct {
28 bool mcc_is_set;
29 bool mnc_is_set;
30 } plmn_code_flag;
31
32 static void
33 print_earfcn_info(uint32_t earfcn)
34 {
35 /* https://www.sqimway.com/lte_band.php */
36 static const struct {
37 uint32_t min;
38 uint32_t max;
39 uint16_t band;
40 uint16_t freq;
41 const char *duplex;
42 } earfcn_ranges[] = {
43 { 0, 599, 1, 2100, "FDD" },
44 { 600, 1199, 2, 1800, "FDD" },
45 { 1200, 1949, 3, 1800, "FDD" },
46 { 1950, 2399, 4, 1700, "FDD" },
47 { 2400, 2649, 5, 850, "FDD" },
48 { 2650, 2749, 6, 800, "FDD" },
49 { 2750, 3449, 7, 2600, "FDD" },
50 { 3450, 3799, 8, 900, "FDD" },
51 { 3800, 4149, 9, 1800, "FDD" },
52 { 4150, 4749, 10, 1700, "FDD" },
53 { 4750, 4999, 11, 1500, "FDD" },
54 { 5000, 5179, 12, 700, "FDD" },
55 { 5180, 5279, 13, 700, "FDD" },
56 { 5280, 5379, 14, 700, "FDD" },
57 { 5730, 5849, 17, 700, "FDD" },
58 { 5850, 5999, 18, 850, "FDD" },
59 { 6000, 6149, 19, 850, "FDD" },
60 { 6150, 6449, 20, 800, "FDD" },
61 { 6450, 6599, 21, 1500, "FDD" },
62 { 6600, 7399, 22, 3500, "FDD" },
63 { 7500, 7699, 23, 2000, "FDD" },
64 { 7700, 8039, 24, 1600, "FDD" },
65 { 8040, 8689, 25, 1900, "FDD" },
66 { 8690, 9039, 26, 850, "FDD" },
67 { 9040, 9209, 27, 800, "FDD" },
68 { 9210, 9659, 28, 700, "FDD" },
69 { 9660, 9769, 29, 700, "SDL" },
70 { 9770, 9869, 30, 2300, "FDD" },
71 { 9870, 9919, 31, 450, "FDD" },
72 { 9920, 10359, 32, 1500, "SDL" },
73 { 36000, 36199, 33, 1900, "TDD" },
74 { 36200, 36349, 34, 2000, "TDD" },
75 { 36350, 36949, 35, 1900, "TDD" },
76 { 36950, 37549, 36, 1900, "TDD" },
77 { 37550, 37749, 37, 1900, "TDD" },
78 { 37750, 38249, 38, 2600, "TDD" },
79 { 38250, 38649, 39, 1900, "TDD" },
80 { 38650, 39649, 40, 2300, "TDD" },
81 { 39650, 41589, 41, 2500, "TDD" },
82 { 41590, 43589, 42, 3500, "TDD" },
83 { 43590, 45589, 43, 3700, "TDD" },
84 { 45590, 46589, 44, 700, "TDD" },
85 };
86
87 for (int i = 0; i < (sizeof(earfcn_ranges) / sizeof(*earfcn_ranges)); i++) {
88 if (earfcn <= earfcn_ranges[i].max && earfcn >= earfcn_ranges[i].min) {
89 blobmsg_add_u32(&status, "band", earfcn_ranges[i].band);
90 blobmsg_add_u32(&status, "frequency", earfcn_ranges[i].freq);
91 blobmsg_add_string(&status, "duplex", earfcn_ranges[i].duplex);
92 return;
93 }
94 }
95 }
96
97 #define cmd_nas_do_set_system_selection_cb no_cb
98 static enum qmi_cmd_result
99 cmd_nas_do_set_system_selection_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
100 {
101 qmi_set_nas_set_system_selection_preference_request(msg, &sel_req);
102 return QMI_CMD_REQUEST;
103 }
104
105 static enum qmi_cmd_result
106 do_sel_network(void)
107 {
108 static bool use_sel_req = false;
109
110 if (!use_sel_req) {
111 use_sel_req = true;
112 uqmi_add_command(NULL, __UQMI_COMMAND_nas_do_set_system_selection);
113 }
114
115 return QMI_CMD_DONE;
116 }
117
118 #define cmd_nas_set_network_modes_cb no_cb
119 static enum qmi_cmd_result
120 cmd_nas_set_network_modes_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
121 {
122 static const struct {
123 const char *name;
124 QmiNasRatModePreference val;
125 } modes[] = {
126 { "cdma", QMI_NAS_RAT_MODE_PREFERENCE_CDMA_1X | QMI_NAS_RAT_MODE_PREFERENCE_CDMA_1XEVDO },
127 { "td-scdma", QMI_NAS_RAT_MODE_PREFERENCE_TD_SCDMA },
128 { "gsm", QMI_NAS_RAT_MODE_PREFERENCE_GSM },
129 { "umts", QMI_NAS_RAT_MODE_PREFERENCE_UMTS },
130 { "lte", QMI_NAS_RAT_MODE_PREFERENCE_LTE },
131 };
132 QmiNasRatModePreference val = 0;
133 char *word;
134 int i;
135
136 for (word = strtok(arg, ",");
137 word;
138 word = strtok(NULL, ",")) {
139 bool found = false;
140
141 for (i = 0; i < ARRAY_SIZE(modes); i++) {
142 if (strcmp(word, modes[i].name) != 0 &&
143 strcmp(word, "all") != 0)
144 continue;
145
146 val |= modes[i].val;
147 found = true;
148 }
149
150 if (!found) {
151 uqmi_add_error("Invalid network mode");
152 return QMI_CMD_EXIT;
153 }
154 }
155
156 qmi_set(&sel_req, mode_preference, val);
157 return do_sel_network();
158 }
159
160 #define cmd_nas_set_network_preference_cb no_cb
161 static enum qmi_cmd_result
162 cmd_nas_set_network_preference_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
163 {
164 QmiNasGsmWcdmaAcquisitionOrderPreference pref = QMI_NAS_GSM_WCDMA_ACQUISITION_ORDER_PREFERENCE_AUTOMATIC;
165
166 if (!strcmp(arg, "gsm"))
167 pref = QMI_NAS_GSM_WCDMA_ACQUISITION_ORDER_PREFERENCE_GSM;
168 else if (!strcmp(arg, "wcdma"))
169 pref = QMI_NAS_GSM_WCDMA_ACQUISITION_ORDER_PREFERENCE_WCDMA;
170
171 qmi_set(&sel_req, gsm_wcdma_acquisition_order_preference, pref);
172 return do_sel_network();
173 }
174
175 #define cmd_nas_set_roaming_cb no_cb
176 static enum qmi_cmd_result
177 cmd_nas_set_roaming_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
178 {
179 QmiNasRoamingPreference pref;
180
181 if (!strcmp(arg, "any"))
182 pref = QMI_NAS_ROAMING_PREFERENCE_ANY;
183 else if (!strcmp(arg, "only"))
184 pref = QMI_NAS_ROAMING_PREFERENCE_NOT_OFF;
185 else if (!strcmp(arg, "off"))
186 pref = QMI_NAS_ROAMING_PREFERENCE_OFF;
187 else
188 return uqmi_add_error("Invalid argument");
189
190 qmi_set(&sel_req, roaming_preference, pref);
191 return do_sel_network();
192 }
193
194 #define cmd_nas_set_mcc_cb no_cb
195 static enum qmi_cmd_result
196 cmd_nas_set_mcc_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
197 {
198 char *err;
199 int value = strtoul(arg, &err, 10);
200 if (err && *err) {
201 uqmi_add_error("Invalid MCC value");
202 return QMI_CMD_EXIT;
203 }
204
205 sel_req.data.network_selection_preference.mcc = value;
206 plmn_code_flag.mcc_is_set = true;
207 return QMI_CMD_DONE;
208 }
209
210 #define cmd_nas_set_mnc_cb no_cb
211 static enum qmi_cmd_result
212 cmd_nas_set_mnc_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
213 {
214 char *err;
215 int value = strtoul(arg, &err, 10);
216 if (err && *err) {
217 uqmi_add_error("Invalid MNC value");
218 return QMI_CMD_EXIT;
219 }
220
221 sel_req.data.network_selection_preference.mnc = value;
222 plmn_code_flag.mnc_is_set = true;
223 return QMI_CMD_DONE;
224 }
225
226 #define cmd_nas_set_plmn_cb no_cb
227 static enum qmi_cmd_result
228 cmd_nas_set_plmn_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
229 {
230 sel_req.set.network_selection_preference = 1;
231 sel_req.data.network_selection_preference.mode = QMI_NAS_NETWORK_SELECTION_PREFERENCE_AUTOMATIC;
232
233 if (!plmn_code_flag.mcc_is_set && plmn_code_flag.mnc_is_set) {
234 uqmi_add_error("No MCC value");
235 return QMI_CMD_EXIT;
236 }
237
238 if (plmn_code_flag.mcc_is_set && sel_req.data.network_selection_preference.mcc) {
239 if (!plmn_code_flag.mnc_is_set) {
240 uqmi_add_error("No MNC value");
241 return QMI_CMD_EXIT;
242 } else {
243 sel_req.data.network_selection_preference.mode = QMI_NAS_NETWORK_SELECTION_PREFERENCE_MANUAL;
244 }
245 }
246
247 return do_sel_network();
248 }
249
250 #define cmd_nas_initiate_network_register_cb no_cb
251 static enum qmi_cmd_result
252 cmd_nas_initiate_network_register_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
253 {
254 static struct qmi_nas_initiate_network_register_request register_req = {
255 QMI_INIT(action, QMI_NAS_NETWORK_REGISTER_TYPE_AUTOMATIC)
256 };
257
258 qmi_set_nas_initiate_network_register_request(msg, &register_req);
259 return QMI_CMD_REQUEST;
260 }
261
262 static void
263 cmd_nas_get_signal_info_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
264 {
265 struct qmi_nas_get_signal_info_response res;
266 void *c;
267
268 qmi_parse_nas_get_signal_info_response(msg, &res);
269
270 c = blobmsg_open_table(&status, NULL);
271 if (res.set.cdma_signal_strength) {
272 blobmsg_add_string(&status, "type", "cdma");
273 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.cdma_signal_strength.rssi);
274 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.cdma_signal_strength.ecio);
275 }
276
277 if (res.set.hdr_signal_strength) {
278 blobmsg_add_string(&status, "type", "hdr");
279 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.hdr_signal_strength.rssi);
280 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.hdr_signal_strength.ecio);
281 blobmsg_add_u32(&status, "io", res.data.hdr_signal_strength.io);
282 }
283
284 if (res.set.gsm_signal_strength) {
285 blobmsg_add_string(&status, "type", "gsm");
286 blobmsg_add_u32(&status, "signal", (int32_t) res.data.gsm_signal_strength);
287 }
288
289 if (res.set.wcdma_signal_strength) {
290 blobmsg_add_string(&status, "type", "wcdma");
291 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.wcdma_signal_strength.rssi);
292 blobmsg_add_u32(&status, "ecio", (int32_t) res.data.wcdma_signal_strength.ecio);
293 }
294
295 if (res.set.lte_signal_strength) {
296 blobmsg_add_string(&status, "type", "lte");
297 blobmsg_add_u32(&status, "rssi", (int32_t) res.data.lte_signal_strength.rssi);
298 blobmsg_add_u32(&status, "rsrq", (int32_t) res.data.lte_signal_strength.rsrq);
299 blobmsg_add_u32(&status, "rsrp", (int32_t) res.data.lte_signal_strength.rsrp);
300 blobmsg_add_double(&status, "snr", (double) res.data.lte_signal_strength.snr*0.1);
301 }
302
303 if (res.set.tdma_signal_strength) {
304 blobmsg_add_string(&status, "type", "tdma");
305 blobmsg_add_u32(&status, "signal", (int32_t) res.data.tdma_signal_strength);
306 }
307
308 blobmsg_close_table(&status, c);
309 }
310
311 static void
312 print_system_info(uint8_t svc_status, uint8_t tsvc_status, bool preferred, bool system_info,
313 bool domain_valid, uint8_t domain,
314 bool service_cap_valid, uint8_t service_cap,
315 bool roaming_status_valid, uint8_t roaming_status,
316 bool forbidden_valid, bool forbidden,
317 bool network_id_valid, char *mcc, char *mnc,
318 bool lac_valid, uint16_t lac)
319 {
320 static const char *map_service[] = {
321 [QMI_NAS_SERVICE_STATUS_NONE] = "none",
322 [QMI_NAS_SERVICE_STATUS_LIMITED] = "limited",
323 [QMI_NAS_SERVICE_STATUS_AVAILABLE] = "available",
324 [QMI_NAS_SERVICE_STATUS_LIMITED_REGIONAL] = "limited regional",
325 [QMI_NAS_SERVICE_STATUS_POWER_SAVE] = "power save",
326 };
327
328 static const char *map_roaming[] = {
329 [QMI_NAS_ROAMING_STATUS_OFF] = "off",
330 [QMI_NAS_ROAMING_STATUS_ON] = "on",
331 [QMI_NAS_ROAMING_STATUS_BLINK] = "blink",
332 [QMI_NAS_ROAMING_STATUS_OUT_OF_NEIGHBORHOOD] = "out of neighborhood",
333 [QMI_NAS_ROAMING_STATUS_OUT_OF_BUILDING] = "out of building",
334 [QMI_NAS_ROAMING_STATUS_PREFERRED_SYSTEM] = "preferred system",
335 [QMI_NAS_ROAMING_STATUS_AVAILABLE_SYSTEM] = "available system",
336 [QMI_NAS_ROAMING_STATUS_ALLIANCE_PARTNER] = "alliance partner",
337 [QMI_NAS_ROAMING_STATUS_PREMIUM_PARTNER] = "premium partner",
338 [QMI_NAS_ROAMING_STATUS_FULL_SERVICE] = "full service",
339 [QMI_NAS_ROAMING_STATUS_PARTIAL_SERVICE] = "partial service",
340 [QMI_NAS_ROAMING_STATUS_BANNER_ON] = "banner on",
341 [QMI_NAS_ROAMING_STATUS_BANNER_OFF] = "banner off",
342 };
343
344 static const char *map_network[] = {
345 [QMI_NAS_NETWORK_SERVICE_DOMAIN_NONE] = "none",
346 [QMI_NAS_NETWORK_SERVICE_DOMAIN_CS] = "cs",
347 [QMI_NAS_NETWORK_SERVICE_DOMAIN_PS] = "ps",
348 [QMI_NAS_NETWORK_SERVICE_DOMAIN_CS_PS] = "cs-ps",
349 [QMI_NAS_NETWORK_SERVICE_DOMAIN_UNKNOWN] = "unknown",
350 };
351
352 blobmsg_add_string(&status, "service_status", map_service[svc_status]);
353 blobmsg_add_string(&status, "true_service_status", map_service[tsvc_status]);
354 blobmsg_add_u8(&status, "preferred_data_path", preferred);
355
356 if (system_info) {
357 if (domain_valid)
358 blobmsg_add_string(&status, "domain", map_network[domain]);
359 if (service_cap_valid)
360 blobmsg_add_string(&status, "service", map_network[service_cap]);
361 if (roaming_status_valid)
362 blobmsg_add_string(&status, "roaming_status", map_roaming[roaming_status]);
363 if (forbidden_valid)
364 blobmsg_add_u8(&status, "forbidden", forbidden);
365 if (network_id_valid) {
366 blobmsg_add_string(&status, "mcc", mcc);
367 if ((uint8_t)mnc[2] == 255)
368 mnc[2] = 0;
369 blobmsg_add_string(&status, "mnc", mnc);
370 }
371 if (lac_valid)
372 blobmsg_add_u32(&status, "location_area_code", (int32_t) lac);
373 }
374 }
375
376 static void
377 cmd_nas_get_system_info_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
378 {
379 static const char *cell_status[] = {
380 [QMI_NAS_CELL_ACCESS_STATUS_NORMAL_ONLY] = "normal",
381 [QMI_NAS_CELL_ACCESS_STATUS_EMERGENCY_ONLY] = "emergency",
382 [QMI_NAS_CELL_ACCESS_STATUS_NO_CALLS] = "no calls",
383 [QMI_NAS_CELL_ACCESS_STATUS_ALL_CALLS] = "all calls",
384 [QMI_NAS_CELL_ACCESS_STATUS_UNKNOWN] = "unknown",
385 };
386
387 struct qmi_nas_get_system_info_response res;
388 void *c, *t;
389
390 qmi_parse_nas_get_system_info_response(msg, &res);
391 t = blobmsg_open_table(&status, NULL);
392 if (res.set.gsm_service_status) {
393 c = blobmsg_open_table(&status, "gsm");
394 print_system_info(res.data.gsm_service_status.service_status,
395 res.data.gsm_service_status.true_service_status,
396 res.data.gsm_service_status.preferred_data_path,
397 res.set.gsm_system_info_v2,
398 res.data.gsm_system_info_v2.domain_valid,
399 res.data.gsm_system_info_v2.domain,
400 res.data.gsm_system_info_v2.service_capability_valid,
401 res.data.gsm_system_info_v2.service_capability,
402 res.data.gsm_system_info_v2.roaming_status_valid,
403 res.data.gsm_system_info_v2.roaming_status,
404 res.data.gsm_system_info_v2.forbidden_valid,
405 res.data.gsm_system_info_v2.forbidden,
406 res.data.gsm_system_info_v2.network_id_valid,
407 res.data.gsm_system_info_v2.mcc,
408 res.data.gsm_system_info_v2.mnc,
409 res.data.gsm_system_info_v2.lac_valid,
410 res.data.gsm_system_info_v2.lac);
411 if (res.set.gsm_system_info_v2 && res.data.gsm_system_info_v2.cid_valid)
412 blobmsg_add_u32(&status, "cell_id",
413 res.data.gsm_system_info_v2.cid);
414 if (res.set.additional_gsm_system_info &&
415 res.data.additional_gsm_system_info.geo_system_index != 0xFFFF)
416 blobmsg_add_u32(&status, "geo_system_index",
417 res.data.additional_gsm_system_info.geo_system_index);
418 blobmsg_close_table(&status, c);
419 }
420
421 if (res.set.wcdma_service_status) {
422 c = blobmsg_open_table(&status, "wcdma");
423 print_system_info(res.data.wcdma_service_status.service_status,
424 res.data.wcdma_service_status.true_service_status,
425 res.data.wcdma_service_status.preferred_data_path,
426 res.set.wcdma_system_info_v2,
427 res.data.wcdma_system_info_v2.domain_valid,
428 res.data.wcdma_system_info_v2.domain,
429 res.data.wcdma_system_info_v2.service_capability_valid,
430 res.data.wcdma_system_info_v2.service_capability,
431 res.data.wcdma_system_info_v2.roaming_status_valid,
432 res.data.wcdma_system_info_v2.roaming_status,
433 res.data.wcdma_system_info_v2.forbidden_valid,
434 res.data.wcdma_system_info_v2.forbidden,
435 res.data.wcdma_system_info_v2.network_id_valid,
436 res.data.wcdma_system_info_v2.mcc,
437 res.data.wcdma_system_info_v2.mnc,
438 res.data.wcdma_system_info_v2.lac_valid,
439 res.data.wcdma_system_info_v2.lac);
440 if (res.set.wcdma_system_info_v2 && res.data.wcdma_system_info_v2.cid_valid) {
441 blobmsg_add_u32(&status, "rnc_id",res.data.wcdma_system_info_v2.cid/65536);
442 blobmsg_add_u32(&status, "cell_id",res.data.wcdma_system_info_v2.cid%65536);
443 }
444 if (res.set.additional_wcdma_system_info &&
445 res.data.additional_wcdma_system_info.geo_system_index != 0xFFFF)
446 blobmsg_add_u32(&status, "geo_system_index",
447 res.data.additional_wcdma_system_info.geo_system_index);
448 blobmsg_close_table(&status, c);
449 }
450
451 if (res.set.lte_service_status) {
452 c = blobmsg_open_table(&status, "lte");
453 print_system_info(res.data.lte_service_status.service_status,
454 res.data.lte_service_status.true_service_status,
455 res.data.lte_service_status.preferred_data_path,
456 res.set.lte_system_info_v2,
457 res.data.lte_system_info_v2.domain_valid,
458 res.data.lte_system_info_v2.domain,
459 res.data.lte_system_info_v2.service_capability_valid,
460 res.data.lte_system_info_v2.service_capability,
461 res.data.lte_system_info_v2.roaming_status_valid,
462 res.data.lte_system_info_v2.roaming_status,
463 res.data.lte_system_info_v2.forbidden_valid,
464 res.data.lte_system_info_v2.forbidden,
465 res.data.lte_system_info_v2.network_id_valid,
466 res.data.lte_system_info_v2.mcc,
467 res.data.lte_system_info_v2.mnc,
468 res.data.lte_system_info_v2.lac_valid,
469 res.data.lte_system_info_v2.lac);
470 if (res.set.lte_system_info_v2 && res.data.lte_system_info_v2.tac_valid)
471 blobmsg_add_u32(&status, "tracking_area_code",
472 res.data.lte_system_info_v2.tac);
473 if (res.set.lte_system_info_v2 && res.data.lte_system_info_v2.cid_valid) {
474 blobmsg_add_u32(&status, "enodeb_id",res.data.lte_system_info_v2.cid/256);
475 blobmsg_add_u32(&status, "cell_id",res.data.lte_system_info_v2.cid%256);
476 }
477 if (res.set.additional_lte_system_info &&
478 res.data.additional_lte_system_info.geo_system_index != 0xFFFF)
479 blobmsg_add_u32(&status, "geo_system_index",
480 res.data.additional_lte_system_info.geo_system_index);
481 if (res.set.lte_voice_support)
482 blobmsg_add_u8(&status, "voice_support", res.data.lte_voice_support);
483 if (res.set.ims_voice_support)
484 blobmsg_add_u8(&status, "ims_voice_support", res.data.ims_voice_support);
485 if (res.set.lte_cell_access_status)
486 blobmsg_add_string(&status, "cell_access_status",
487 cell_status[res.data.lte_cell_access_status]);
488 if (res.set.network_selection_registration_restriction)
489 blobmsg_add_u32(&status, "registration_restriction",
490 res.data.network_selection_registration_restriction);
491 if (res.set.lte_registration_domain)
492 blobmsg_add_u32(&status, "registration_domain",
493 res.data.lte_registration_domain);
494 if (res.set.eutra_with_nr5g_availability)
495 blobmsg_add_u8(&status, "5g_nsa_available",
496 res.data.eutra_with_nr5g_availability);
497 if (res.set.dcnr_restriction_info)
498 blobmsg_add_u8(&status, "dcnr_restriction", res.data.dcnr_restriction_info);
499
500 blobmsg_close_table(&status, c);
501 }
502 blobmsg_close_table(&status, t);
503 }
504
505 static enum qmi_cmd_result
506 cmd_nas_get_system_info_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
507 {
508 qmi_set_nas_get_system_info_request(msg);
509 return QMI_CMD_REQUEST;
510 }
511
512 static void
513 print_channel_info(int32_t cell_id, int32_t channel, uint32_t bw)
514 {
515 static const char *map_bandwidth[] = {
516 [QMI_NAS_DL_BANDWIDTH_1_4] = "1.4",
517 [QMI_NAS_DL_BANDWIDTH_3] = "3",
518 [QMI_NAS_DL_BANDWIDTH_5] = "5",
519 [QMI_NAS_DL_BANDWIDTH_10] = "10",
520 [QMI_NAS_DL_BANDWIDTH_15] = "15",
521 [QMI_NAS_DL_BANDWIDTH_20] = "20",
522 [QMI_NAS_DL_BANDWIDTH_INVALID] = "invalid",
523 [QMI_NAS_DL_BANDWIDTH_UNKNOWN] = "unknown",
524 };
525
526 blobmsg_add_u32(&status, "cell_id", cell_id);
527 blobmsg_add_u32(&status, "channel", channel);
528 print_earfcn_info(channel);
529 blobmsg_add_string(&status, "bandwidth", map_bandwidth[bw]);
530 }
531
532 static void
533 cmd_nas_get_lte_cphy_ca_info_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
534 {
535 struct qmi_nas_get_lte_cphy_ca_info_response res;
536 static const char *scell_state[] = {
537 [QMI_NAS_SCELL_STATE_DECONFIGURED] = "deconfigured",
538 [QMI_NAS_SCELL_STATE_DEACTIVATED] = "deactivated",
539 [QMI_NAS_SCELL_STATE_ACTIVATED] = "activated",
540 };
541 char idx_buf[16];
542 void *t, *c;
543 int i;
544
545 qmi_parse_nas_get_lte_cphy_ca_info_response(msg, &res);
546 t = blobmsg_open_table(&status, NULL);
547 if (res.set.phy_ca_agg_pcell_info) {
548 c = blobmsg_open_table(&status, "primary");
549 print_channel_info(res.data.phy_ca_agg_pcell_info.physical_cell_id,
550 res.data.phy_ca_agg_pcell_info.rx_channel,
551 res.data.phy_ca_agg_pcell_info.dl_bandwidth);
552 blobmsg_close_table(&status, c);
553 }
554 if (res.set.phy_ca_agg_scell_info && res.data.phy_ca_agg_secondary_cells_n) {
555 for (i = 0; i < res.data.phy_ca_agg_secondary_cells_n; i++) {
556 if (res.data.phy_ca_agg_secondary_cells[i].rx_channel == 0)
557 break;
558 sprintf(idx_buf, "secondary_%d",
559 res.data.phy_ca_agg_secondary_cells[i].cell_index);
560 c = blobmsg_open_table(&status, idx_buf);
561 print_channel_info(res.data.phy_ca_agg_secondary_cells[i].physical_cell_id,
562 res.data.phy_ca_agg_secondary_cells[i].rx_channel,
563 res.data.phy_ca_agg_secondary_cells[i].dl_bandwidth);
564 blobmsg_add_string(&status, "state",
565 scell_state[res.data.phy_ca_agg_secondary_cells[i].state]);
566 blobmsg_close_table(&status, c);
567 }
568 } else {
569 if (res.set.scell_index)
570 sprintf(idx_buf, "secondary_%d", res.data.scell_index);
571 else
572 sprintf(idx_buf, "secondary");
573 if (res.set.phy_ca_agg_scell_info && res.data.phy_ca_agg_scell_info.rx_channel != 0) {
574 c = blobmsg_open_table(&status, idx_buf);
575 print_channel_info(res.data.phy_ca_agg_scell_info.physical_cell_id,
576 res.data.phy_ca_agg_scell_info.rx_channel,
577 res.data.phy_ca_agg_scell_info.dl_bandwidth);
578 blobmsg_add_string(&status, "state",
579 scell_state[res.data.phy_ca_agg_scell_info.state]);
580 blobmsg_close_table(&status, c);
581 }
582 }
583 blobmsg_close_table(&status, t);
584 }
585
586 static enum qmi_cmd_result
587 cmd_nas_get_lte_cphy_ca_info_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
588 {
589 qmi_set_nas_get_lte_cphy_ca_info_request(msg);
590 return QMI_CMD_REQUEST;
591 }
592
593 static void
594 print_chain_info(int8_t radio, bool tuned, int32_t rssi, int32_t ecio, int32_t rsrp, int32_t rscp, uint32_t phase)
595 {
596 blobmsg_add_u8(&status, "tuned", tuned);
597 blobmsg_add_double(&status, "rssi", (double) rssi*0.1);
598 if (radio == QMI_NAS_RADIO_INTERFACE_LTE) {
599 blobmsg_add_double(&status, "rsrq", (double) ecio*-0.1);
600 blobmsg_add_double(&status, "rsrp", (double) rsrp*-0.1);
601 }
602 if (radio == QMI_NAS_RADIO_INTERFACE_UMTS) {
603 blobmsg_add_double(&status, "ecio", (double) ecio*-0.1);
604 blobmsg_add_double(&status, "rscp", (double) rscp*-0.1);
605 }
606 if (phase != 0xFFFFFFFF)
607 blobmsg_add_double(&status, "phase", (double) phase*0.01);
608 }
609
610 static void
611 cmd_nas_get_tx_rx_info_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
612 {
613 struct qmi_nas_get_tx_rx_info_response res;
614 void *c, *t;
615
616 qmi_parse_nas_get_tx_rx_info_response(msg, &res);
617 t = blobmsg_open_table(&status, NULL);
618 if (res.set.rx_chain_0_info) {
619 c = blobmsg_open_table(&status, "rx_chain_0");
620 print_chain_info(tx_rx_req.data.radio_interface,
621 res.data.rx_chain_0_info.is_radio_tuned,
622 res.data.rx_chain_0_info.rx_power,
623 res.data.rx_chain_0_info.ecio,
624 res.data.rx_chain_0_info.rsrp,
625 res.data.rx_chain_0_info.rscp,
626 res.data.rx_chain_0_info.phase);
627 blobmsg_close_table(&status, c);
628 }
629 if (res.set.rx_chain_1_info) {
630 c = blobmsg_open_table(&status, "rx_chain_1");
631 print_chain_info(tx_rx_req.data.radio_interface,
632 res.data.rx_chain_1_info.is_radio_tuned,
633 res.data.rx_chain_1_info.rx_power,
634 res.data.rx_chain_1_info.ecio,
635 res.data.rx_chain_1_info.rsrp,
636 res.data.rx_chain_1_info.rscp,
637 res.data.rx_chain_1_info.phase);
638 blobmsg_close_table(&status, c);
639 }
640 if (res.set.rx_chain_2_info) {
641 c = blobmsg_open_table(&status, "rx_chain_2");
642 print_chain_info(tx_rx_req.data.radio_interface,
643 res.data.rx_chain_2_info.is_radio_tuned,
644 res.data.rx_chain_2_info.rx_power,
645 res.data.rx_chain_2_info.ecio,
646 res.data.rx_chain_2_info.rsrp,
647 res.data.rx_chain_2_info.rscp,
648 res.data.rx_chain_2_info.phase);
649 blobmsg_close_table(&status, c);
650 }
651 if (res.set.rx_chain_3_info) {
652 c = blobmsg_open_table(&status, "rx_chain_3");
653 print_chain_info(tx_rx_req.data.radio_interface,
654 res.data.rx_chain_3_info.is_radio_tuned,
655 res.data.rx_chain_3_info.rx_power,
656 res.data.rx_chain_3_info.ecio,
657 res.data.rx_chain_3_info.rsrp,
658 res.data.rx_chain_3_info.rscp,
659 res.data.rx_chain_3_info.phase);
660 blobmsg_close_table(&status, c);
661 }
662 if (res.set.tx_info) {
663 c = blobmsg_open_table(&status, "tx");
664 blobmsg_add_u8(&status, "traffic", res.data.tx_info.is_in_traffic);
665 if (res.data.tx_info.is_in_traffic)
666 blobmsg_add_double(&status, "tx_power",
667 (double) res.data.tx_info.tx_power*0.1);
668 blobmsg_close_table(&status, c);
669 }
670 blobmsg_close_table(&status, t);
671 }
672
673
674 static enum qmi_cmd_result
675 cmd_nas_get_tx_rx_info_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
676 {
677 int radio = 0;
678
679 if (!strcmp(arg, "lte"))
680 radio = QMI_NAS_RADIO_INTERFACE_LTE;
681 else if (!strcmp(arg, "umts"))
682 radio = QMI_NAS_RADIO_INTERFACE_UMTS;
683 else if (!strcmp(arg, "gsm"))
684 radio = QMI_NAS_RADIO_INTERFACE_GSM;
685 else
686 return uqmi_add_error("Invalid argument");
687
688 qmi_set(&tx_rx_req, radio_interface, radio);
689 qmi_set_nas_get_tx_rx_info_request(msg, &tx_rx_req);
690 return QMI_CMD_REQUEST;
691 }
692
693 static void
694 print_lte_info(int32_t cell_id, int16_t rsrp, int16_t rsrq, int16_t rssi)
695 {
696 blobmsg_add_u32(&status, "physical_cell_id", cell_id);
697 blobmsg_add_double(&status, "rsrq", ((double)rsrq)/10);
698 blobmsg_add_double(&status, "rsrp", ((double)rsrp)/10);
699 blobmsg_add_double(&status, "rssi", ((double)rssi)/10);
700 }
701
702 static void
703 print_sel_info(int32_t priority, int32_t high, int32_t low)
704 {
705 blobmsg_add_u32(&status, "cell_reselection_priority", priority);
706 blobmsg_add_u32(&status, "cell_reselection_low", low);
707 blobmsg_add_u32(&status, "cell_reselection_high", high);
708 }
709
710 static void
711 cmd_nas_get_cell_location_info_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
712 {
713 struct qmi_nas_get_cell_location_info_response res;
714 void *c = NULL, *t, *cell, *freq;
715 int i, j;
716
717 qmi_parse_nas_get_cell_location_info_response(msg, &res);
718 t = blobmsg_open_table(&status, NULL);
719
720 if (res.set.umts_info_v2) {
721 c = blobmsg_open_table(&status, "umts_info");
722 blobmsg_add_u32(&status, "location_area_code", res.data.umts_info_v2.lac);
723 blobmsg_add_u32(&status, "cell_id", res.data.umts_info_v2.cell_id);
724 blobmsg_add_u32(&status, "channel",
725 res.data.umts_info_v2.utra_absolute_rf_channel_number);
726 blobmsg_add_u32(&status, "primary_scrambling_code",
727 res.data.umts_info_v2.primary_scrambling_code);
728 blobmsg_add_u32(&status, "rscp", res.data.umts_info_v2.rscp);
729 blobmsg_add_u32(&status, "ecio", res.data.umts_info_v2.ecio);
730 for (j = 0; j < res.data.umts_info_v2.cell_n; j++) {
731 cell = blobmsg_open_table(&status, NULL);
732 blobmsg_add_u32(&status, "channel",
733 res.data.umts_info_v2.cell[j].utra_absolute_rf_channel_number);
734 blobmsg_add_u32(&status, "primary_scrambling_code",
735 res.data.umts_info_v2.cell[j].primary_scrambling_code);
736 blobmsg_add_u32(&status, "rscp", res.data.umts_info_v2.cell[j].rscp);
737 blobmsg_add_u32(&status, "ecio", res.data.umts_info_v2.cell[j].ecio);
738 blobmsg_close_table(&status, cell);
739 }
740 for (j = 0; j < res.data.umts_info_v2.neighboring_geran_n; j++) {
741 cell = blobmsg_open_table(&status, "neighboring_geran");
742 blobmsg_add_u32(&status, "channel",
743 res.data.umts_info_v2.neighboring_geran[j].geran_absolute_rf_channel_number);
744 blobmsg_add_u8(&status, "network_color_code",
745 res.data.umts_info_v2.neighboring_geran[j].network_color_code);
746 blobmsg_add_u8(&status, "base_station_color_code",
747 res.data.umts_info_v2.neighboring_geran[j].base_station_color_code);
748 blobmsg_add_u32(&status, "rssi",
749 res.data.umts_info_v2.neighboring_geran[j].rssi);
750 blobmsg_close_table(&status, cell);
751 }
752 blobmsg_close_table(&status, c);
753 }
754 if (res.set.intrafrequency_lte_info_v2) {
755 c = blobmsg_open_table(&status, "intrafrequency_lte_info");
756 blobmsg_add_u32(&status, "tracking_area_code",
757 res.data.intrafrequency_lte_info_v2.tracking_area_code);
758 blobmsg_add_u32(&status, "enodeb_id",
759 res.data.intrafrequency_lte_info_v2.global_cell_id/256);
760 blobmsg_add_u32(&status, "cell_id",
761 res.data.intrafrequency_lte_info_v2.global_cell_id%256);
762 blobmsg_add_u32(&status, "channel",
763 res.data.intrafrequency_lte_info_v2.eutra_absolute_rf_channel_number);
764 print_earfcn_info(res.data.intrafrequency_lte_info_v2.eutra_absolute_rf_channel_number);
765 blobmsg_add_u32(&status, "serving_cell_id",
766 res.data.intrafrequency_lte_info_v2.serving_cell_id);
767 if (res.data.intrafrequency_lte_info_v2.ue_in_idle) {
768 blobmsg_add_u32(&status, "cell_reselection_priority",
769 res.data.intrafrequency_lte_info_v2.cell_reselection_priority);
770 blobmsg_add_u32(&status, "s_non_intra_search_threshold",
771 res.data.intrafrequency_lte_info_v2.s_non_intra_search_threshold);
772 blobmsg_add_u32(&status, "serving_cell_low_threshold",
773 res.data.intrafrequency_lte_info_v2.serving_cell_low_threshold);
774 blobmsg_add_u32(&status, "s_intra_search_threshold",
775 res.data.intrafrequency_lte_info_v2.s_intra_search_threshold);
776 }
777 for (i = 0; i < res.data.intrafrequency_lte_info_v2.cell_n; i++) {
778 cell = blobmsg_open_table(&status, NULL);
779 print_lte_info(res.data.intrafrequency_lte_info_v2.cell[i].physical_cell_id,
780 res.data.intrafrequency_lte_info_v2.cell[i].rsrq,
781 res.data.intrafrequency_lte_info_v2.cell[i].rsrp,
782 res.data.intrafrequency_lte_info_v2.cell[i].rssi);
783 if (res.data.intrafrequency_lte_info_v2.ue_in_idle)
784 blobmsg_add_u32(&status, "cell_selection_rx_level",
785 res.data.intrafrequency_lte_info_v2.cell[i].cell_selection_rx_level);
786 blobmsg_close_table(&status, cell);
787 }
788 blobmsg_close_table(&status, c);
789 }
790 if (res.set.interfrequency_lte_info) {
791 if (res.data.interfrequency_lte_info.frequency_n > 0)
792 c = blobmsg_open_table(&status, "interfrequency_lte_info");
793 for (i = 0; i < res.data.interfrequency_lte_info.frequency_n; i++) {
794 freq = blobmsg_open_table(&status, NULL);
795 blobmsg_add_u32(&status, "channel",
796 res.data.interfrequency_lte_info.frequency[i].eutra_absolute_rf_channel_number);
797 print_earfcn_info(res.data.interfrequency_lte_info.frequency[i].eutra_absolute_rf_channel_number);
798 if (res.data.interfrequency_lte_info.ue_in_idle) {
799 print_sel_info(res.data.interfrequency_lte_info.frequency[i].cell_reselection_priority,
800 res.data.interfrequency_lte_info.frequency[i].cell_selection_rx_level_high_threshold,
801 res.data.interfrequency_lte_info.frequency[i].cell_selection_rx_level_low_threshold);
802 }
803 for (j = 0; j < res.data.interfrequency_lte_info.frequency[i].cell_n; j++) {
804 cell = blobmsg_open_table(&status, NULL);
805 print_lte_info(res.data.interfrequency_lte_info.frequency[i].cell[j].physical_cell_id,
806 res.data.interfrequency_lte_info.frequency[i].cell[j].rsrq,
807 res.data.interfrequency_lte_info.frequency[i].cell[j].rsrp,
808 res.data.interfrequency_lte_info.frequency[i].cell[j].rssi);
809 if (res.data.interfrequency_lte_info.ue_in_idle)
810 blobmsg_add_u32(&status, "cell_selection_rx_level",
811 res.data.interfrequency_lte_info.frequency[i].cell[j].cell_selection_rx_level);
812 blobmsg_close_table(&status, cell);
813 }
814 blobmsg_close_table(&status, freq);
815 }
816 if (res.data.interfrequency_lte_info.frequency_n > 0)
817 blobmsg_close_table(&status, c);
818 }
819 if (res.set.lte_info_neighboring_gsm) {
820 if (res.data.lte_info_neighboring_gsm.frequency_n > 0)
821 c = blobmsg_open_table(&status, "lte_info_neighboring_gsm");
822 for (i = 0; i < res.data.lte_info_neighboring_gsm.frequency_n; i++) {
823 freq = blobmsg_open_table(&status, NULL);
824 blobmsg_add_u32(&status, "ncc_permitted",
825 res.data.lte_info_neighboring_gsm.frequency[i].ncc_permitted);
826 if (res.data.lte_info_neighboring_gsm.ue_in_idle) {
827 print_sel_info(res.data.lte_info_neighboring_gsm.frequency[i].cell_reselection_priority,
828 res.data.lte_info_neighboring_gsm.frequency[i].cell_reselection_high_threshold,
829 res.data.lte_info_neighboring_gsm.frequency[i].cell_reselection_low_threshold);
830 }
831 for (j = 0; j < res.data.lte_info_neighboring_gsm.frequency[i].cell_n; j++) {
832 cell = blobmsg_open_table(&status, NULL);
833 blobmsg_add_u32(&status, "channel",
834 res.data.lte_info_neighboring_gsm.frequency[i].cell[j].geran_absolute_rf_channel_number);
835 blobmsg_add_u32(&status, "base_station_identity_code",
836 res.data.lte_info_neighboring_gsm.frequency[i].cell[j].base_station_identity_code);
837 blobmsg_add_double(&status, "rssi",
838 ((double)res.data.lte_info_neighboring_gsm.frequency[i].cell[j].rssi)/10);
839 if (res.data.lte_info_neighboring_gsm.ue_in_idle)
840 blobmsg_add_u32(&status, "cell_selection_rx_level",
841 res.data.lte_info_neighboring_gsm.frequency[i].cell[j].cell_selection_rx_level);
842 blobmsg_close_table(&status, cell);
843 }
844 blobmsg_close_table(&status, freq);
845 }
846 if (res.data.lte_info_neighboring_gsm.frequency_n > 0)
847 blobmsg_close_table(&status, c);
848 }
849 if (res.set.lte_info_neighboring_wcdma) {
850 if (res.data.lte_info_neighboring_wcdma.frequency_n > 0)
851 c = blobmsg_open_table(&status, "lte_info_neighboring_wcdma");
852 for (i = 0; i < res.data.lte_info_neighboring_wcdma.frequency_n; i++) {
853 freq = blobmsg_open_table(&status, NULL);
854 blobmsg_add_u32(&status, "channel",
855 res.data.lte_info_neighboring_wcdma.frequency[i].utra_absolute_rf_channel_number);
856 if (res.data.lte_info_neighboring_wcdma.ue_in_idle) {
857 print_sel_info(res.data.lte_info_neighboring_wcdma.frequency[i].cell_reselection_priority,
858 res.data.lte_info_neighboring_wcdma.frequency[i].cell_reselection_high_threshold,
859 res.data.lte_info_neighboring_wcdma.frequency[i].cell_reselection_low_threshold);
860 }
861 for (j = 0; j < res.data.lte_info_neighboring_wcdma.frequency[i].cell_n; j++) {
862 cell = blobmsg_open_table(&status, NULL);
863 blobmsg_add_u32(&status, "primary_scrambling_code",
864 res.data.lte_info_neighboring_wcdma.frequency[i].cell[j].primary_scrambling_code);
865 blobmsg_add_double(&status, "rscp",
866 ((double)res.data.lte_info_neighboring_wcdma.frequency[i].cell[j].cpich_rscp)/10);
867 blobmsg_add_double(&status, "ecno",
868 ((double)res.data.lte_info_neighboring_wcdma.frequency[i].cell[j].cpich_ecno)/10);
869 if (res.data.lte_info_neighboring_wcdma.ue_in_idle)
870 blobmsg_add_u32(&status, "cell_selection_rx_level",
871 res.data.lte_info_neighboring_wcdma.frequency[i].cell[j].cell_selection_rx_level);
872 blobmsg_close_table(&status, cell);
873 }
874 blobmsg_close_table(&status, freq);
875 }
876 if (res.data.lte_info_neighboring_wcdma.frequency_n > 0)
877 blobmsg_close_table(&status, c);
878 }
879 if (res.set.umts_info_neighboring_lte) {
880 if (res.data.umts_info_neighboring_lte.frequency_n > 0)
881 c = blobmsg_open_table(&status, "umts_info_neighboring_lte");
882 for (i = 0; i < res.data.umts_info_neighboring_lte.frequency_n; i++) {
883 freq = blobmsg_open_table(&status, NULL);
884 blobmsg_add_u32(&status, "channel",
885 res.data.umts_info_neighboring_lte.frequency[i].eutra_absolute_rf_channel_number);
886 print_earfcn_info(res.data.umts_info_neighboring_lte.frequency[i].eutra_absolute_rf_channel_number);
887 blobmsg_add_u32(&status, "physical_cell_id",
888 res.data.umts_info_neighboring_lte.frequency[i].physical_cell_id);
889 blobmsg_add_double(&status, "rsrp",
890 (double) res.data.umts_info_neighboring_lte.frequency[i].rsrp);
891 blobmsg_add_double(&status, "rsrq",
892 (double) res.data.umts_info_neighboring_lte.frequency[i].rsrq);
893 blobmsg_add_u32(&status, "cell_selection_rx_level",
894 res.data.umts_info_neighboring_lte.frequency[i].cell_selection_rx_level);
895 blobmsg_close_table(&status, freq);
896 }
897 if (res.data.umts_info_neighboring_lte.frequency_n > 0)
898 blobmsg_close_table(&status, c);
899 }
900 blobmsg_close_table(&status, t);
901 }
902
903 static enum qmi_cmd_result
904 cmd_nas_get_cell_location_info_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
905 {
906 qmi_set_nas_get_cell_location_info_request(msg);
907 return QMI_CMD_REQUEST;
908 }
909
910 static enum qmi_cmd_result
911 cmd_nas_get_signal_info_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
912 {
913 qmi_set_nas_get_signal_info_request(msg);
914 return QMI_CMD_REQUEST;
915 }
916
917 static void
918 cmd_nas_get_serving_system_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
919 {
920 struct qmi_nas_get_serving_system_response res;
921 static const char *reg_states[] = {
922 [QMI_NAS_REGISTRATION_STATE_NOT_REGISTERED] = "not_registered",
923 [QMI_NAS_REGISTRATION_STATE_REGISTERED] = "registered",
924 [QMI_NAS_REGISTRATION_STATE_NOT_REGISTERED_SEARCHING] = "searching",
925 [QMI_NAS_REGISTRATION_STATE_REGISTRATION_DENIED] = "registering_denied",
926 [QMI_NAS_REGISTRATION_STATE_UNKNOWN] = "unknown",
927 };
928 void *c;
929
930 qmi_parse_nas_get_serving_system_response(msg, &res);
931
932 c = blobmsg_open_table(&status, NULL);
933 if (res.set.serving_system) {
934 int state = res.data.serving_system.registration_state;
935
936 if (state > QMI_NAS_REGISTRATION_STATE_UNKNOWN)
937 state = QMI_NAS_REGISTRATION_STATE_UNKNOWN;
938
939 blobmsg_add_string(&status, "registration", reg_states[state]);
940 }
941 if (res.set.current_plmn) {
942 blobmsg_add_u32(&status, "plmn_mcc", res.data.current_plmn.mcc);
943 blobmsg_add_u32(&status, "plmn_mnc", res.data.current_plmn.mnc);
944 if (res.data.current_plmn.description)
945 blobmsg_add_string(&status, "plmn_description", res.data.current_plmn.description);
946 }
947
948 if (res.set.roaming_indicator)
949 blobmsg_add_u8(&status, "roaming", !res.data.roaming_indicator);
950
951 blobmsg_close_table(&status, c);
952 }
953
954 static enum qmi_cmd_result
955 cmd_nas_get_serving_system_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
956 {
957 qmi_set_nas_get_serving_system_request(msg);
958 return QMI_CMD_REQUEST;
959 }
960
961 static void
962 cmd_nas_get_plmn_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
963 {
964 struct qmi_nas_get_system_selection_preference_response res;
965 static const char *modes[] = {
966 [QMI_NAS_NETWORK_SELECTION_PREFERENCE_AUTOMATIC] = "automatic",
967 [QMI_NAS_NETWORK_SELECTION_PREFERENCE_MANUAL] = "manual",
968 };
969 void *c;
970
971 qmi_parse_nas_get_system_selection_preference_response(msg, &res);
972
973 c = blobmsg_open_table(&status, NULL);
974 if (res.set.network_selection_preference) {
975 blobmsg_add_string(&status, "mode", modes[res.data.network_selection_preference]);
976 }
977 if (res.set.manual_network_selection) {
978 blobmsg_add_u32(&status, "mcc", res.data.manual_network_selection.mcc);
979 blobmsg_add_u32(&status, "mnc", res.data.manual_network_selection.mnc);
980 }
981
982 blobmsg_close_table(&status, c);
983 }
984
985 static enum qmi_cmd_result
986 cmd_nas_get_plmn_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
987 {
988 qmi_set_nas_get_system_selection_preference_request(msg);
989 return QMI_CMD_REQUEST;
990 }
991
992 static void
993 cmd_nas_network_scan_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
994 {
995 static struct qmi_nas_network_scan_response res;
996 const char *network_status[] = {
997 "current_serving",
998 "available",
999 "home",
1000 "roaming",
1001 "forbidden",
1002 "not_forbidden",
1003 "preferred",
1004 "not_preferred",
1005 };
1006 const char *radio[] = {
1007 [QMI_NAS_RADIO_INTERFACE_NONE] = "none",
1008 [QMI_NAS_RADIO_INTERFACE_CDMA_1X] = "cdma-1x",
1009 [QMI_NAS_RADIO_INTERFACE_CDMA_1XEVDO] = "cdma-1x_evdo",
1010 [QMI_NAS_RADIO_INTERFACE_AMPS] = "amps",
1011 [QMI_NAS_RADIO_INTERFACE_GSM] = "gsm",
1012 [QMI_NAS_RADIO_INTERFACE_UMTS] = "umts",
1013 [QMI_NAS_RADIO_INTERFACE_LTE] = "lte",
1014 [QMI_NAS_RADIO_INTERFACE_TD_SCDMA] = "td-scdma",
1015 };
1016 void *t, *c, *info, *stat;
1017 int i, j;
1018
1019 qmi_parse_nas_network_scan_response(msg, &res);
1020
1021 t = blobmsg_open_table(&status, NULL);
1022
1023 c = blobmsg_open_array(&status, "network_info");
1024 for (i = 0; i < res.data.network_information_n; i++) {
1025 info = blobmsg_open_table(&status, NULL);
1026 blobmsg_add_u32(&status, "mcc", res.data.network_information[i].mcc);
1027 blobmsg_add_u32(&status, "mnc", res.data.network_information[i].mnc);
1028 if (res.data.network_information[i].description)
1029 blobmsg_add_string(&status, "description", res.data.network_information[i].description);
1030 stat = blobmsg_open_array(&status, "status");
1031 for (j = 0; j < ARRAY_SIZE(network_status); j++) {
1032 if (!(res.data.network_information[i].network_status & (1 << j)))
1033 continue;
1034
1035 blobmsg_add_string(&status, NULL, network_status[j]);
1036 }
1037 blobmsg_close_array(&status, stat);
1038 blobmsg_close_table(&status, info);
1039 }
1040 blobmsg_close_array(&status, c);
1041
1042 c = blobmsg_open_array(&status, "radio_access_technology");
1043 for (i = 0; i < res.data.radio_access_technology_n; i++) {
1044 const char *r = "unknown";
1045 int r_i = res.data.radio_access_technology[i].radio_interface;
1046
1047 info = blobmsg_open_table(&status, NULL);
1048 blobmsg_add_u32(&status, "mcc", res.data.radio_access_technology[i].mcc);
1049 blobmsg_add_u32(&status, "mnc", res.data.radio_access_technology[i].mnc);
1050 if (r_i >= 0 && r_i < ARRAY_SIZE(radio))
1051 r = radio[r_i];
1052
1053 blobmsg_add_string(&status, "radio", r);
1054 blobmsg_close_table(&status, info);
1055 }
1056 blobmsg_close_array(&status, c);
1057
1058 blobmsg_close_table(&status, t);
1059 }
1060
1061 static enum qmi_cmd_result
1062 cmd_nas_network_scan_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
1063 {
1064 struct qmi_nas_network_scan_request sreq = {
1065 QMI_INIT(network_type,
1066 QMI_NAS_NETWORK_SCAN_TYPE_GSM |
1067 QMI_NAS_NETWORK_SCAN_TYPE_UMTS |
1068 QMI_NAS_NETWORK_SCAN_TYPE_LTE |
1069 QMI_NAS_NETWORK_SCAN_TYPE_TD_SCDMA),
1070 };
1071
1072 qmi_set_nas_network_scan_request(msg, &sreq);
1073 return QMI_CMD_REQUEST;
1074 }
Tiny QMI command line utility