add --set-device-operating-mode

[project/uqmi.git] / commands-dms.c

diff --git a/commands-dms.c b/commands-dms.c
index 483dea0..c40a38e 100644 (file)
--- a/commands-dms.c
+++ b/commands-dms.c
@@ -23,8 +23,10 @@ static const char *get_pin_status(QmiDmsUimPinStatus status)
 static void cmd_dms_get_pin_status_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
 {
        struct qmi_dms_uim_get_pin_status_response res;
+       void *c;
 
        qmi_parse_dms_uim_get_pin_status_response(msg, &res);
+       c = blobmsg_open_table(&status, NULL);
        if (res.set.pin1_status) {
                blobmsg_add_string(&status, "pin1_status", get_pin_status(res.data.pin1_status.current_status));
                blobmsg_add_u32(&status, "pin1_verify_tries", (int32_t) res.data.pin1_status.verify_retries_left);
@@ -35,6 +37,7 @@ static void cmd_dms_get_pin_status_cb(struct qmi_dev *qmi, struct qmi_request *r
                blobmsg_add_u32(&status, "pin2_verify_tries", (int32_t) res.data.pin2_status.verify_retries_left);
                blobmsg_add_u32(&status, "pin2_unblock_tries", (int32_t) res.data.pin2_status.unblock_retries_left);
        }
+       blobmsg_close_table(&status, c);
 }
 
 static enum qmi_cmd_result
@@ -71,3 +74,61 @@ cmd_dms_verify_pin2_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct
        qmi_set_dms_uim_verify_pin_request(msg, &data);
        return QMI_CMD_REQUEST;
 }
+
+static void cmd_dms_get_imsi_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
+{
+       struct qmi_dms_uim_get_imsi_response res;
+
+       qmi_parse_dms_uim_get_imsi_response(msg, &res);
+       if (res.data.imsi)
+               blobmsg_add_string(&status, NULL, res.data.imsi);
+}
+
+static enum qmi_cmd_result
+cmd_dms_get_imsi_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
+{
+       qmi_set_dms_uim_get_imsi_request(msg);
+       return QMI_CMD_REQUEST;
+}
+
+#define cmd_dms_reset_cb no_cb
+static enum qmi_cmd_result
+cmd_dms_reset_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
+{
+       qmi_set_dms_reset_request(msg);
+       return QMI_CMD_REQUEST;
+}
+
+#define cmd_dms_set_operating_mode_cb no_cb
+static enum qmi_cmd_result
+cmd_dms_set_operating_mode_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
+{
+       static const char *modes[] = {
+               [QMI_DMS_OPERATING_MODE_ONLINE] = "online",
+               [QMI_DMS_OPERATING_MODE_LOW_POWER] = "low_power",
+               [QMI_DMS_OPERATING_MODE_FACTORY_TEST] = "factory_test",
+               [QMI_DMS_OPERATING_MODE_OFFLINE] = "offline",
+               [QMI_DMS_OPERATING_MODE_RESET] = "reset",
+               [QMI_DMS_OPERATING_MODE_SHUTTING_DOWN] = "shutting_down",
+               [QMI_DMS_OPERATING_MODE_PERSISTENT_LOW_POWER] = "persistent_low_power",
+               [QMI_DMS_OPERATING_MODE_MODE_ONLY_LOW_POWER] = "mode_only_low_power",
+       };
+       static struct qmi_dms_set_operating_mode_request sreq = {
+               QMI_INIT(mode, QMI_DMS_OPERATING_MODE_ONLINE),
+       };
+       int i;
+
+       for (i = 0; i < ARRAY_SIZE(modes); i++) {
+               if (!modes[i])
+                       continue;
+
+               if (strcmp(arg, modes[i]) != 0)
+                       continue;
+
+               sreq.data.mode = i;
+               qmi_set_dms_set_operating_mode_request(msg, &sreq);
+               return QMI_CMD_REQUEST;
+       }
+
+       return uqmi_add_error("Invalid argument");
+}