Merge "icnss2: Send enter power save after driver suspend" (c788d28e) · Commits · e / devices / android_kernel_fairphone_FP4

drivers/soc/qcom/icnss2/main.c

+17 −10

Original line number	Diff line number	Diff line
		@@ -2749,7 +2749,6 @@ EXPORT_SYMBOL(icnss_idle_restart);
		int icnss_exit_power_save(struct device *dev)
		{
		struct icnss_priv *priv = dev_get_drvdata(dev);
		int ret = 0;

		icnss_pr_dbg("Calling Exit Power Save\n");

		@@ -2757,12 +2756,8 @@ int icnss_exit_power_save(struct device *dev)
		!test_bit(ICNSS_MODE_ON, &priv->state))
		return 0;

		ret = wlfw_exit_power_save_send_msg(priv);
		if (ret) {
		priv->stats.pm_resume_err++;
		return ret;
		}
		return 0;
		return wlfw_power_save_send_msg(priv,
		(enum wlfw_power_save_mode_v01)ICNSS_POWER_SAVE_EXIT);
		}
		EXPORT_SYMBOL(icnss_exit_power_save);

		@@ -3349,12 +3344,18 @@ static int icnss_pm_suspend(struct device *dev)

		if (!priv->ops \|\| !priv->ops->pm_suspend \|\|
		!test_bit(ICNSS_DRIVER_PROBED, &priv->state))
		goto out;
		return 0;

		ret = priv->ops->pm_suspend(dev);

		out:
		if (ret == 0) {
		if (priv->device_id == WCN6750_DEVICE_ID) {
		ret = wlfw_power_save_send_msg(priv,
		(enum wlfw_power_save_mode_v01)
		ICNSS_POWER_SAVE_ENTER);
		if (ret)
		return priv->ops->pm_resume(dev);
		}
		priv->stats.pm_suspend++;
		set_bit(ICNSS_PM_SUSPEND, &priv->state);
		} else {
		@@ -3466,7 +3467,13 @@ static int icnss_pm_runtime_suspend(struct device *dev)

		icnss_pr_vdbg("Runtime suspend\n");
		ret = priv->ops->runtime_suspend(dev);

		if (!ret) {
		ret = wlfw_power_save_send_msg(priv,
		(enum wlfw_power_save_mode_v01)
		ICNSS_POWER_SAVE_ENTER);
		if (ret)
		return priv->ops->runtime_resume(dev);
		}
		out:
		return ret;
		}

drivers/soc/qcom/icnss2/main.h

+7 −0

