On suspend we send AVS_CMD_S2_ENTER and on resume AVS_CMD_S2_EXIT.
These are best effort calls, so we don't check the return code or take
any action if either of the calls fails.

Signed-off-by: Markus Mayer <[email protected]>
---
 drivers/cpufreq/brcmstb-avs-cpufreq.c | 12 +++++++++++-
 1 file changed, 11 insertions(+), 1 deletion(-)

diff --git a/drivers/cpufreq/brcmstb-avs-cpufreq.c 
b/drivers/cpufreq/brcmstb-avs-cpufreq.c
index 79a0538a531a..3e31e5d28b79 100644
--- a/drivers/cpufreq/brcmstb-avs-cpufreq.c
+++ b/drivers/cpufreq/brcmstb-avs-cpufreq.c
@@ -506,7 +506,14 @@ static int brcm_avs_suspend(struct cpufreq_policy *policy)
         * AVS co-processor, not necessarily the P-state we are running at now.
         * So, we get the current P-state explicitly.
         */
-       return brcm_avs_get_pstate(priv, &priv->pmap.state);
+       ret = brcm_avs_get_pstate(priv, &priv->pmap.state);
+       if (ret)
+               return ret;
+
+       /* This is best effort. Nothing to do if it fails. */
+       (void)__issue_avs_command(priv, AVS_CMD_S2_ENTER, 0, 0, NULL);
+
+       return 0;
 }
 
 static int brcm_avs_resume(struct cpufreq_policy *policy)
@@ -514,6 +521,9 @@ static int brcm_avs_resume(struct cpufreq_policy *policy)
        struct private_data *priv = policy->driver_data;
        int ret;
 
+       /* This is best effort. Nothing to do if it fails. */
+       (void)__issue_avs_command(priv, AVS_CMD_S2_EXIT, 0, 0, NULL);
+
        ret = brcm_avs_set_pmap(priv, &priv->pmap);
        if (ret == -EEXIST) {
                struct platform_device *pdev  = cpufreq_get_driver_data();
-- 
2.17.1

Reply via email to