2 * uqmi -- tiny QMI support implementation
4 * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
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.
22 #define cmd_uim_verify_pin1_cb no_cb
23 static enum qmi_cmd_result
24 cmd_uim_verify_pin1_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
26 struct qmi_uim_verify_pin_request data
= {
27 QMI_INIT_SEQUENCE(session
,
28 .session_type
= QMI_UIM_SESSION_TYPE_CARD_SLOT_1
,
29 .application_identifier_n
= 0
31 QMI_INIT_SEQUENCE(info
,
32 .pin_id
= QMI_UIM_PIN_ID_PIN1
,
36 qmi_set_uim_verify_pin_request(msg
, &data
);
37 return QMI_CMD_REQUEST
;
40 #define cmd_uim_verify_pin2_cb no_cb
41 static enum qmi_cmd_result
42 cmd_uim_verify_pin2_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
44 struct qmi_uim_verify_pin_request data
= {
45 QMI_INIT_SEQUENCE(session
,
46 .session_type
= QMI_UIM_SESSION_TYPE_CARD_SLOT_1
,
47 .application_identifier_n
= 0
49 QMI_INIT_SEQUENCE(info
,
50 .pin_id
= QMI_UIM_PIN_ID_PIN2
,
54 qmi_set_uim_verify_pin_request(msg
, &data
);
55 return QMI_CMD_REQUEST
;
58 static void cmd_uim_get_sim_state_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
60 struct qmi_uim_get_card_status_response res
;
61 void * const card_table
= blobmsg_open_table(&status
, NULL
);
63 qmi_parse_uim_get_card_status_response(msg
, &res
);
65 for (int i
= 0; i
< res
.data
.card_status
.cards_n
; ++i
) {
66 if (res
.data
.card_status
.cards
[i
].card_state
!= QMI_UIM_CARD_STATE_PRESENT
)
69 uint8_t pin1_state
= res
.data
.card_status
.cards
[i
].upin_state
;
70 uint8_t pin1_retries
= res
.data
.card_status
.cards
[i
].upin_retries
;
71 uint8_t puk1_retries
= res
.data
.card_status
.cards
[i
].upuk_retries
;
75 bool has_pin2
= false;
77 for (int j
= 0; j
< res
.data
.card_status
.cards
[i
].applications_n
; ++j
) {
78 if (res
.data
.card_status
.cards
[i
].applications
[j
].type
== QMI_UIM_CARD_APPLICATION_TYPE_UNKNOWN
)
81 if (!res
.data
.card_status
.cards
[i
].applications
[j
].upin_replaces_pin1
) {
82 pin1_state
= res
.data
.card_status
.cards
[i
].applications
[j
].pin1_state
;
83 pin1_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].pin1_retries
;
84 puk1_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].puk1_retries
;
87 pin2_state
= res
.data
.card_status
.cards
[i
].applications
[j
].pin2_state
;
88 pin2_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].pin2_retries
;
89 puk2_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].puk2_retries
;
92 break; /* handle first application only for now */
95 blobmsg_add_string(&status
, "pin1_status", get_pin_status(pin1_state
));
96 blobmsg_add_u32(&status
, "pin1_verify_tries", pin1_retries
);
97 blobmsg_add_u32(&status
, "pin1_unlock_tries", puk1_retries
);
99 blobmsg_add_string(&status
, "pin2_status", get_pin_status(pin2_state
));
100 blobmsg_add_u32(&status
, "pin2_verify_tries", pin2_retries
);
101 blobmsg_add_u32(&status
, "pin2_unlock_tries", puk2_retries
);
104 break; /* handle only first preset SIM card for now */
107 blobmsg_close_table(&status
, card_table
);
110 static enum qmi_cmd_result
111 cmd_uim_get_sim_state_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
113 qmi_set_uim_get_card_status_request(msg
);
114 return QMI_CMD_REQUEST
;