Lines Matching +full:pd +full:- +full:node
1 // SPDX-License-Identifier: GPL-2.0-only
6 #include <linux/clk-provider.h>
19 #include "mt8167-pm-domains.h"
20 #include "mt8173-pm-domains.h"
21 #include "mt8183-pm-domains.h"
22 #include "mt8192-pm-domains.h"
58 static bool scpsys_domain_is_on(struct scpsys_domain *pd) in scpsys_domain_is_on() argument
60 struct scpsys *scpsys = pd->scpsys; in scpsys_domain_is_on()
63 regmap_read(scpsys->base, scpsys->soc_data->pwr_sta_offs, &status); in scpsys_domain_is_on()
64 status &= pd->data->sta_mask; in scpsys_domain_is_on()
66 regmap_read(scpsys->base, scpsys->soc_data->pwr_sta2nd_offs, &status2); in scpsys_domain_is_on()
67 status2 &= pd->data->sta_mask; in scpsys_domain_is_on()
73 static int scpsys_sram_enable(struct scpsys_domain *pd) in scpsys_sram_enable() argument
75 u32 pdn_ack = pd->data->sram_pdn_ack_bits; in scpsys_sram_enable()
76 struct scpsys *scpsys = pd->scpsys; in scpsys_sram_enable()
80 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, pd->data->sram_pdn_bits); in scpsys_sram_enable()
83 ret = regmap_read_poll_timeout(scpsys->base, pd->data->ctl_offs, tmp, in scpsys_sram_enable()
88 if (MTK_SCPD_CAPS(pd, MTK_SCPD_SRAM_ISO)) { in scpsys_sram_enable()
89 regmap_set_bits(scpsys->base, pd->data->ctl_offs, PWR_SRAM_ISOINT_B_BIT); in scpsys_sram_enable()
91 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, PWR_SRAM_CLKISO_BIT); in scpsys_sram_enable()
97 static int scpsys_sram_disable(struct scpsys_domain *pd) in scpsys_sram_disable() argument
99 u32 pdn_ack = pd->data->sram_pdn_ack_bits; in scpsys_sram_disable()
100 struct scpsys *scpsys = pd->scpsys; in scpsys_sram_disable()
103 if (MTK_SCPD_CAPS(pd, MTK_SCPD_SRAM_ISO)) { in scpsys_sram_disable()
104 regmap_set_bits(scpsys->base, pd->data->ctl_offs, PWR_SRAM_CLKISO_BIT); in scpsys_sram_disable()
106 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, PWR_SRAM_ISOINT_B_BIT); in scpsys_sram_disable()
109 regmap_set_bits(scpsys->base, pd->data->ctl_offs, pd->data->sram_pdn_bits); in scpsys_sram_disable()
112 return regmap_read_poll_timeout(scpsys->base, pd->data->ctl_offs, tmp, in scpsys_sram_disable()
142 static int scpsys_bus_protect_enable(struct scpsys_domain *pd) in scpsys_bus_protect_enable() argument
146 ret = _scpsys_bus_protect_enable(pd->data->bp_infracfg, pd->infracfg); in scpsys_bus_protect_enable()
150 return _scpsys_bus_protect_enable(pd->data->bp_smi, pd->smi); in scpsys_bus_protect_enable()
158 for (i = SPM_MAX_BUS_PROT_DATA - 1; i >= 0; i--) { in _scpsys_bus_protect_disable()
182 static int scpsys_bus_protect_disable(struct scpsys_domain *pd) in scpsys_bus_protect_disable() argument
186 ret = _scpsys_bus_protect_disable(pd->data->bp_smi, pd->smi); in scpsys_bus_protect_disable()
190 return _scpsys_bus_protect_disable(pd->data->bp_infracfg, pd->infracfg); in scpsys_bus_protect_disable()
205 struct scpsys_domain *pd = container_of(genpd, struct scpsys_domain, genpd); in scpsys_power_on() local
206 struct scpsys *scpsys = pd->scpsys; in scpsys_power_on()
210 ret = scpsys_regulator_enable(pd->supply); in scpsys_power_on()
214 ret = clk_bulk_prepare_enable(pd->num_clks, pd->clks); in scpsys_power_on()
219 regmap_set_bits(scpsys->base, pd->data->ctl_offs, PWR_ON_BIT); in scpsys_power_on()
220 regmap_set_bits(scpsys->base, pd->data->ctl_offs, PWR_ON_2ND_BIT); in scpsys_power_on()
223 ret = readx_poll_timeout(scpsys_domain_is_on, pd, tmp, tmp, MTK_POLL_DELAY_US, in scpsys_power_on()
228 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, PWR_CLK_DIS_BIT); in scpsys_power_on()
229 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, PWR_ISO_BIT); in scpsys_power_on()
230 regmap_set_bits(scpsys->base, pd->data->ctl_offs, PWR_RST_B_BIT); in scpsys_power_on()
232 ret = clk_bulk_prepare_enable(pd->num_subsys_clks, pd->subsys_clks); in scpsys_power_on()
236 ret = scpsys_sram_enable(pd); in scpsys_power_on()
240 ret = scpsys_bus_protect_disable(pd); in scpsys_power_on()
247 scpsys_sram_disable(pd); in scpsys_power_on()
249 clk_bulk_disable_unprepare(pd->num_subsys_clks, pd->subsys_clks); in scpsys_power_on()
251 clk_bulk_disable_unprepare(pd->num_clks, pd->clks); in scpsys_power_on()
253 scpsys_regulator_disable(pd->supply); in scpsys_power_on()
259 struct scpsys_domain *pd = container_of(genpd, struct scpsys_domain, genpd); in scpsys_power_off() local
260 struct scpsys *scpsys = pd->scpsys; in scpsys_power_off()
264 ret = scpsys_bus_protect_enable(pd); in scpsys_power_off()
268 ret = scpsys_sram_disable(pd); in scpsys_power_off()
272 clk_bulk_disable_unprepare(pd->num_subsys_clks, pd->subsys_clks); in scpsys_power_off()
275 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, PWR_RST_B_BIT); in scpsys_power_off()
276 regmap_set_bits(scpsys->base, pd->data->ctl_offs, PWR_ISO_BIT); in scpsys_power_off()
277 regmap_set_bits(scpsys->base, pd->data->ctl_offs, PWR_CLK_DIS_BIT); in scpsys_power_off()
278 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, PWR_ON_2ND_BIT); in scpsys_power_off()
279 regmap_clear_bits(scpsys->base, pd->data->ctl_offs, PWR_ON_BIT); in scpsys_power_off()
282 ret = readx_poll_timeout(scpsys_domain_is_on, pd, tmp, !tmp, MTK_POLL_DELAY_US, in scpsys_power_off()
287 clk_bulk_disable_unprepare(pd->num_clks, pd->clks); in scpsys_power_off()
289 scpsys_regulator_disable(pd->supply); in scpsys_power_off()
295 generic_pm_domain *scpsys_add_one_domain(struct scpsys *scpsys, struct device_node *node) in scpsys_add_one_domain() argument
298 struct scpsys_domain *pd; in scpsys_add_one_domain() local
299 struct device_node *root_node = scpsys->dev->of_node; in scpsys_add_one_domain()
308 ret = of_property_read_u32(node, "reg", &id); in scpsys_add_one_domain()
310 dev_err(scpsys->dev, "%pOF: failed to retrieve domain id from reg: %d\n", in scpsys_add_one_domain()
311 node, ret); in scpsys_add_one_domain()
312 return ERR_PTR(-EINVAL); in scpsys_add_one_domain()
315 if (id >= scpsys->soc_data->num_domains) { in scpsys_add_one_domain()
316 dev_err(scpsys->dev, "%pOF: invalid domain id %d\n", node, id); in scpsys_add_one_domain()
317 return ERR_PTR(-EINVAL); in scpsys_add_one_domain()
320 domain_data = &scpsys->soc_data->domains_data[id]; in scpsys_add_one_domain()
321 if (domain_data->sta_mask == 0) { in scpsys_add_one_domain()
322 dev_err(scpsys->dev, "%pOF: undefined domain id %d\n", node, id); in scpsys_add_one_domain()
323 return ERR_PTR(-EINVAL); in scpsys_add_one_domain()
326 pd = devm_kzalloc(scpsys->dev, sizeof(*pd), GFP_KERNEL); in scpsys_add_one_domain()
327 if (!pd) in scpsys_add_one_domain()
328 return ERR_PTR(-ENOMEM); in scpsys_add_one_domain()
330 pd->data = domain_data; in scpsys_add_one_domain()
331 pd->scpsys = scpsys; in scpsys_add_one_domain()
333 if (MTK_SCPD_CAPS(pd, MTK_SCPD_DOMAIN_SUPPLY)) { in scpsys_add_one_domain()
335 * Find regulator in current power domain node. in scpsys_add_one_domain()
336 * devm_regulator_get() finds regulator in a node and its child in scpsys_add_one_domain()
337 * node, so set of_node to current power domain node then change in scpsys_add_one_domain()
338 * back to original node after regulator is found for current in scpsys_add_one_domain()
339 * power domain node. in scpsys_add_one_domain()
341 scpsys->dev->of_node = node; in scpsys_add_one_domain()
342 pd->supply = devm_regulator_get(scpsys->dev, "domain"); in scpsys_add_one_domain()
343 scpsys->dev->of_node = root_node; in scpsys_add_one_domain()
344 if (IS_ERR(pd->supply)) { in scpsys_add_one_domain()
345 dev_err_probe(scpsys->dev, PTR_ERR(pd->supply), in scpsys_add_one_domain()
347 node); in scpsys_add_one_domain()
348 return ERR_CAST(pd->supply); in scpsys_add_one_domain()
352 pd->infracfg = syscon_regmap_lookup_by_phandle_optional(node, "mediatek,infracfg"); in scpsys_add_one_domain()
353 if (IS_ERR(pd->infracfg)) in scpsys_add_one_domain()
354 return ERR_CAST(pd->infracfg); in scpsys_add_one_domain()
356 smi_node = of_parse_phandle(node, "mediatek,smi", 0); in scpsys_add_one_domain()
358 pd->smi = device_node_to_regmap(smi_node); in scpsys_add_one_domain()
360 if (IS_ERR(pd->smi)) in scpsys_add_one_domain()
361 return ERR_CAST(pd->smi); in scpsys_add_one_domain()
364 num_clks = of_clk_get_parent_count(node); in scpsys_add_one_domain()
367 of_property_for_each_string(node, "clock-names", prop, clk_name) { in scpsys_add_one_domain()
370 subsys = strchr(clk_name, '-'); in scpsys_add_one_domain()
372 pd->num_subsys_clks++; in scpsys_add_one_domain()
374 pd->num_clks++; in scpsys_add_one_domain()
377 pd->clks = devm_kcalloc(scpsys->dev, pd->num_clks, sizeof(*pd->clks), GFP_KERNEL); in scpsys_add_one_domain()
378 if (!pd->clks) in scpsys_add_one_domain()
379 return ERR_PTR(-ENOMEM); in scpsys_add_one_domain()
381 pd->subsys_clks = devm_kcalloc(scpsys->dev, pd->num_subsys_clks, in scpsys_add_one_domain()
382 sizeof(*pd->subsys_clks), GFP_KERNEL); in scpsys_add_one_domain()
383 if (!pd->subsys_clks) in scpsys_add_one_domain()
384 return ERR_PTR(-ENOMEM); in scpsys_add_one_domain()
388 for (i = 0; i < pd->num_clks; i++) { in scpsys_add_one_domain()
389 clk = of_clk_get(node, i); in scpsys_add_one_domain()
392 dev_err_probe(scpsys->dev, ret, in scpsys_add_one_domain()
393 "%pOF: failed to get clk at index %d: %d\n", node, i, ret); in scpsys_add_one_domain()
397 pd->clks[clk_ind++].clk = clk; in scpsys_add_one_domain()
400 for (i = 0; i < pd->num_subsys_clks; i++) { in scpsys_add_one_domain()
401 clk = of_clk_get(node, i + clk_ind); in scpsys_add_one_domain()
404 dev_err_probe(scpsys->dev, ret, in scpsys_add_one_domain()
405 "%pOF: failed to get clk at index %d: %d\n", node, in scpsys_add_one_domain()
410 pd->subsys_clks[i].clk = clk; in scpsys_add_one_domain()
419 if (MTK_SCPD_CAPS(pd, MTK_SCPD_KEEP_DEFAULT_OFF)) { in scpsys_add_one_domain()
420 if (scpsys_domain_is_on(pd)) in scpsys_add_one_domain()
421 dev_warn(scpsys->dev, in scpsys_add_one_domain()
422 "%pOF: A default off power domain has been ON\n", node); in scpsys_add_one_domain()
424 ret = scpsys_power_on(&pd->genpd); in scpsys_add_one_domain()
426 dev_err(scpsys->dev, "%pOF: failed to power on domain: %d\n", node, ret); in scpsys_add_one_domain()
431 if (scpsys->domains[id]) { in scpsys_add_one_domain()
432 ret = -EINVAL; in scpsys_add_one_domain()
433 dev_err(scpsys->dev, in scpsys_add_one_domain()
434 "power domain with id %d already exists, check your device-tree\n", id); in scpsys_add_one_domain()
438 if (!pd->data->name) in scpsys_add_one_domain()
439 pd->genpd.name = node->name; in scpsys_add_one_domain()
441 pd->genpd.name = pd->data->name; in scpsys_add_one_domain()
443 pd->genpd.power_off = scpsys_power_off; in scpsys_add_one_domain()
444 pd->genpd.power_on = scpsys_power_on; in scpsys_add_one_domain()
446 if (MTK_SCPD_CAPS(pd, MTK_SCPD_KEEP_DEFAULT_OFF)) in scpsys_add_one_domain()
447 pm_genpd_init(&pd->genpd, NULL, true); in scpsys_add_one_domain()
449 pm_genpd_init(&pd->genpd, NULL, false); in scpsys_add_one_domain()
451 scpsys->domains[id] = &pd->genpd; in scpsys_add_one_domain()
453 return scpsys->pd_data.domains[id]; in scpsys_add_one_domain()
456 clk_bulk_put(pd->num_subsys_clks, pd->subsys_clks); in scpsys_add_one_domain()
458 clk_bulk_put(pd->num_clks, pd->clks); in scpsys_add_one_domain()
473 dev_err(scpsys->dev, "%pOF: failed to get parent domain id\n", child); in scpsys_add_subdomain()
477 if (!scpsys->pd_data.domains[id]) { in scpsys_add_subdomain()
478 ret = -EINVAL; in scpsys_add_subdomain()
479 dev_err(scpsys->dev, "power domain with id %d does not exist\n", id); in scpsys_add_subdomain()
483 parent_pd = scpsys->pd_data.domains[id]; in scpsys_add_subdomain()
488 dev_err_probe(scpsys->dev, ret, "%pOF: failed to get child domain id\n", in scpsys_add_subdomain()
495 dev_err(scpsys->dev, "failed to add %s subdomain to parent %s\n", in scpsys_add_subdomain()
496 child_pd->name, parent_pd->name); in scpsys_add_subdomain()
499 dev_dbg(scpsys->dev, "%s add subdomain: %s\n", parent_pd->name, in scpsys_add_subdomain()
500 child_pd->name); in scpsys_add_subdomain()
516 static void scpsys_remove_one_domain(struct scpsys_domain *pd) in scpsys_remove_one_domain() argument
520 if (scpsys_domain_is_on(pd)) in scpsys_remove_one_domain()
521 scpsys_power_off(&pd->genpd); in scpsys_remove_one_domain()
527 ret = pm_genpd_remove(&pd->genpd); in scpsys_remove_one_domain()
529 dev_err(pd->scpsys->dev, in scpsys_remove_one_domain()
530 "failed to remove domain '%s' : %d - state may be inconsistent\n", in scpsys_remove_one_domain()
531 pd->genpd.name, ret); in scpsys_remove_one_domain()
533 clk_bulk_put(pd->num_clks, pd->clks); in scpsys_remove_one_domain()
534 clk_bulk_put(pd->num_subsys_clks, pd->subsys_clks); in scpsys_remove_one_domain()
540 struct scpsys_domain *pd; in scpsys_domain_cleanup() local
543 for (i = scpsys->pd_data.num_domains - 1; i >= 0; i--) { in scpsys_domain_cleanup()
544 genpd = scpsys->pd_data.domains[i]; in scpsys_domain_cleanup()
546 pd = to_scpsys_domain(genpd); in scpsys_domain_cleanup()
547 scpsys_remove_one_domain(pd); in scpsys_domain_cleanup()
554 .compatible = "mediatek,mt8167-power-controller",
558 .compatible = "mediatek,mt8173-power-controller",
562 .compatible = "mediatek,mt8183-power-controller",
566 .compatible = "mediatek,mt8192-power-controller",
574 struct device *dev = &pdev->dev; in scpsys_probe()
575 struct device_node *np = dev->of_node; in scpsys_probe()
577 struct device_node *node; in scpsys_probe() local
582 soc = of_device_get_match_data(&pdev->dev); in scpsys_probe()
584 dev_err(&pdev->dev, "no power controller data\n"); in scpsys_probe()
585 return -EINVAL; in scpsys_probe()
588 scpsys = devm_kzalloc(dev, struct_size(scpsys, domains, soc->num_domains), GFP_KERNEL); in scpsys_probe()
590 return -ENOMEM; in scpsys_probe()
592 scpsys->dev = dev; in scpsys_probe()
593 scpsys->soc_data = soc; in scpsys_probe()
595 scpsys->pd_data.domains = scpsys->domains; in scpsys_probe()
596 scpsys->pd_data.num_domains = soc->num_domains; in scpsys_probe()
598 parent = dev->parent; in scpsys_probe()
601 return -ENODEV; in scpsys_probe()
604 scpsys->base = syscon_node_to_regmap(parent->of_node); in scpsys_probe()
605 if (IS_ERR(scpsys->base)) { in scpsys_probe()
607 return PTR_ERR(scpsys->base); in scpsys_probe()
610 ret = -ENODEV; in scpsys_probe()
611 for_each_available_child_of_node(np, node) { in scpsys_probe()
614 domain = scpsys_add_one_domain(scpsys, node); in scpsys_probe()
617 of_node_put(node); in scpsys_probe()
621 ret = scpsys_add_subdomain(scpsys, node); in scpsys_probe()
623 of_node_put(node); in scpsys_probe()
633 ret = of_genpd_add_provider_onecell(np, &scpsys->pd_data); in scpsys_probe()
649 .name = "mtk-power-controller",