|
@@ -21,6 +21,7 @@
|
|
|
#include <linux/soc/mediatek/infracfg.h>
|
|
|
|
|
|
#include <dt-bindings/power/mt2701-power.h>
|
|
|
+#include <dt-bindings/power/mt6797-power.h>
|
|
|
#include <dt-bindings/power/mt8173-power.h>
|
|
|
|
|
|
#define SPM_VDE_PWR_CON 0x0210
|
|
@@ -71,6 +72,7 @@ enum clk_id {
|
|
|
CLK_VENC,
|
|
|
CLK_VENC_LT,
|
|
|
CLK_ETHIF,
|
|
|
+ CLK_VDEC,
|
|
|
CLK_MAX,
|
|
|
};
|
|
|
|
|
@@ -81,6 +83,7 @@ static const char * const clk_names[] = {
|
|
|
"venc",
|
|
|
"venc_lt",
|
|
|
"ethif",
|
|
|
+ "vdec",
|
|
|
NULL,
|
|
|
};
|
|
|
|
|
@@ -107,21 +110,28 @@ struct scp_domain {
|
|
|
struct regulator *supply;
|
|
|
};
|
|
|
|
|
|
+struct scp_ctrl_reg {
|
|
|
+ int pwr_sta_offs;
|
|
|
+ int pwr_sta2nd_offs;
|
|
|
+};
|
|
|
+
|
|
|
struct scp {
|
|
|
struct scp_domain *domains;
|
|
|
struct genpd_onecell_data pd_data;
|
|
|
struct device *dev;
|
|
|
void __iomem *base;
|
|
|
struct regmap *infracfg;
|
|
|
+ struct scp_ctrl_reg ctrl_reg;
|
|
|
};
|
|
|
|
|
|
static int scpsys_domain_is_on(struct scp_domain *scpd)
|
|
|
{
|
|
|
struct scp *scp = scpd->scp;
|
|
|
|
|
|
- u32 status = readl(scp->base + SPM_PWR_STATUS) & scpd->data->sta_mask;
|
|
|
- u32 status2 = readl(scp->base + SPM_PWR_STATUS_2ND) &
|
|
|
- scpd->data->sta_mask;
|
|
|
+ u32 status = readl(scp->base + scp->ctrl_reg.pwr_sta_offs) &
|
|
|
+ scpd->data->sta_mask;
|
|
|
+ u32 status2 = readl(scp->base + scp->ctrl_reg.pwr_sta2nd_offs) &
|
|
|
+ scpd->data->sta_mask;
|
|
|
|
|
|
/*
|
|
|
* A domain is on when both status bits are set. If only one is set
|
|
@@ -346,7 +356,8 @@ static void init_clks(struct platform_device *pdev, struct clk **clk)
|
|
|
}
|
|
|
|
|
|
static struct scp *init_scp(struct platform_device *pdev,
|
|
|
- const struct scp_domain_data *scp_domain_data, int num)
|
|
|
+ const struct scp_domain_data *scp_domain_data, int num,
|
|
|
+ struct scp_ctrl_reg *scp_ctrl_reg)
|
|
|
{
|
|
|
struct genpd_onecell_data *pd_data;
|
|
|
struct resource *res;
|
|
@@ -358,6 +369,9 @@ static struct scp *init_scp(struct platform_device *pdev,
|
|
|
if (!scp)
|
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
|
|
+ scp->ctrl_reg.pwr_sta_offs = scp_ctrl_reg->pwr_sta_offs;
|
|
|
+ scp->ctrl_reg.pwr_sta2nd_offs = scp_ctrl_reg->pwr_sta2nd_offs;
|
|
|
+
|
|
|
scp->dev = &pdev->dev;
|
|
|
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
@@ -556,8 +570,13 @@ static const struct scp_domain_data scp_domain_data_mt2701[] = {
|
|
|
static int __init scpsys_probe_mt2701(struct platform_device *pdev)
|
|
|
{
|
|
|
struct scp *scp;
|
|
|
+ struct scp_ctrl_reg scp_reg;
|
|
|
|
|
|
- scp = init_scp(pdev, scp_domain_data_mt2701, NUM_DOMAINS_MT2701);
|
|
|
+ scp_reg.pwr_sta_offs = SPM_PWR_STATUS;
|
|
|
+ scp_reg.pwr_sta2nd_offs = SPM_PWR_STATUS_2ND;
|
|
|
+
|
|
|
+ scp = init_scp(pdev, scp_domain_data_mt2701, NUM_DOMAINS_MT2701,
|
|
|
+ &scp_reg);
|
|
|
if (IS_ERR(scp))
|
|
|
return PTR_ERR(scp);
|
|
|
|
|
@@ -566,6 +585,116 @@ static int __init scpsys_probe_mt2701(struct platform_device *pdev)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+/*
|
|
|
+ * MT6797 power domain support
|
|
|
+ */
|
|
|
+
|
|
|
+static const struct scp_domain_data scp_domain_data_mt6797[] = {
|
|
|
+ [MT6797_POWER_DOMAIN_VDEC] = {
|
|
|
+ .name = "vdec",
|
|
|
+ .sta_mask = BIT(7),
|
|
|
+ .ctl_offs = 0x300,
|
|
|
+ .sram_pdn_bits = GENMASK(8, 8),
|
|
|
+ .sram_pdn_ack_bits = GENMASK(12, 12),
|
|
|
+ .clk_id = {CLK_VDEC},
|
|
|
+ },
|
|
|
+ [MT6797_POWER_DOMAIN_VENC] = {
|
|
|
+ .name = "venc",
|
|
|
+ .sta_mask = BIT(21),
|
|
|
+ .ctl_offs = 0x304,
|
|
|
+ .sram_pdn_bits = GENMASK(11, 8),
|
|
|
+ .sram_pdn_ack_bits = GENMASK(15, 12),
|
|
|
+ .clk_id = {CLK_NONE},
|
|
|
+ },
|
|
|
+ [MT6797_POWER_DOMAIN_ISP] = {
|
|
|
+ .name = "isp",
|
|
|
+ .sta_mask = BIT(5),
|
|
|
+ .ctl_offs = 0x308,
|
|
|
+ .sram_pdn_bits = GENMASK(9, 8),
|
|
|
+ .sram_pdn_ack_bits = GENMASK(13, 12),
|
|
|
+ .clk_id = {CLK_NONE},
|
|
|
+ },
|
|
|
+ [MT6797_POWER_DOMAIN_MM] = {
|
|
|
+ .name = "mm",
|
|
|
+ .sta_mask = BIT(3),
|
|
|
+ .ctl_offs = 0x30C,
|
|
|
+ .sram_pdn_bits = GENMASK(8, 8),
|
|
|
+ .sram_pdn_ack_bits = GENMASK(12, 12),
|
|
|
+ .clk_id = {CLK_MM},
|
|
|
+ .bus_prot_mask = (BIT(1) | BIT(2)),
|
|
|
+ },
|
|
|
+ [MT6797_POWER_DOMAIN_AUDIO] = {
|
|
|
+ .name = "audio",
|
|
|
+ .sta_mask = BIT(24),
|
|
|
+ .ctl_offs = 0x314,
|
|
|
+ .sram_pdn_bits = GENMASK(11, 8),
|
|
|
+ .sram_pdn_ack_bits = GENMASK(15, 12),
|
|
|
+ .clk_id = {CLK_NONE},
|
|
|
+ },
|
|
|
+ [MT6797_POWER_DOMAIN_MFG_ASYNC] = {
|
|
|
+ .name = "mfg_async",
|
|
|
+ .sta_mask = BIT(13),
|
|
|
+ .ctl_offs = 0x334,
|
|
|
+ .sram_pdn_bits = 0,
|
|
|
+ .sram_pdn_ack_bits = 0,
|
|
|
+ .clk_id = {CLK_MFG},
|
|
|
+ },
|
|
|
+ [MT6797_POWER_DOMAIN_MJC] = {
|
|
|
+ .name = "mjc",
|
|
|
+ .sta_mask = BIT(20),
|
|
|
+ .ctl_offs = 0x310,
|
|
|
+ .sram_pdn_bits = GENMASK(8, 8),
|
|
|
+ .sram_pdn_ack_bits = GENMASK(12, 12),
|
|
|
+ .clk_id = {CLK_NONE},
|
|
|
+ },
|
|
|
+};
|
|
|
+
|
|
|
+#define NUM_DOMAINS_MT6797 ARRAY_SIZE(scp_domain_data_mt6797)
|
|
|
+#define SPM_PWR_STATUS_MT6797 0x0180
|
|
|
+#define SPM_PWR_STATUS_2ND_MT6797 0x0184
|
|
|
+
|
|
|
+static int __init scpsys_probe_mt6797(struct platform_device *pdev)
|
|
|
+{
|
|
|
+ struct scp *scp;
|
|
|
+ struct genpd_onecell_data *pd_data;
|
|
|
+ int ret;
|
|
|
+ struct scp_ctrl_reg scp_reg;
|
|
|
+
|
|
|
+ scp_reg.pwr_sta_offs = SPM_PWR_STATUS_MT6797;
|
|
|
+ scp_reg.pwr_sta2nd_offs = SPM_PWR_STATUS_2ND_MT6797;
|
|
|
+
|
|
|
+ scp = init_scp(pdev, scp_domain_data_mt6797, NUM_DOMAINS_MT6797,
|
|
|
+ &scp_reg);
|
|
|
+ if (IS_ERR(scp))
|
|
|
+ return PTR_ERR(scp);
|
|
|
+
|
|
|
+ mtk_register_power_domains(pdev, scp, NUM_DOMAINS_MT6797);
|
|
|
+
|
|
|
+ pd_data = &scp->pd_data;
|
|
|
+
|
|
|
+ ret = pm_genpd_add_subdomain(pd_data->domains[MT6797_POWER_DOMAIN_MM],
|
|
|
+ pd_data->domains[MT6797_POWER_DOMAIN_VDEC]);
|
|
|
+ if (ret && IS_ENABLED(CONFIG_PM))
|
|
|
+ dev_err(&pdev->dev, "Failed to add subdomain: %d\n", ret);
|
|
|
+
|
|
|
+ ret = pm_genpd_add_subdomain(pd_data->domains[MT6797_POWER_DOMAIN_MM],
|
|
|
+ pd_data->domains[MT6797_POWER_DOMAIN_ISP]);
|
|
|
+ if (ret && IS_ENABLED(CONFIG_PM))
|
|
|
+ dev_err(&pdev->dev, "Failed to add subdomain: %d\n", ret);
|
|
|
+
|
|
|
+ ret = pm_genpd_add_subdomain(pd_data->domains[MT6797_POWER_DOMAIN_MM],
|
|
|
+ pd_data->domains[MT6797_POWER_DOMAIN_VENC]);
|
|
|
+ if (ret && IS_ENABLED(CONFIG_PM))
|
|
|
+ dev_err(&pdev->dev, "Failed to add subdomain: %d\n", ret);
|
|
|
+
|
|
|
+ ret = pm_genpd_add_subdomain(pd_data->domains[MT6797_POWER_DOMAIN_MM],
|
|
|
+ pd_data->domains[MT6797_POWER_DOMAIN_MJC]);
|
|
|
+ if (ret && IS_ENABLED(CONFIG_PM))
|
|
|
+ dev_err(&pdev->dev, "Failed to add subdomain: %d\n", ret);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
/*
|
|
|
* MT8173 power domain support
|
|
|
*/
|
|
@@ -667,8 +796,13 @@ static int __init scpsys_probe_mt8173(struct platform_device *pdev)
|
|
|
struct scp *scp;
|
|
|
struct genpd_onecell_data *pd_data;
|
|
|
int ret;
|
|
|
+ struct scp_ctrl_reg scp_reg;
|
|
|
|
|
|
- scp = init_scp(pdev, scp_domain_data_mt8173, NUM_DOMAINS_MT8173);
|
|
|
+ scp_reg.pwr_sta_offs = SPM_PWR_STATUS;
|
|
|
+ scp_reg.pwr_sta2nd_offs = SPM_PWR_STATUS_2ND;
|
|
|
+
|
|
|
+ scp = init_scp(pdev, scp_domain_data_mt8173, NUM_DOMAINS_MT8173,
|
|
|
+ &scp_reg);
|
|
|
if (IS_ERR(scp))
|
|
|
return PTR_ERR(scp);
|
|
|
|
|
@@ -697,6 +831,9 @@ static const struct of_device_id of_scpsys_match_tbl[] = {
|
|
|
{
|
|
|
.compatible = "mediatek,mt2701-scpsys",
|
|
|
.data = scpsys_probe_mt2701,
|
|
|
+ }, {
|
|
|
+ .compatible = "mediatek,mt6797-scpsys",
|
|
|
+ .data = scpsys_probe_mt6797,
|
|
|
}, {
|
|
|
.compatible = "mediatek,mt8173-scpsys",
|
|
|
.data = scpsys_probe_mt8173,
|