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 static int uim_slot
= 0;
24 #define cmd_uim_verify_pin1_cb no_cb
25 static enum qmi_cmd_result
26 cmd_uim_verify_pin1_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
28 struct qmi_uim_verify_pin_request data
= {
29 QMI_INIT_SEQUENCE(session
,
30 .session_type
= QMI_UIM_SESSION_TYPE_CARD_SLOT_1
,
31 .application_identifier_n
= 0
33 QMI_INIT_SEQUENCE(info
,
34 .pin_id
= QMI_UIM_PIN_ID_PIN1
,
38 qmi_set_uim_verify_pin_request(msg
, &data
);
39 return QMI_CMD_REQUEST
;
42 #define cmd_uim_verify_pin2_cb no_cb
43 static enum qmi_cmd_result
44 cmd_uim_verify_pin2_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
46 struct qmi_uim_verify_pin_request data
= {
47 QMI_INIT_SEQUENCE(session
,
48 .session_type
= QMI_UIM_SESSION_TYPE_CARD_SLOT_1
,
49 .application_identifier_n
= 0
51 QMI_INIT_SEQUENCE(info
,
52 .pin_id
= QMI_UIM_PIN_ID_PIN2
,
56 qmi_set_uim_verify_pin_request(msg
, &data
);
57 return QMI_CMD_REQUEST
;
60 static void cmd_uim_get_sim_state_cb(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
)
62 struct qmi_uim_get_card_status_response res
;
63 void * const card_table
= blobmsg_open_table(&status
, NULL
);
64 static const char *card_application_states
[] = {
65 [QMI_UIM_CARD_APPLICATION_STATE_UNKNOWN
] = "unknown",
66 [QMI_UIM_CARD_APPLICATION_STATE_DETECTED
] = "detected",
67 [QMI_UIM_CARD_APPLICATION_STATE_PIN1_OR_UPIN_PIN_REQUIRED
] = "pin-required",
68 [QMI_UIM_CARD_APPLICATION_STATE_PUK1_OR_UPIN_PUK_REQUIRED
] = "puk-required",
69 [QMI_UIM_CARD_APPLICATION_STATE_CHECK_PERSONALIZATION_STATE
] = "check-personalization-state",
70 [QMI_UIM_CARD_APPLICATION_STATE_PIN1_BLOCKED
] = "pin1-blocked",
71 [QMI_UIM_CARD_APPLICATION_STATE_ILLEGAL
] = "illegal",
72 [QMI_UIM_CARD_APPLICATION_STATE_READY
] = "ready",
75 qmi_parse_uim_get_card_status_response(msg
, &res
);
77 for (int i
= 0; i
< res
.data
.card_status
.cards_n
; ++i
) {
78 if (res
.data
.card_status
.cards
[i
].card_state
!= QMI_UIM_CARD_STATE_PRESENT
)
81 uint8_t card_application_state
;
82 uint8_t pin1_state
= res
.data
.card_status
.cards
[i
].upin_state
;
83 uint8_t pin1_retries
= res
.data
.card_status
.cards
[i
].upin_retries
;
84 uint8_t puk1_retries
= res
.data
.card_status
.cards
[i
].upuk_retries
;
88 bool has_pin2
= false;
90 for (int j
= 0; j
< res
.data
.card_status
.cards
[i
].applications_n
; ++j
) {
91 if (res
.data
.card_status
.cards
[i
].applications
[j
].type
== QMI_UIM_CARD_APPLICATION_TYPE_UNKNOWN
)
94 card_application_state
= pin1_state
= res
.data
.card_status
.cards
[i
].applications
[j
].state
;
96 if (!res
.data
.card_status
.cards
[i
].applications
[j
].upin_replaces_pin1
) {
97 pin1_state
= res
.data
.card_status
.cards
[i
].applications
[j
].pin1_state
;
98 pin1_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].pin1_retries
;
99 puk1_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].puk1_retries
;
102 pin2_state
= res
.data
.card_status
.cards
[i
].applications
[j
].pin2_state
;
103 pin2_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].pin2_retries
;
104 puk2_retries
= res
.data
.card_status
.cards
[i
].applications
[j
].puk2_retries
;
107 break; /* handle first application only for now */
110 if (card_application_state
> QMI_UIM_CARD_APPLICATION_STATE_READY
)
111 card_application_state
= QMI_UIM_CARD_APPLICATION_STATE_UNKNOWN
;
113 blobmsg_add_string(&status
, "card_application_state", card_application_states
[card_application_state
]);
114 blobmsg_add_string(&status
, "pin1_status", get_pin_status(pin1_state
));
115 blobmsg_add_u32(&status
, "pin1_verify_tries", pin1_retries
);
116 blobmsg_add_u32(&status
, "pin1_unlock_tries", puk1_retries
);
118 blobmsg_add_string(&status
, "pin2_status", get_pin_status(pin2_state
));
119 blobmsg_add_u32(&status
, "pin2_verify_tries", pin2_retries
);
120 blobmsg_add_u32(&status
, "pin2_unlock_tries", puk2_retries
);
123 break; /* handle only first preset SIM card for now */
126 blobmsg_close_table(&status
, card_table
);
129 static enum qmi_cmd_result
130 cmd_uim_get_sim_state_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
132 qmi_set_uim_get_card_status_request(msg
);
133 return QMI_CMD_REQUEST
;
136 #define cmd_uim_slot_cb no_cb
137 static enum qmi_cmd_result
138 cmd_uim_slot_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
141 int value
= strtoul(arg
, &err
, 10);
142 if ((err
&& *err
) || value
< 1 || value
> 2) {
143 uqmi_add_error("Invalid UIM-Slot value. Allowed: [1,2]");
152 #define cmd_uim_power_off_cb no_cb
153 static enum qmi_cmd_result
154 cmd_uim_power_off_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
156 struct qmi_uim_power_off_sim_request data
= {
157 QMI_INIT(slot
, uim_slot
)
161 uqmi_add_error("UIM-Slot not set. Use --uim-slot <slot> to set it.");
165 qmi_set_uim_power_off_sim_request(msg
, &data
);
166 return QMI_CMD_REQUEST
;
169 #define cmd_uim_power_on_cb no_cb
170 static enum qmi_cmd_result
171 cmd_uim_power_on_prepare(struct qmi_dev
*qmi
, struct qmi_request
*req
, struct qmi_msg
*msg
, char *arg
)
173 struct qmi_uim_power_on_sim_request data
= {
174 QMI_INIT(slot
, uim_slot
)
178 uqmi_add_error("UIM-Slot not set. Use --uim-slot <slot> to set it.");
182 qmi_set_uim_power_on_sim_request(msg
, &data
);
183 return QMI_CMD_REQUEST
;