soc: mediatek: introduce a CAPS flag for scp_domain_data

[linux.git] / drivers / soc / mediatek / mtk-scpsys.c

diff --git a/drivers/soc/mediatek/mtk-scpsys.c b/drivers/soc/mediatek/mtk-scpsys.c
index d762a46d434fc8c99be832d6938dbb8d9bf55768..b1b45e44c7adcf906e33318ef038896c79b29cf5 100644 (file)
--- a/drivers/soc/mediatek/mtk-scpsys.c
+++ b/drivers/soc/mediatek/mtk-scpsys.c
@@ -13,6 +13,7 @@
 #include <linux/clk.h>
 #include <linux/init.h>
 #include <linux/io.h>
+#include <linux/iopoll.h>
 #include <linux/mfd/syscon.h>
 #include <linux/of_device.h>
 #include <linux/platform_device.h>
@@ -27,6 +28,12 @@
 #include <dt-bindings/power/mt7623a-power.h>
 #include <dt-bindings/power/mt8173-power.h>
 
+#define MTK_POLL_DELAY_US   10
+#define MTK_POLL_TIMEOUT    (jiffies_to_usecs(HZ))
+
+#define MTK_SCPD_ACTIVE_WAKEUP         BIT(0)
+#define MTK_SCPD_CAPS(_scpd, _x)       ((_scpd)->data->caps & (_x))
+
 #define SPM_VDE_PWR_CON                        0x0210
 #define SPM_MFG_PWR_CON                        0x0214
 #define SPM_VEN_PWR_CON                        0x0230
@@ -116,7 +123,7 @@ struct scp_domain_data {
        u32 sram_pdn_ack_bits;
        u32 bus_prot_mask;
        enum clk_id clk_id[MAX_CLKS];
-       bool active_wakeup;
+       u8 caps;
 };
 
 struct scp;
