ARM: at91: pm: set soc_pm.data.mode in at91_pm_secure_init()

In non secure mode, soc_pm.data.mode is set when entering pm in
at91_pm_begin(). This value is used (not only) to determine if the system
is going into slow clock mode (at91_suspend_entering_slow_clock()). This
function is called from various drivers to check this and act accordingly.
If not set, the driver might enter an incorrect suspend mode. When using
secure suspend mode, at91_pm_begin() is not called and thus
soc_pm.data.mode is not set. Since when using secure suspend, only one
suspend mode is supported, set this value directly in
at91_pm_secure_init().

Signed-off-by: Clément Léger <clement.leger@bootlin.com>
Signed-off-by: Thomas Perrot <thomas.perrot@bootlin.com>
Acked-by: Nicolas Ferre <nicolas.ferre@microchip.com>
Link: https://lore.kernel.org/r/20231020130219.1255937-1-thomas.perrot@bootlin.com
Signed-off-by: Claudiu Beznea <claudiu.beznea@tuxon.dev>

diff --git a/arch/arm/mach-at91/pm.c b/arch/arm/mach-at91/pm.c
index 1a26af0..345b91d 100644 (file)
--- a/arch/arm/mach-at91/pm.c
+++ b/arch/arm/mach-at91/pm.c
@@ -1103,6 +1103,7 @@ static void __init at91_pm_secure_init(void)
        if (res.a0 == 0) {
                pr_info("AT91: Secure PM: suspend mode set to %s\n",
                        pm_modes[suspend_mode].pattern);
+               soc_pm.data.mode = suspend_mode;
                return;
        }
 
@@ -1112,6 +1113,7 @@ static void __init at91_pm_secure_init(void)
        res = sam_smccc_call(SAMA5_SMC_SIP_GET_SUSPEND_MODE, 0, 0);
        if (res.a0 == 0) {
                pr_warn("AT91: Secure PM: failed to get default mode\n");
+               soc_pm.data.mode = -1;
                return;
        }
 
@@ -1119,6 +1121,7 @@ static void __init at91_pm_secure_init(void)
                pm_modes[suspend_mode].pattern);
 
        soc_pm.data.suspend_mode = res.a1;
+       soc_pm.data.mode = soc_pm.data.suspend_mode;
 }
 static const struct of_device_id atmel_shdwc_ids[] = {
        { .compatible = "atmel,sama5d2-shdwc" },