Message ID | 20201026175526.2915399-5-enric.balletbo@collabora.com (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
Series | soc: mediatek: pm-domains: Add new driver for SCPSYS power domains controller | expand |
On Tue, Oct 27, 2020 at 1:55 AM Enric Balletbo i Serra <enric.balletbo@collabora.com> wrote: > > From: Matthias Brugger <mbrugger@suse.com> > > Bus protection will need to update more then one register > in infracfg. Add support for several operations. > > Signed-off-by: Matthias Brugger <mbrugger@suse.com> > Signed-off-by: Enric Balletbo i Serra <enric.balletbo@collabora.com> Reviewed-by: Nicolas Boichat <drinkcat@chromium.org> > --- > > Changes in v3: None > Changes in v2: None > > drivers/soc/mediatek/mt8173-pm-domains.h | 4 +-- > drivers/soc/mediatek/mtk-pm-domains.c | 36 +++++++++++++++++------- > drivers/soc/mediatek/mtk-pm-domains.h | 4 ++- > 3 files changed, 31 insertions(+), 13 deletions(-) > > diff --git a/drivers/soc/mediatek/mt8173-pm-domains.h b/drivers/soc/mediatek/mt8173-pm-domains.h > index a2a624bbd8b8..341cc287c8ce 100644 > --- a/drivers/soc/mediatek/mt8173-pm-domains.h > +++ b/drivers/soc/mediatek/mt8173-pm-domains.h > @@ -34,7 +34,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { > .ctl_offs = SPM_DIS_PWR_CON, > .sram_pdn_bits = GENMASK(11, 8), > .sram_pdn_ack_bits = GENMASK(12, 12), > - .bp_infracfg = { > + .bp_infracfg[0] = { > .bus_prot_reg_update = true, > .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MM_M0 | > MT8173_TOP_AXI_PROT_EN_MM_M1, > @@ -76,7 +76,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { > .ctl_offs = SPM_MFG_PWR_CON, > .sram_pdn_bits = GENMASK(13, 8), > .sram_pdn_ack_bits = GENMASK(21, 16), > - .bp_infracfg = { > + .bp_infracfg[0] = { > .bus_prot_reg_update = true, > .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MFG_S | > MT8173_TOP_AXI_PROT_EN_MFG_M0 | > diff --git a/drivers/soc/mediatek/mtk-pm-domains.c b/drivers/soc/mediatek/mtk-pm-domains.c > index 16503d6db6a8..2121e05cb9a4 100644 > --- a/drivers/soc/mediatek/mtk-pm-domains.c > +++ b/drivers/soc/mediatek/mtk-pm-domains.c > @@ -89,24 +89,40 @@ static int scpsys_sram_disable(struct scpsys_domain *pd) > > static int scpsys_bus_protect_enable(struct scpsys_domain *pd) > { > - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; > + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; > + int i, ret; > > - if (!bp_data->bus_prot_mask) > - return 0; > + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { > + if (!bpd[i].bus_prot_mask) > + break; > > - return mtk_infracfg_set_bus_protection(pd->infracfg, bp_data->bus_prot_mask, > - bp_data->bus_prot_reg_update); > + ret = mtk_infracfg_set_bus_protection(pd->infracfg, > + bpd[i].bus_prot_mask, > + bpd[i].bus_prot_reg_update); > + if (ret) > + return ret; > + } > + > + return 0; > } > > static int scpsys_bus_protect_disable(struct scpsys_domain *pd) > { > - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; > + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; > + int i, ret; > > - if (!bp_data->bus_prot_mask) > - return 0; > + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { > + if (!bpd[i].bus_prot_mask) > + return 0; > > - return mtk_infracfg_clear_bus_protection(pd->infracfg, bp_data->bus_prot_mask, > - bp_data->bus_prot_reg_update); > + ret = mtk_infracfg_clear_bus_protection(pd->infracfg, > + bpd[i].bus_prot_mask, > + bpd[i].bus_prot_reg_update); > + if (ret) > + return ret; > + } > + > + return 0; > } > > static int scpsys_power_on(struct generic_pm_domain *genpd) > diff --git a/drivers/soc/mediatek/mtk-pm-domains.h b/drivers/soc/mediatek/mtk-pm-domains.h > index 7c8efcb3cef2..e428fe23a7e3 100644 > --- a/drivers/soc/mediatek/mtk-pm-domains.h > +++ b/drivers/soc/mediatek/mtk-pm-domains.h > @@ -32,6 +32,8 @@ > #define PWR_STATUS_AUDIO BIT(24) > #define PWR_STATUS_USB BIT(25) > > +#define SPM_MAX_BUS_PROT_DATA 3 > + > struct scpsys_bus_prot_data { > u32 bus_prot_mask; > bool bus_prot_reg_update; > @@ -52,7 +54,7 @@ struct scpsys_domain_data { > u32 sram_pdn_bits; > u32 sram_pdn_ack_bits; > u8 caps; > - const struct scpsys_bus_prot_data bp_infracfg; > + const struct scpsys_bus_prot_data bp_infracfg[SPM_MAX_BUS_PROT_DATA]; > }; > > struct scpsys_soc_data { > -- > 2.28.0 >
On Mon, 2020-10-26 at 18:55 +0100, Enric Balletbo i Serra wrote: > From: Matthias Brugger <mbrugger@suse.com> > > Bus protection will need to update more then one register > in infracfg. Add support for several operations. > > Signed-off-by: Matthias Brugger <mbrugger@suse.com> > Signed-off-by: Enric Balletbo i Serra <enric.balletbo@collabora.com> > --- > > Changes in v3: None > Changes in v2: None > > drivers/soc/mediatek/mt8173-pm-domains.h | 4 +-- > drivers/soc/mediatek/mtk-pm-domains.c | 36 +++++++++++++++++------- > drivers/soc/mediatek/mtk-pm-domains.h | 4 ++- > 3 files changed, 31 insertions(+), 13 deletions(-) > > diff --git a/drivers/soc/mediatek/mt8173-pm-domains.h b/drivers/soc/mediatek/mt8173-pm-domains.h > index a2a624bbd8b8..341cc287c8ce 100644 > --- a/drivers/soc/mediatek/mt8173-pm-domains.h > +++ b/drivers/soc/mediatek/mt8173-pm-domains.h > @@ -34,7 +34,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { > .ctl_offs = SPM_DIS_PWR_CON, > .sram_pdn_bits = GENMASK(11, 8), > .sram_pdn_ack_bits = GENMASK(12, 12), > - .bp_infracfg = { > + .bp_infracfg[0] = { > .bus_prot_reg_update = true, > .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MM_M0 | > MT8173_TOP_AXI_PROT_EN_MM_M1, > @@ -76,7 +76,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { > .ctl_offs = SPM_MFG_PWR_CON, > .sram_pdn_bits = GENMASK(13, 8), > .sram_pdn_ack_bits = GENMASK(21, 16), > - .bp_infracfg = { > + .bp_infracfg[0] = { > .bus_prot_reg_update = true, > .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MFG_S | > MT8173_TOP_AXI_PROT_EN_MFG_M0 | > diff --git a/drivers/soc/mediatek/mtk-pm-domains.c b/drivers/soc/mediatek/mtk-pm-domains.c > index 16503d6db6a8..2121e05cb9a4 100644 > --- a/drivers/soc/mediatek/mtk-pm-domains.c > +++ b/drivers/soc/mediatek/mtk-pm-domains.c > @@ -89,24 +89,40 @@ static int scpsys_sram_disable(struct scpsys_domain *pd) > > static int scpsys_bus_protect_enable(struct scpsys_domain *pd) > { > - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; > + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; > + int i, ret; > > - if (!bp_data->bus_prot_mask) > - return 0; > + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { > + if (!bpd[i].bus_prot_mask) > + break; > > - return mtk_infracfg_set_bus_protection(pd->infracfg, bp_data->bus_prot_mask, > - bp_data->bus_prot_reg_update); > + ret = mtk_infracfg_set_bus_protection(pd->infracfg, > + bpd[i].bus_prot_mask, > + bpd[i].bus_prot_reg_update); > + if (ret) > + return ret; > + } > + > + return 0; > } > > static int scpsys_bus_protect_disable(struct scpsys_domain *pd) > { > - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; > + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; > + int i, ret; > > - if (!bp_data->bus_prot_mask) > - return 0; > + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { I thought it should be for (i = SPM_MAX_BUS_PROT_DATA - 1; i > 0; i--) { if (!bpd[i].bus_prot_mask) continue; ... > + if (!bpd[i].bus_prot_mask) > + return 0; > > - return mtk_infracfg_clear_bus_protection(pd->infracfg, bp_data->bus_prot_mask, > - bp_data->bus_prot_reg_update); > + ret = mtk_infracfg_clear_bus_protection(pd->infracfg, > + bpd[i].bus_prot_mask, > + bpd[i].bus_prot_reg_update); > + if (ret) > + return ret; > + } > + > + return 0; > } > > static int scpsys_power_on(struct generic_pm_domain *genpd) > diff --git a/drivers/soc/mediatek/mtk-pm-domains.h b/drivers/soc/mediatek/mtk-pm-domains.h > index 7c8efcb3cef2..e428fe23a7e3 100644 > --- a/drivers/soc/mediatek/mtk-pm-domains.h > +++ b/drivers/soc/mediatek/mtk-pm-domains.h > @@ -32,6 +32,8 @@ > #define PWR_STATUS_AUDIO BIT(24) > #define PWR_STATUS_USB BIT(25) > > +#define SPM_MAX_BUS_PROT_DATA 3 > + #define SPM_MAX_BUS_PROT_DATA 5 to be compatible with MT8192 > struct scpsys_bus_prot_data { > u32 bus_prot_mask; > bool bus_prot_reg_update; > @@ -52,7 +54,7 @@ struct scpsys_domain_data { > u32 sram_pdn_bits; > u32 sram_pdn_ack_bits; > u8 caps; > - const struct scpsys_bus_prot_data bp_infracfg; > + const struct scpsys_bus_prot_data bp_infracfg[SPM_MAX_BUS_PROT_DATA]; > }; > > struct scpsys_soc_data {
Hi Weiyi Lu, Many thanks for your comments. On 27/10/20 12:07, Weiyi Lu wrote: > On Mon, 2020-10-26 at 18:55 +0100, Enric Balletbo i Serra wrote: >> From: Matthias Brugger <mbrugger@suse.com> >> >> Bus protection will need to update more then one register >> in infracfg. Add support for several operations. >> >> Signed-off-by: Matthias Brugger <mbrugger@suse.com> >> Signed-off-by: Enric Balletbo i Serra <enric.balletbo@collabora.com> >> --- >> >> Changes in v3: None >> Changes in v2: None >> >> drivers/soc/mediatek/mt8173-pm-domains.h | 4 +-- >> drivers/soc/mediatek/mtk-pm-domains.c | 36 +++++++++++++++++------- >> drivers/soc/mediatek/mtk-pm-domains.h | 4 ++- >> 3 files changed, 31 insertions(+), 13 deletions(-) >> >> diff --git a/drivers/soc/mediatek/mt8173-pm-domains.h b/drivers/soc/mediatek/mt8173-pm-domains.h >> index a2a624bbd8b8..341cc287c8ce 100644 >> --- a/drivers/soc/mediatek/mt8173-pm-domains.h >> +++ b/drivers/soc/mediatek/mt8173-pm-domains.h >> @@ -34,7 +34,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { >> .ctl_offs = SPM_DIS_PWR_CON, >> .sram_pdn_bits = GENMASK(11, 8), >> .sram_pdn_ack_bits = GENMASK(12, 12), >> - .bp_infracfg = { >> + .bp_infracfg[0] = { >> .bus_prot_reg_update = true, >> .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MM_M0 | >> MT8173_TOP_AXI_PROT_EN_MM_M1, >> @@ -76,7 +76,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { >> .ctl_offs = SPM_MFG_PWR_CON, >> .sram_pdn_bits = GENMASK(13, 8), >> .sram_pdn_ack_bits = GENMASK(21, 16), >> - .bp_infracfg = { >> + .bp_infracfg[0] = { >> .bus_prot_reg_update = true, >> .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MFG_S | >> MT8173_TOP_AXI_PROT_EN_MFG_M0 | >> diff --git a/drivers/soc/mediatek/mtk-pm-domains.c b/drivers/soc/mediatek/mtk-pm-domains.c >> index 16503d6db6a8..2121e05cb9a4 100644 >> --- a/drivers/soc/mediatek/mtk-pm-domains.c >> +++ b/drivers/soc/mediatek/mtk-pm-domains.c >> @@ -89,24 +89,40 @@ static int scpsys_sram_disable(struct scpsys_domain *pd) >> >> static int scpsys_bus_protect_enable(struct scpsys_domain *pd) >> { >> - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; >> + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; >> + int i, ret; >> >> - if (!bp_data->bus_prot_mask) >> - return 0; >> + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { >> + if (!bpd[i].bus_prot_mask) >> + break; >> >> - return mtk_infracfg_set_bus_protection(pd->infracfg, bp_data->bus_prot_mask, >> - bp_data->bus_prot_reg_update); >> + ret = mtk_infracfg_set_bus_protection(pd->infracfg, >> + bpd[i].bus_prot_mask, >> + bpd[i].bus_prot_reg_update); >> + if (ret) >> + return ret; >> + } >> + >> + return 0; >> } >> >> static int scpsys_bus_protect_disable(struct scpsys_domain *pd) >> { >> - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; >> + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; >> + int i, ret; >> >> - if (!bp_data->bus_prot_mask) >> - return 0; >> + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { > > I thought it should be > > for (i = SPM_MAX_BUS_PROT_DATA - 1; i > 0; i--) { > if (!bpd[i].bus_prot_mask) > continue; > Done. > ... > >> + if (!bpd[i].bus_prot_mask) >> + return 0; >> >> - return mtk_infracfg_clear_bus_protection(pd->infracfg, bp_data->bus_prot_mask, >> - bp_data->bus_prot_reg_update); >> + ret = mtk_infracfg_clear_bus_protection(pd->infracfg, >> + bpd[i].bus_prot_mask, >> + bpd[i].bus_prot_reg_update); >> + if (ret) >> + return ret; >> + } >> + >> + return 0; >> } >> >> static int scpsys_power_on(struct generic_pm_domain *genpd) >> diff --git a/drivers/soc/mediatek/mtk-pm-domains.h b/drivers/soc/mediatek/mtk-pm-domains.h >> index 7c8efcb3cef2..e428fe23a7e3 100644 >> --- a/drivers/soc/mediatek/mtk-pm-domains.h >> +++ b/drivers/soc/mediatek/mtk-pm-domains.h >> @@ -32,6 +32,8 @@ >> #define PWR_STATUS_AUDIO BIT(24) >> #define PWR_STATUS_USB BIT(25) >> >> +#define SPM_MAX_BUS_PROT_DATA 3 >> + > > #define SPM_MAX_BUS_PROT_DATA 5 > > to be compatible with MT8192 > Done. >> struct scpsys_bus_prot_data { >> u32 bus_prot_mask; >> bool bus_prot_reg_update; >> @@ -52,7 +54,7 @@ struct scpsys_domain_data { >> u32 sram_pdn_bits; >> u32 sram_pdn_ack_bits; >> u8 caps; >> - const struct scpsys_bus_prot_data bp_infracfg; >> + const struct scpsys_bus_prot_data bp_infracfg[SPM_MAX_BUS_PROT_DATA]; >> }; >> >> struct scpsys_soc_data { >
diff --git a/drivers/soc/mediatek/mt8173-pm-domains.h b/drivers/soc/mediatek/mt8173-pm-domains.h index a2a624bbd8b8..341cc287c8ce 100644 --- a/drivers/soc/mediatek/mt8173-pm-domains.h +++ b/drivers/soc/mediatek/mt8173-pm-domains.h @@ -34,7 +34,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { .ctl_offs = SPM_DIS_PWR_CON, .sram_pdn_bits = GENMASK(11, 8), .sram_pdn_ack_bits = GENMASK(12, 12), - .bp_infracfg = { + .bp_infracfg[0] = { .bus_prot_reg_update = true, .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MM_M0 | MT8173_TOP_AXI_PROT_EN_MM_M1, @@ -76,7 +76,7 @@ static const struct scpsys_domain_data scpsys_domain_data_mt8173[] = { .ctl_offs = SPM_MFG_PWR_CON, .sram_pdn_bits = GENMASK(13, 8), .sram_pdn_ack_bits = GENMASK(21, 16), - .bp_infracfg = { + .bp_infracfg[0] = { .bus_prot_reg_update = true, .bus_prot_mask = MT8173_TOP_AXI_PROT_EN_MFG_S | MT8173_TOP_AXI_PROT_EN_MFG_M0 | diff --git a/drivers/soc/mediatek/mtk-pm-domains.c b/drivers/soc/mediatek/mtk-pm-domains.c index 16503d6db6a8..2121e05cb9a4 100644 --- a/drivers/soc/mediatek/mtk-pm-domains.c +++ b/drivers/soc/mediatek/mtk-pm-domains.c @@ -89,24 +89,40 @@ static int scpsys_sram_disable(struct scpsys_domain *pd) static int scpsys_bus_protect_enable(struct scpsys_domain *pd) { - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; + int i, ret; - if (!bp_data->bus_prot_mask) - return 0; + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { + if (!bpd[i].bus_prot_mask) + break; - return mtk_infracfg_set_bus_protection(pd->infracfg, bp_data->bus_prot_mask, - bp_data->bus_prot_reg_update); + ret = mtk_infracfg_set_bus_protection(pd->infracfg, + bpd[i].bus_prot_mask, + bpd[i].bus_prot_reg_update); + if (ret) + return ret; + } + + return 0; } static int scpsys_bus_protect_disable(struct scpsys_domain *pd) { - const struct scpsys_bus_prot_data *bp_data = &pd->data->bp_infracfg; + const struct scpsys_bus_prot_data *bpd = pd->data->bp_infracfg; + int i, ret; - if (!bp_data->bus_prot_mask) - return 0; + for (i = 0; i < SPM_MAX_BUS_PROT_DATA; i++) { + if (!bpd[i].bus_prot_mask) + return 0; - return mtk_infracfg_clear_bus_protection(pd->infracfg, bp_data->bus_prot_mask, - bp_data->bus_prot_reg_update); + ret = mtk_infracfg_clear_bus_protection(pd->infracfg, + bpd[i].bus_prot_mask, + bpd[i].bus_prot_reg_update); + if (ret) + return ret; + } + + return 0; } static int scpsys_power_on(struct generic_pm_domain *genpd) diff --git a/drivers/soc/mediatek/mtk-pm-domains.h b/drivers/soc/mediatek/mtk-pm-domains.h index 7c8efcb3cef2..e428fe23a7e3 100644 --- a/drivers/soc/mediatek/mtk-pm-domains.h +++ b/drivers/soc/mediatek/mtk-pm-domains.h @@ -32,6 +32,8 @@ #define PWR_STATUS_AUDIO BIT(24) #define PWR_STATUS_USB BIT(25) +#define SPM_MAX_BUS_PROT_DATA 3 + struct scpsys_bus_prot_data { u32 bus_prot_mask; bool bus_prot_reg_update; @@ -52,7 +54,7 @@ struct scpsys_domain_data { u32 sram_pdn_bits; u32 sram_pdn_ack_bits; u8 caps; - const struct scpsys_bus_prot_data bp_infracfg; + const struct scpsys_bus_prot_data bp_infracfg[SPM_MAX_BUS_PROT_DATA]; }; struct scpsys_soc_data {