Original line number	Diff line number	Diff line
		@@ -169,6 +169,10 @@ struct icnss_fw_mem {
		unsigned long attrs;
		};

		enum icnss_power_save_mode {
		ICNSS_POWER_SAVE_ENTER,
		ICNSS_POWER_SAVE_EXIT,
		};
		struct icnss_stats {
		struct {
		uint32_t posted;
		@@ -241,6 +245,9 @@ struct icnss_stats {
		u32 exit_power_save_req;
		u32 exit_power_save_resp;
		u32 exit_power_save_err;
		u32 enter_power_save_req;
		u32 enter_power_save_resp;
		u32 enter_power_save_err;
		u32 soc_wake_req;
		u32 soc_wake_resp;
		u32 soc_wake_err;

drivers/soc/qcom/icnss2/qmi.c

+29 −31

Original line number	Diff line number	Diff line
		@@ -341,11 +341,11 @@ int wlfw_device_info_send_msg(struct icnss_priv *priv)
		return ret;
		}

		int wlfw_exit_power_save_send_msg(struct icnss_priv *priv)
		int wlfw_power_save_send_msg(struct icnss_priv *priv,
		enum wlfw_power_save_mode_v01 mode)
		{
		int ret;
		struct wlfw_exit_power_save_req_msg_v01 *req;
		struct wlfw_exit_power_save_resp_msg_v01 *resp;
		struct wlfw_power_save_req_msg_v01 *req;
		struct qmi_txn txn;

		if (!priv)
		@@ -354,23 +354,27 @@ int wlfw_exit_power_save_send_msg(struct icnss_priv *priv)
		if (test_bit(ICNSS_FW_DOWN, &priv->state))
		return -EINVAL;

		icnss_pr_dbg("Sending exit power save, state: 0x%lx\n",
		priv->state);
		if (test_bit(ICNSS_PD_RESTART, &priv->state) \|\|
		!test_bit(ICNSS_MODE_ON, &priv->state))
		return 0;

		icnss_pr_dbg("Sending power save mode: %d, state: 0x%lx\n",
		mode, priv->state);

		req = kzalloc(sizeof(*req), GFP_KERNEL);
		if (!req)
		return -ENOMEM;

		resp = kzalloc(sizeof(*resp), GFP_KERNEL);
		if (!resp) {
		kfree(req);
		return -ENOMEM;
		}
		req->power_save_mode_valid = 1;
		req->power_save_mode = mode;

		if (mode == WLFW_POWER_SAVE_EXIT_V01)
		priv->stats.exit_power_save_req++;
		else
		priv->stats.enter_power_save_req++;

		ret = qmi_txn_init(&priv->qmi, &txn,
		wlfw_exit_power_save_resp_msg_v01_ei, resp);
		NULL, NULL);
		if (ret < 0) {
		icnss_qmi_fatal_err("Fail to init txn for exit power save%d\n",
		ret);
		@@ -378,9 +382,9 @@ int wlfw_exit_power_save_send_msg(struct icnss_priv *priv)
		}

		ret = qmi_send_request(&priv->qmi, NULL, &txn,
		QMI_WLFW_EXIT_POWER_SAVE_REQ_V01,
		WLFW_EXIT_POWER_SAVE_REQ_MSG_V01_MAX_MSG_LEN,
		wlfw_exit_power_save_req_msg_v01_ei, req);
		QMI_WLFW_POWER_SAVE_REQ_V01,
		WLFW_POWER_SAVE_REQ_MSG_V01_MAX_MSG_LEN,
		wlfw_power_save_req_msg_v01_ei, req);
		if (ret < 0) {
		qmi_txn_cancel(&txn);
		icnss_qmi_fatal_err("Fail to send exit power save req %d\n",
		@@ -388,29 +392,23 @@ int wlfw_exit_power_save_send_msg(struct icnss_priv *priv)
		goto out;
		}

		ret = qmi_txn_wait(&txn, priv->ctrl_params.qmi_timeout);
		if (ret < 0) {
		icnss_qmi_fatal_err("Exit power save wait failed with ret %d\n",
		ret);
		goto out;
		} else if (resp->resp.result != QMI_RESULT_SUCCESS_V01) {
		icnss_qmi_fatal_err(
		"QMI exit power save request rejected,result:%d error:%d\n",
		resp->resp.result, resp->resp.error);
		ret = -resp->resp.result;
		goto out;
		}
		qmi_txn_cancel(&txn);

		if (mode == WLFW_POWER_SAVE_EXIT_V01)
		priv->stats.exit_power_save_resp++;
		else
		priv->stats.enter_power_save_resp++;

		kfree(resp);
		kfree(req);
		return 0;

		out:
		kfree(resp);
		kfree(req);

		if (mode == WLFW_POWER_SAVE_EXIT_V01)
		priv->stats.exit_power_save_err++;
		else
		priv->stats.enter_power_save_err++;
		return ret;
		}

drivers/soc/qcom/icnss2/qmi.h

+4 −2

Original line number	Diff line number	Diff line
		@@ -129,7 +129,8 @@ int wlfw_qdss_trace_mem_info_send_sync(struct icnss_priv *priv)
		return 0;
		}

		int wlfw_exit_power_save_send_msg(struct icnss_priv *priv)
		int wlfw_power_save_send_msg(struct icnss_priv *priv,
		enum wlfw_power_save_mode_v01 mode)
		{
		return 0;
		}
		@@ -180,7 +181,8 @@ int wlfw_wlan_mode_send_sync_msg(struct icnss_priv *priv,
		enum wlfw_driver_mode_enum_v01 mode);
		int icnss_wlfw_bdf_dnld_send_sync(struct icnss_priv *priv, u32 bdf_type);
		int wlfw_qdss_trace_mem_info_send_sync(struct icnss_priv *priv);
		int wlfw_exit_power_save_send_msg(struct icnss_priv *priv);
		int wlfw_power_save_send_msg(struct icnss_priv *priv,
		enum wlfw_power_save_mode_v01 mode);
		int icnss_wlfw_get_info_send_sync(struct icnss_priv *priv, int type,
		void *cmd, int cmd_len);
		int wlfw_send_soc_wake_msg(struct icnss_priv *priv,