Browse Source

uqmi: add support for get operating mode

Currently only the set operation is supported.
Add support for getting the current operating mode.

Reviewed-by: Sergey Ryazanov <ryazanov.s.a@gmail.com>
Signed-off-by: Henrik Ginstmark <henrik@ginstmark.se>
Signed-off-by: Oskari Lemmela <oskari@lemmela.net>
Oskari Lemmela 2 years ago
parent
commit
f254fc59c7
2 changed files with 35 additions and 13 deletions
  1. 33 13
      commands-dms.c
  2. 2 0
      commands-dms.h

+ 33 - 13
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;

+ 2 - 0
commands-dms.h

@@ -37,6 +37,7 @@
 	__uqmi_command(dms_get_imsi, get-imsi, no, QMI_SERVICE_DMS), \
 	__uqmi_command(dms_get_imei, get-imei, no, QMI_SERVICE_DMS), \
 	__uqmi_command(dms_get_msisdn, get-msisdn, no, QMI_SERVICE_DMS), \
+	__uqmi_command(dms_get_operating_mode, get-device-operating-mode, no, QMI_SERVICE_DMS), \
 	__uqmi_command(dms_set_operating_mode, set-device-operating-mode, required, QMI_SERVICE_DMS), \
 	__uqmi_command(dms_reset, reset-dms, no, QMI_SERVICE_DMS), \
 	__uqmi_command(dms_set_fcc_authentication, fcc-auth, no, QMI_SERVICE_DMS) \
@@ -67,6 +68,7 @@
 		"  --get-imei:                       Get International Mobile Equipment ID\n" \
 		"  --get-msisdn:                     Get the MSISDN (telephone number)\n" \
 		"  --reset-dms:                      Reset the DMS service\n" \
+		"  --get-device-operating-mode       Get the device operating mode\n" \
 		"  --set-device-operating-mode <m>   Set the device operating mode\n" \
 		"                                    (modes: online, low_power, factory_test, offline\n" \
 		"                                     reset, shutting_down, persistent_low_power,\n" \