uqmi: add support for get operating mode

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

diff --git a/commands-dms.c b/commands-dms.c
index 954dacad510d01ff5e6d5149b328252532383302..59648fb9e8a94d3499648cc6c6c14cb520593c28 100644 (file)
--- a/commands-dms.c
+++ b/commands-dms.c
@@ -27,6 +27,17 @@ static struct {
        char* puk;
 } dms_req_data;
 
+const char *oper_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 void cmd_dms_get_capabilities_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
 {
        void *t, *networks;
@@ -375,30 +386,39 @@ cmd_dms_reset_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_m
        return QMI_CMD_REQUEST;
 }
 
+static void
+cmd_dms_get_operating_mode_cb(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg)
+{
+       struct qmi_dms_get_operating_mode_response res;
+
+       qmi_parse_dms_get_operating_mode_response(msg, &res);
+       if (res.data.mode < ARRAY_SIZE(oper_modes))
+               blobmsg_add_string(&status, NULL, oper_modes[res.data.mode]);
+       else
+               blobmsg_add_string(&status, NULL, "unknown");
+}
+
+static enum qmi_cmd_result
+cmd_dms_get_operating_mode_prepare(struct qmi_dev *qmi, struct qmi_request *req, struct qmi_msg *msg, char *arg)
+{
+       qmi_set_dms_get_operating_mode_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])
+       for (i = 0; i < ARRAY_SIZE(oper_modes); i++) {
+               if (!oper_modes[i])
                        continue;
 
-               if (strcmp(arg, modes[i]) != 0)
+               if (strcmp(arg, oper_modes[i]) != 0)
                        continue;
 
                sreq.data.mode = i;