2 * uqmi -- tiny QMI support implementation
4 * Copyright (C) 2014-2015 Felix Fietkau <nbd@openwrt.org>
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.
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.
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.
21 #include "qmi-message.h"
24 QmiDmsUimPinId pin_id
;
30 static void cmd_dms_get_capabilities_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
34 struct qmi_dms_get_capabilities_response res
;
35 const char *radio_cap
[] = {
36 [QMI_DMS_RADIO_INTERFACE_CDMA20001X
] = "cdma1x",
37 [QMI_DMS_RADIO_INTERFACE_EVDO
] = "cdma1xevdo",
38 [QMI_DMS_RADIO_INTERFACE_GSM
] = "gsm",
39 [QMI_DMS_RADIO_INTERFACE_UMTS
] = "umts",
40 [QMI_DMS_RADIO_INTERFACE_LTE
] = "lte",
42 const char *service_cap
[] = {
43 [QMI_DMS_DATA_SERVICE_CAPABILITY_NONE
] = "none",
44 [QMI_DMS_DATA_SERVICE_CAPABILITY_CS
] = "cs",
45 [QMI_DMS_DATA_SERVICE_CAPABILITY_PS
] = "ps",
46 [QMI_DMS_DATA_SERVICE_CAPABILITY_SIMULTANEOUS_CS_PS
] = "simultaneous_cs_ps",
47 [QMI_DMS_DATA_SERVICE_CAPABILITY_NON_SIMULTANEOUS_CS_PS
] = "non_simultaneous_cs_ps",
50 qmi_parse_dms_get_capabilities_response(msg
, &res
);
52 t
= blobmsg_open_table(&status
, NULL
);
54 blobmsg_add_u32(&status
, "max_tx_channel_rate", (int32_t) res
.data
.info
.max_tx_channel_rate
);
55 blobmsg_add_u32(&status
, "max_rx_channel_rate", (int32_t) res
.data
.info
.max_rx_channel_rate
);
56 if ((int)res
.data
.info
.data_service_capability
>= 0 && res
.data
.info
.data_service_capability
< ARRAY_SIZE(service_cap
))
57 blobmsg_add_string(&status
, "data_service", service_cap
[res
.data
.info
.data_service_capability
]);
59 if(res
.data
.info
.sim_capability
== QMI_DMS_SIM_CAPABILITY_NOT_SUPPORTED
)
60 blobmsg_add_string(&status
, "sim", "not supported");
61 else if(res
.data
.info
.sim_capability
== QMI_DMS_SIM_CAPABILITY_SUPPORTED
)
62 blobmsg_add_string(&status
, "sim", "supported");
64 networks
= blobmsg_open_array(&status
, "networks");
65 for (i
= 0; i
< res
.data
.info
.radio_interface_list_n
; i
++) {
66 if ((int)res
.data
.info
.radio_interface_list
[i
] >= 0 && res
.data
.info
.radio_interface_list
[i
] < ARRAY_SIZE(radio_cap
))
67 blobmsg_add_string(&status
, NULL
, radio_cap
[res
.data
.info
.radio_interface_list
[i
]]);
69 blobmsg_add_string(&status
, NULL
, "unknown");
71 blobmsg_close_array(&status
, networks
);
73 blobmsg_close_table(&status
, t
);
76 static enum qmi_cmd_result
77 cmd_dms_get_capabilities_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
79 qmi_set_dms_get_capabilities_request(msg
);
80 return QMI_CMD_REQUEST
;
83 static const char *get_pin_status(int status
)
85 static const char *pin_status
[] = {
86 [QMI_DMS_UIM_PIN_STATUS_NOT_INITIALIZED
] = "not_initialized",
87 [QMI_DMS_UIM_PIN_STATUS_ENABLED_NOT_VERIFIED
] = "not_verified",
88 [QMI_DMS_UIM_PIN_STATUS_ENABLED_VERIFIED
] = "verified",
89 [QMI_DMS_UIM_PIN_STATUS_DISABLED
] = "disabled",
90 [QMI_DMS_UIM_PIN_STATUS_BLOCKED
] = "blocked",
91 [QMI_DMS_UIM_PIN_STATUS_PERMANENTLY_BLOCKED
] = "permanently_blocked",
92 [QMI_DMS_UIM_PIN_STATUS_UNBLOCKED
] = "unblocked",
93 [QMI_DMS_UIM_PIN_STATUS_CHANGED
] = "changed",
95 const char *res
= "Unknown";
97 if (status
< ARRAY_SIZE(pin_status
) && pin_status
[status
])
98 res
= pin_status
[status
];
103 static void cmd_dms_get_pin_status_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
105 struct qmi_dms_uim_get_pin_status_response res
;
108 qmi_parse_dms_uim_get_pin_status_response(msg
, &res
);
109 c
= blobmsg_open_table(&status
, NULL
);
110 if (res
.set
.pin1_status
) {
111 blobmsg_add_string(&status
, "pin1_status", get_pin_status(res
.data
.pin1_status
.current_status
));
112 blobmsg_add_u32(&status
, "pin1_verify_tries", (int32_t) res
.data
.pin1_status
.verify_retries_left
);
113 blobmsg_add_u32(&status
, "pin1_unblock_tries", (int32_t) res
.data
.pin1_status
.unblock_retries_left
);
115 if (res
.set
.pin2_status
) {
116 blobmsg_add_string(&status
, "pin2_status", get_pin_status(res
.data
.pin2_status
.current_status
));
117 blobmsg_add_u32(&status
, "pin2_verify_tries", (int32_t) res
.data
.pin2_status
.verify_retries_left
);
118 blobmsg_add_u32(&status
, "pin2_unblock_tries", (int32_t) res
.data
.pin2_status
.unblock_retries_left
);
120 blobmsg_close_table(&status
, c
);
123 static enum qmi_cmd_result
124 cmd_dms_get_pin_status_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
126 qmi_set_dms_uim_get_pin_status_request(msg
);
127 return QMI_CMD_REQUEST
;
130 #define cmd_dms_verify_pin1_cb no_cb
131 static enum qmi_cmd_result
132 cmd_dms_verify_pin1_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
134 struct qmi_dms_uim_verify_pin_request data
= {
135 QMI_INIT_SEQUENCE(info
,
136 .pin_id
= QMI_DMS_UIM_PIN_ID_PIN
,
140 qmi_set_dms_uim_verify_pin_request(msg
, &data
);
141 return QMI_CMD_REQUEST
;
144 #define cmd_dms_verify_pin2_cb no_cb
145 static enum qmi_cmd_result
146 cmd_dms_verify_pin2_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
148 struct qmi_dms_uim_verify_pin_request data
= {
149 QMI_INIT_SEQUENCE(info
,
150 .pin_id
= QMI_DMS_UIM_PIN_ID_PIN2
,
154 qmi_set_dms_uim_verify_pin_request(msg
, &data
);
155 return QMI_CMD_REQUEST
;
158 #define cmd_dms_set_pin_cb no_cb
159 static enum qmi_cmd_result
160 cmd_dms_set_pin_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
162 dms_req_data
.pin
= arg
;
166 static enum qmi_cmd_result
167 cmd_dms_set_pin_protection_prepare(struct qmi_msg
*msg
, char *arg
)
169 if (!dms_req_data
.pin
) {
170 uqmi_add_error("Missing argument");
175 if (strcasecmp(arg
, "disabled") == 0)
177 else if (strcasecmp(arg
, "enabled") == 0)
180 uqmi_add_error("Invalid value (valid: disabled, enabled)");
184 struct qmi_dms_uim_set_pin_protection_request dms_pin_protection_req
= {
185 QMI_INIT_SEQUENCE(info
,
186 .pin_id
= dms_req_data
.pin_id
188 QMI_INIT_PTR(info
.pin
, dms_req_data
.pin
),
189 QMI_INIT_PTR(info
.protection_enabled
, is_enabled
)
192 qmi_set_dms_uim_set_pin_protection_request(msg
, &dms_pin_protection_req
);
193 return QMI_CMD_REQUEST
;
196 #define cmd_dms_set_pin1_protection_cb no_cb
197 static enum qmi_cmd_result
198 cmd_dms_set_pin1_protection_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
200 dms_req_data
.pin_id
= QMI_DMS_UIM_PIN_ID_PIN
;
201 return cmd_dms_set_pin_protection_prepare(msg
, arg
);
204 #define cmd_dms_set_pin2_protection_cb no_cb
205 static enum qmi_cmd_result
206 cmd_dms_set_pin2_protection_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
208 dms_req_data
.pin_id
= QMI_DMS_UIM_PIN_ID_PIN2
;
209 return cmd_dms_set_pin_protection_prepare(msg
, arg
);
212 static enum qmi_cmd_result
213 cmd_dms_change_pin_prepare(struct qmi_msg
*msg
, char *arg
)
215 if (!dms_req_data
.pin
|| !dms_req_data
.new_pin
) {
216 uqmi_add_error("Missing argument");
220 struct qmi_dms_uim_change_pin_request dms_change_pin_req
= {
221 QMI_INIT_SEQUENCE(info
,
222 .pin_id
= dms_req_data
.pin_id
224 QMI_INIT_PTR(info
.old_pin
, dms_req_data
.pin
),
225 QMI_INIT_PTR(info
.new_pin
, dms_req_data
.new_pin
)
228 qmi_set_dms_uim_change_pin_request(msg
, &dms_change_pin_req
);
229 return QMI_CMD_REQUEST
;
232 #define cmd_dms_change_pin1_cb no_cb
233 static enum qmi_cmd_result
234 cmd_dms_change_pin1_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
236 dms_req_data
.pin_id
= QMI_DMS_UIM_PIN_ID_PIN
;
237 return cmd_dms_change_pin_prepare(msg
, arg
);
240 #define cmd_dms_change_pin2_cb no_cb
241 static enum qmi_cmd_result
242 cmd_dms_change_pin2_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
244 dms_req_data
.pin_id
= QMI_DMS_UIM_PIN_ID_PIN2
;
245 return cmd_dms_change_pin_prepare(msg
, arg
);
248 #define cmd_dms_set_new_pin_cb no_cb
249 static enum qmi_cmd_result
250 cmd_dms_set_new_pin_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
252 dms_req_data
.new_pin
= arg
;
256 #define cmd_dms_set_puk_cb no_cb
257 static enum qmi_cmd_result
258 cmd_dms_set_puk_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
260 dms_req_data
.puk
= arg
;
264 #define cmd_dms_unblock_pin1_cb no_cb
265 static enum qmi_cmd_result
266 cmd_dms_unblock_pin1_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
268 if (!dms_req_data
.puk
|| !dms_req_data
.new_pin
) {
269 uqmi_add_error("Missing argument");
273 struct qmi_dms_uim_unblock_pin_request dms_unlock_pin_req
= {
274 QMI_INIT_SEQUENCE(info
,
275 .pin_id
= QMI_DMS_UIM_PIN_ID_PIN
277 QMI_INIT_PTR(info
.puk
, dms_req_data
.puk
),
278 QMI_INIT_PTR(info
.new_pin
, dms_req_data
.new_pin
)
281 qmi_set_dms_uim_unblock_pin_request(msg
, &dms_unlock_pin_req
);
282 return QMI_CMD_REQUEST
;
285 #define cmd_dms_unblock_pin2_cb no_cb
286 static enum qmi_cmd_result
287 cmd_dms_unblock_pin2_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
289 if (!dms_req_data
.puk
|| !dms_req_data
.new_pin
) {
290 uqmi_add_error("Missing argument");
294 struct qmi_dms_uim_unblock_pin_request dms_unlock_pin_req
= {
295 QMI_INIT_SEQUENCE(info
,
296 .pin_id
= QMI_DMS_UIM_PIN_ID_PIN2
298 QMI_INIT_PTR(info
.puk
, dms_req_data
.puk
),
299 QMI_INIT_PTR(info
.new_pin
, dms_req_data
.new_pin
)
302 qmi_set_dms_uim_unblock_pin_request(msg
, &dms_unlock_pin_req
);
303 return QMI_CMD_REQUEST
;
306 static void cmd_dms_get_iccid_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
308 struct qmi_dms_uim_get_iccid_response res
;
310 qmi_parse_dms_uim_get_iccid_response(msg
, &res
);
312 blobmsg_add_string(&status
, NULL
, res
.data
.iccid
);
315 static enum qmi_cmd_result
316 cmd_dms_get_iccid_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
318 qmi_set_dms_uim_get_iccid_request(msg
);
319 return QMI_CMD_REQUEST
;
322 static void cmd_dms_get_imsi_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
324 struct qmi_dms_uim_get_imsi_response res
;
326 qmi_parse_dms_uim_get_imsi_response(msg
, &res
);
328 blobmsg_add_string(&status
, NULL
, res
.data
.imsi
);
331 static enum qmi_cmd_result
332 cmd_dms_get_imsi_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
334 qmi_set_dms_uim_get_imsi_request(msg
);
335 return QMI_CMD_REQUEST
;
338 static void cmd_dms_get_msisdn_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
340 struct qmi_dms_get_msisdn_response res
;
342 qmi_parse_dms_get_msisdn_response(msg
, &res
);
344 blobmsg_add_string(&status
, NULL
, res
.data
.msisdn
);
347 static enum qmi_cmd_result
348 cmd_dms_get_msisdn_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
350 qmi_set_dms_get_msisdn_request(msg
);
351 return QMI_CMD_REQUEST
;
354 static void cmd_dms_get_imei_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
356 struct qmi_dms_get_ids_response res
;
358 qmi_parse_dms_get_ids_response(msg
, &res
);
360 blobmsg_add_string(&status
, NULL
, res
.data
.imei
);
363 static enum qmi_cmd_result
364 cmd_dms_get_imei_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
366 qmi_set_dms_get_ids_request(msg
);
367 return QMI_CMD_REQUEST
;
370 #define cmd_dms_reset_cb no_cb
371 static enum qmi_cmd_result
372 cmd_dms_reset_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
374 qmi_set_dms_reset_request(msg
);
375 return QMI_CMD_REQUEST
;
378 #define cmd_dms_set_operating_mode_cb no_cb
379 static enum qmi_cmd_result
380 cmd_dms_set_operating_mode_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
382 static const char *modes
[] = {
383 [QMI_DMS_OPERATING_MODE_ONLINE
] = "online",
384 [QMI_DMS_OPERATING_MODE_LOW_POWER
] = "low_power",
385 [QMI_DMS_OPERATING_MODE_FACTORY_TEST
] = "factory_test",
386 [QMI_DMS_OPERATING_MODE_OFFLINE
] = "offline",
387 [QMI_DMS_OPERATING_MODE_RESET
] = "reset",
388 [QMI_DMS_OPERATING_MODE_SHUTTING_DOWN
] = "shutting_down",
389 [QMI_DMS_OPERATING_MODE_PERSISTENT_LOW_POWER
] = "persistent_low_power",
390 [QMI_DMS_OPERATING_MODE_MODE_ONLY_LOW_POWER
] = "mode_only_low_power",
392 static struct qmi_dms_set_operating_mode_request sreq
= {
393 QMI_INIT(mode
, QMI_DMS_OPERATING_MODE_ONLINE
),
397 for (i
= 0; i
< ARRAY_SIZE(modes
); i
++) {
401 if (strcmp(arg
, modes
[i
]) != 0)
405 qmi_set_dms_set_operating_mode_request(msg
, &sreq
);
406 return QMI_CMD_REQUEST
;
409 return uqmi_add_error("Invalid argument");
412 #define cmd_dms_set_fcc_authentication_cb no_cb
413 static enum qmi_cmd_result
414 cmd_dms_set_fcc_authentication_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
416 qmi_set_dms_set_fcc_authentication_request(msg
);
417 return QMI_CMD_REQUEST
;