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