[PATCH 07/13] bus: ti-sysc: Handle swsup idle mode quirks

[Tony Lindgren]

Some modules have idlemodes wired, but not completely functional. We have
quirks for SWSUP_SIDLE and SWSUP_SIDLE_ACT to manage interconnect target
modules without hardware support, but we've been only using them so far
in legacy mode. Let's add support for SWSUP quirks in non-legacy mode too.

Signed-off-by: Tony Lindgren <t...@atomide.com>
---
 drivers/bus/ti-sysc.c | 25 +++++++++++++++++--------
 1 file changed, 17 insertions(+), 8 deletions(-)

diff --git a/drivers/bus/ti-sysc.c b/drivers/bus/ti-sysc.c
--- a/drivers/bus/ti-sysc.c
+++ b/drivers/bus/ti-sysc.c
@@ -872,10 +872,15 @@ static int sysc_enable_module(struct device *dev)
        if (!idlemodes || regbits->sidle_shift < 0)
                goto set_midle;
 
-       best_mode = fls(ddata->cfg.sidlemodes) - 1;
-       if (best_mode > SYSC_IDLE_MASK) {
-               dev_err(dev, "%s: invalid sidlemode\n", __func__);
-               return -EINVAL;
+       if (ddata->cfg.quirks & (SYSC_QUIRK_SWSUP_SIDLE |
+                                SYSC_QUIRK_SWSUP_SIDLE_ACT)) {
+               best_mode = SYSC_IDLE_NO;
+       } else {
+               best_mode = fls(ddata->cfg.sidlemodes) - 1;
+               if (best_mode > SYSC_IDLE_MASK) {
+                       dev_err(dev, "%s: invalid sidlemode\n", __func__);
+                       return -EINVAL;
+               }
        }
 
        reg &= ~(SYSC_IDLE_MASK << regbits->sidle_shift);
@@ -959,10 +964,14 @@ static int sysc_disable_module(struct device *dev)
        if (!idlemodes || regbits->sidle_shift < 0)
                return 0;
 
-       ret = sysc_best_idle_mode(idlemodes, &best_mode);
-       if (ret) {
-               dev_err(dev, "%s: invalid sidlemode\n", __func__);
-               return ret;
+       if (ddata->cfg.quirks & SYSC_QUIRK_SWSUP_SIDLE) {
+               best_mode = SYSC_IDLE_FORCE;
+       } else {
+               ret = sysc_best_idle_mode(idlemodes, &best_mode);
+               if (ret) {
+                       dev_err(dev, "%s: invalid sidlemode\n", __func__);
+                       return ret;
+               }
        }
 
        reg &= ~(SYSC_IDLE_MASK << regbits->sidle_shift);
-- 
2.21.0