diff mbox series

[uqmi,2/3] uim: support SIM card power-up/down

Message ID 20231010135845.183016-2-mail@david-bauer.net
State Accepted
Delegated to: David Bauer
Headers show
Series [uqmi,1/3] uim: add application state to SIM status | expand

Commit Message

David Bauer Oct. 10, 2023, 1:58 p.m. UTC 
Support the power-up and power-down commands for the modem's SIM card.
This allows to reset the SIM card and recover it from an illegal card
application state.

Signed-off-by: David Bauer <mail@david-bauer.net>
---
 commands-uim.c | 52 ++++++++++++++++++++++++++++++++++++++++++++++++++
 commands-uim.h |  9 ++++++++-
 2 files changed, 60 insertions(+), 1 deletion(-)
diff mbox series

Patch

diff --git a/commands-uim.c b/commands-uim.c
index 68803b4..ff01d7b 100644
--- a/commands-uim.c
+++ b/commands-uim.c
@@ -19,6 +19,8 @@ 
  * Boston, MA 02110-1301 USA.
  */
 
+static int uim_slot = 0;
+
 #define cmd_uim_verify_pin1_cb no_cb
 static enum qmi_cmd_result
 cmd_uim_verify_pin1_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
@@ -130,3 +132,53 @@  cmd_uim_get_sim_state_prepare(struct qmi_dev *qmi, struct qmi_request *req, stru
 	qmi_set_uim_get_card_status_request(msg);
 	return QMI_CMD_REQUEST;
 }
+
+#define cmd_uim_slot_cb no_cb
+static enum qmi_cmd_result
+cmd_uim_slot_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
+{
+	char *err;
+	int value = strtoul(arg, &err, 10);
+	if ((err && *err) || value < 1 || value > 2) {
+		uqmi_add_error("Invalid UIM-Slot value. Allowed: [1,2]");
+		return QMI_CMD_EXIT;
+	}
+
+	uim_slot = value;
+
+	return QMI_CMD_DONE;
+}
+
+#define cmd_uim_power_off_cb no_cb
+static enum qmi_cmd_result
+cmd_uim_power_off_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
+{
+	struct qmi_uim_power_off_sim_request data = {
+		QMI_INIT(slot, uim_slot)
+	};
+
+	if (!uim_slot) {
+		uqmi_add_error("UIM-Slot not set. Use --uim-slot <slot> to set it.");
+		return QMI_CMD_EXIT;
+	}
+
+	qmi_set_uim_power_off_sim_request(msg, &data);
+	return QMI_CMD_REQUEST;
+}
+
+#define cmd_uim_power_on_cb no_cb
+static enum qmi_cmd_result
+cmd_uim_power_on_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
+{
+	struct qmi_uim_power_on_sim_request data = {
+		QMI_INIT(slot, uim_slot)
+	};
+
+	if (!uim_slot) {
+		uqmi_add_error("UIM-Slot not set. Use --uim-slot <slot> to set it.");
+		return QMI_CMD_EXIT;
+	}
+
+	qmi_set_uim_power_on_sim_request(msg, &data);
+	return QMI_CMD_REQUEST;
+}
diff --git a/commands-uim.h b/commands-uim.h
index 02a49b1..191f09c 100644
--- a/commands-uim.h
+++ b/commands-uim.h
@@ -20,13 +20,20 @@ 
  */
 
 #define __uqmi_uim_commands												\
+	__uqmi_command(uim_slot, uim-slot, required, CMD_TYPE_OPTION), \
 	__uqmi_command(uim_verify_pin1, uim-verify-pin1, required, QMI_SERVICE_UIM), \
 	__uqmi_command(uim_verify_pin2, uim-verify-pin2, required, QMI_SERVICE_UIM), \
-	__uqmi_command(uim_get_sim_state, uim-get-sim-state, no, QMI_SERVICE_UIM) \
+	__uqmi_command(uim_get_sim_state, uim-get-sim-state, no, QMI_SERVICE_UIM), \
+	__uqmi_command(uim_power_off, uim-power-off, no, QMI_SERVICE_UIM), \
+	__uqmi_command(uim_power_on, uim-power-on, no, QMI_SERVICE_UIM) \
 
 
 #define uim_helptext \
 		"  --uim-verify-pin1 <pin>:          Verify PIN1 (new devices)\n" \
 		"  --uim-verify-pin2 <pin>:          Verify PIN2 (new devices)\n" \
 		"  --uim-get-sim-state:                  Get current SIM state\n" \
+		"  --uim-power-off:                  Power off SIM card\n" \
+		"    --uim-slot:                     SIM slot [1-2]\n" \
+		"  --uim-power-on:                   Power on SIM card\n" \
+		"    --uim-slot:                     SIM slot [1-2]\n" \