@@ -184,12 +191,10 @@ static int scpsys_power_on(struct generic_pm_domain *genpd)
 {
        struct scp_domain *scpd = container_of(genpd, struct scp_domain, genpd);
        struct scp *scp = scpd->scp;
-       unsigned long timeout;
-       bool expired;
        void __iomem *ctl_addr = scp->base + scpd->data->ctl_offs;
-       u32 sram_pdn_ack = scpd->data->sram_pdn_ack_bits;
+       u32 pdn_ack = scpd->data->sram_pdn_ack_bits;
        u32 val;
-       int ret;
+       int ret, tmp;
        int i;
 
        if (scpd->supply) {
@@ -215,23 +220,10 @@ static int scpsys_power_on(struct generic_pm_domain *genpd)
        writel(val, ctl_addr);
 
        /* wait until PWR_ACK = 1 */
-       timeout = jiffies + HZ;
-       expired = false;
-       while (1) {
-               ret = scpsys_domain_is_on(scpd);
-               if (ret > 0)
-                       break;
-
-               if (expired) {
-                       ret = -ETIMEDOUT;
-                       goto err_pwr_ack;
-               }
-
-               cpu_relax();
-
-               if (time_after(jiffies, timeout))
-                       expired = true;
-       }
+       ret = readx_poll_timeout(scpsys_domain_is_on, scpd, tmp, tmp > 0,
+                                MTK_POLL_DELAY_US, MTK_POLL_TIMEOUT);
+       if (ret < 0)
+               goto err_pwr_ack;
 
        val &= ~PWR_CLK_DIS_BIT;
        writel(val, ctl_addr);
@@ -246,20 +238,10 @@ static int scpsys_power_on(struct generic_pm_domain *genpd)
        writel(val, ctl_addr);
 
        /* wait until SRAM_PDN_ACK all 0 */
-       timeout = jiffies + HZ;
-       expired = false;
-       while (sram_pdn_ack && (readl(ctl_addr) & sram_pdn_ack)) {
-
-               if (expired) {
-                       ret = -ETIMEDOUT;
-                       goto err_pwr_ack;
-               }
-
-               cpu_relax();
-
-               if (time_after(jiffies, timeout))
-                       expired = true;
-       }
+       ret = readl_poll_timeout(ctl_addr, tmp, (tmp & pdn_ack) == 0,
+                                MTK_POLL_DELAY_US, MTK_POLL_TIMEOUT);
+       if (ret < 0)
+               goto err_pwr_ack;
 
        if (scpd->data->bus_prot_mask) {
                ret = mtk_infracfg_clear_bus_protection(scp->infracfg,
@@ -289,12 +271,10 @@ static int scpsys_power_off(struct generic_pm_domain *genpd)
 {
        struct scp_domain *scpd = container_of(genpd, struct scp_domain, genpd);
        struct scp *scp = scpd->scp;
-       unsigned long timeout;
-       bool expired;
        void __iomem *ctl_addr = scp->base + scpd->data->ctl_offs;
        u32 pdn_ack = scpd->data->sram_pdn_ack_bits;
        u32 val;
-       int ret;
+       int ret, tmp;
        int i;
 
        if (scpd->data->bus_prot_mask) {
@@ -310,19 +290,10 @@ static int scpsys_power_off(struct generic_pm_domain *genpd)
        writel(val, ctl_addr);
 
        /* wait until SRAM_PDN_ACK all 1 */
-       timeout = jiffies + HZ;
-       expired = false;
-       while (pdn_ack && (readl(ctl_addr) & pdn_ack) != pdn_ack) {
-               if (expired) {
-                       ret = -ETIMEDOUT;
-                       goto out;
-               }
-
-               cpu_relax();
-
-               if (time_after(jiffies, timeout))
-                       expired = true;
-       }
+       ret = readl_poll_timeout(ctl_addr, tmp, (tmp & pdn_ack) == pdn_ack,
+                                MTK_POLL_DELAY_US, MTK_POLL_TIMEOUT);
+       if (ret < 0)
+               goto out;
 
        val |= PWR_ISO_BIT;
        writel(val, ctl_addr);
@@ -340,23 +311,10 @@ static int scpsys_power_off(struct generic_pm_domain *genpd)
        writel(val, ctl_addr);
 
        /* wait until PWR_ACK = 0 */
-       timeout = jiffies + HZ;
-       expired = false;
-       while (1) {
-               ret = scpsys_domain_is_on(scpd);
-               if (ret == 0)
-                       break;
-
-               if (expired) {
-                       ret = -ETIMEDOUT;
-                       goto out;
-               }
-
-               cpu_relax();
-
-               if (time_after(jiffies, timeout))
-                       expired = true;
-       }
+       ret = readx_poll_timeout(scpsys_domain_is_on, scpd, tmp, tmp == 0,
+                                MTK_POLL_DELAY_US, MTK_POLL_TIMEOUT);
+       if (ret < 0)
+               goto out;
 
        for (i = 0; i < MAX_CLKS && scpd->clk[i]; i++)
                clk_disable_unprepare(scpd->clk[i]);
@@ -469,7 +427,7 @@ static struct scp *init_scp(struct platform_device *pdev,
                genpd->name = data->name;
                genpd->power_off = scpsys_power_off;
                genpd->power_on = scpsys_power_on;
-               if (scpd->data->active_wakeup)
+               if (MTK_SCPD_CAPS(scpd, MTK_SCPD_ACTIVE_WAKEUP))
                        genpd->flags |= GENPD_FLAG_ACTIVE_WAKEUP;
        }
 
@@ -522,7 +480,7 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .bus_prot_mask = MT2701_TOP_AXI_PROT_EN_CONN_M |
                                 MT2701_TOP_AXI_PROT_EN_CONN_S,
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_DISP] = {
                .name = "disp",
@@ -531,7 +489,7 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .clk_id = {CLK_MM},
                .bus_prot_mask = MT2701_TOP_AXI_PROT_EN_MM_M0,
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_MFG] = {
                .name = "mfg",
@@ -540,7 +498,7 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(12, 12),
                .clk_id = {CLK_MFG},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_VDEC] = {
                .name = "vdec",
@@ -549,7 +507,7 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(12, 12),
                .clk_id = {CLK_MM},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_ISP] = {
                .name = "isp",
@@ -558,7 +516,7 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(13, 12),
                .clk_id = {CLK_MM},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_BDP] = {
                .name = "bdp",
@@ -566,7 +524,7 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .ctl_offs = SPM_BDP_PWR_CON,
                .sram_pdn_bits = GENMASK(11, 8),
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_ETH] = {
                .name = "eth",
@@ -575,7 +533,7 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_ETHIF},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_HIF] = {
                .name = "hif",
@@ -584,14 +542,14 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_ETHIF},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2701_POWER_DOMAIN_IFR_MSC] = {
                .name = "ifr_msc",
                .sta_mask = PWR_STATUS_IFR_MSC,
                .ctl_offs = SPM_IFR_MSC_PWR_CON,
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
 };
 
@@ -606,7 +564,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(8, 8),
                .sram_pdn_ack_bits = GENMASK(12, 12),
                .clk_id = {CLK_MM},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_VDEC] = {
                .name = "vdec",
@@ -615,7 +573,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(8, 8),
                .sram_pdn_ack_bits = GENMASK(12, 12),
                .clk_id = {CLK_MM, CLK_VDEC},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_VENC] = {
                .name = "venc",
@@ -624,7 +582,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_MM, CLK_VENC, CLK_JPGDEC},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_ISP] = {
                .name = "isp",
@@ -633,7 +591,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(13, 12),
                .clk_id = {CLK_MM},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_AUDIO] = {
                .name = "audio",
@@ -642,7 +600,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_AUDIO},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_USB] = {
                .name = "usb",
@@ -651,7 +609,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(10, 8),
                .sram_pdn_ack_bits = GENMASK(14, 12),
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_USB2] = {
                .name = "usb2",
@@ -660,7 +618,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(10, 8),
                .sram_pdn_ack_bits = GENMASK(14, 12),
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_MFG] = {
                .name = "mfg",
@@ -670,7 +628,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_ack_bits = GENMASK(16, 16),
                .clk_id = {CLK_MFG},
                .bus_prot_mask = BIT(14) | BIT(21) | BIT(23),
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_MFG_SC1] = {
                .name = "mfg_sc1",
@@ -679,7 +637,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(8, 8),
                .sram_pdn_ack_bits = GENMASK(16, 16),
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_MFG_SC2] = {
                .name = "mfg_sc2",
@@ -688,7 +646,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(8, 8),
                .sram_pdn_ack_bits = GENMASK(16, 16),
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT2712_POWER_DOMAIN_MFG_SC3] = {
                .name = "mfg_sc3",
@@ -697,7 +655,7 @@ static const struct scp_domain_data scp_domain_data_mt2712[] = {
                .sram_pdn_bits = GENMASK(8, 8),
                .sram_pdn_ack_bits = GENMASK(16, 16),
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
 };
 
@@ -797,7 +755,7 @@ static const struct scp_domain_data scp_domain_data_mt7622[] = {
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_NONE},
                .bus_prot_mask = MT7622_TOP_AXI_PROT_EN_ETHSYS,
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT7622_POWER_DOMAIN_HIF0] = {
                .name = "hif0",
@@ -807,7 +765,7 @@ static const struct scp_domain_data scp_domain_data_mt7622[] = {
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_HIFSEL},
                .bus_prot_mask = MT7622_TOP_AXI_PROT_EN_HIF0,
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT7622_POWER_DOMAIN_HIF1] = {
                .name = "hif1",
@@ -817,7 +775,7 @@ static const struct scp_domain_data scp_domain_data_mt7622[] = {
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_HIFSEL},
                .bus_prot_mask = MT7622_TOP_AXI_PROT_EN_HIF1,
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT7622_POWER_DOMAIN_WB] = {
                .name = "wb",
@@ -827,7 +785,7 @@ static const struct scp_domain_data scp_domain_data_mt7622[] = {
                .sram_pdn_ack_bits = 0,
                .clk_id = {CLK_NONE},
                .bus_prot_mask = MT7622_TOP_AXI_PROT_EN_WB,
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
 };
 
@@ -843,7 +801,7 @@ static const struct scp_domain_data scp_domain_data_mt7623a[] = {
                .bus_prot_mask = MT2701_TOP_AXI_PROT_EN_CONN_M |
                                 MT2701_TOP_AXI_PROT_EN_CONN_S,
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT7623A_POWER_DOMAIN_ETH] = {
                .name = "eth",
@@ -852,7 +810,7 @@ static const struct scp_domain_data scp_domain_data_mt7623a[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_ETHIF},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT7623A_POWER_DOMAIN_HIF] = {
                .name = "hif",
@@ -861,14 +819,14 @@ static const struct scp_domain_data scp_domain_data_mt7623a[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_ETHIF},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT7623A_POWER_DOMAIN_IFR_MSC] = {
                .name = "ifr_msc",
                .sta_mask = PWR_STATUS_IFR_MSC,
                .ctl_offs = SPM_IFR_MSC_PWR_CON,
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
 };
 
@@ -934,7 +892,7 @@ static const struct scp_domain_data scp_domain_data_mt8173[] = {
                .sram_pdn_bits = GENMASK(11, 8),
                .sram_pdn_ack_bits = GENMASK(15, 12),
                .clk_id = {CLK_NONE},
-               .active_wakeup = true,
+               .caps = MTK_SCPD_ACTIVE_WAKEUP,
        },
        [MT8173_POWER_DOMAIN_MFG_ASYNC] = {
                .name = "mfg_async",
@@ -1067,15 +1025,13 @@ static const struct of_device_id of_scpsys_match_tbl[] = {
 
 static int scpsys_probe(struct platform_device *pdev)
 {
-       const struct of_device_id *match;
        const struct scp_subdomain *sd;
        const struct scp_soc_data *soc;
        struct scp *scp;
        struct genpd_onecell_data *pd_data;
        int i, ret;
 
-       match = of_match_device(of_scpsys_match_tbl, &pdev->dev);
-       soc = (const struct scp_soc_data *)match->data;
+       soc = of_device_get_match_data(&pdev->dev);
 
        scp = init_scp(pdev, soc->domains, soc->num_domains, &soc->regs,
                        soc->bus_prot_reg_update);