Lines Matching refs:pg
704 static int tegra_powergate_prepare_clocks(struct tegra_powergate *pg) in tegra_powergate_prepare_clocks() argument
710 for (i = 0; i < pg->num_clks; i++) { in tegra_powergate_prepare_clocks()
711 pg->clk_rates[i] = clk_get_rate(pg->clks[i]); in tegra_powergate_prepare_clocks()
713 if (!pg->clk_rates[i]) { in tegra_powergate_prepare_clocks()
718 if (pg->clk_rates[i] <= safe_rate) in tegra_powergate_prepare_clocks()
727 err = clk_set_rate(pg->clks[i], safe_rate); in tegra_powergate_prepare_clocks()
736 clk_set_rate(pg->clks[i], pg->clk_rates[i]); in tegra_powergate_prepare_clocks()
741 static int tegra_powergate_unprepare_clocks(struct tegra_powergate *pg) in tegra_powergate_unprepare_clocks() argument
746 for (i = 0; i < pg->num_clks; i++) { in tegra_powergate_unprepare_clocks()
747 err = clk_set_rate(pg->clks[i], pg->clk_rates[i]); in tegra_powergate_unprepare_clocks()
755 static void tegra_powergate_disable_clocks(struct tegra_powergate *pg) in tegra_powergate_disable_clocks() argument
759 for (i = 0; i < pg->num_clks; i++) in tegra_powergate_disable_clocks()
760 clk_disable_unprepare(pg->clks[i]); in tegra_powergate_disable_clocks()
763 static int tegra_powergate_enable_clocks(struct tegra_powergate *pg) in tegra_powergate_enable_clocks() argument
768 for (i = 0; i < pg->num_clks; i++) { in tegra_powergate_enable_clocks()
769 err = clk_prepare_enable(pg->clks[i]); in tegra_powergate_enable_clocks()
778 clk_disable_unprepare(pg->clks[i]); in tegra_powergate_enable_clocks()
783 static int tegra_powergate_power_up(struct tegra_powergate *pg, in tegra_powergate_power_up() argument
788 err = reset_control_assert(pg->reset); in tegra_powergate_power_up()
794 err = tegra_powergate_set(pg->pmc, pg->id, true); in tegra_powergate_power_up()
800 err = tegra_powergate_prepare_clocks(pg); in tegra_powergate_power_up()
804 err = tegra_powergate_enable_clocks(pg); in tegra_powergate_power_up()
810 err = __tegra_powergate_remove_clamping(pg->pmc, pg->id); in tegra_powergate_power_up()
816 err = reset_control_deassert(pg->reset); in tegra_powergate_power_up()
822 if (pg->pmc->soc->needs_mbist_war) in tegra_powergate_power_up()
823 err = tegra210_clk_handle_mbist_war(pg->id); in tegra_powergate_power_up()
828 tegra_powergate_disable_clocks(pg); in tegra_powergate_power_up()
830 err = tegra_powergate_unprepare_clocks(pg); in tegra_powergate_power_up()
837 tegra_powergate_disable_clocks(pg); in tegra_powergate_power_up()
841 tegra_powergate_unprepare_clocks(pg); in tegra_powergate_power_up()
844 tegra_powergate_set(pg->pmc, pg->id, false); in tegra_powergate_power_up()
849 static int tegra_powergate_power_down(struct tegra_powergate *pg) in tegra_powergate_power_down() argument
853 err = tegra_powergate_prepare_clocks(pg); in tegra_powergate_power_down()
857 err = tegra_powergate_enable_clocks(pg); in tegra_powergate_power_down()
863 err = reset_control_assert(pg->reset); in tegra_powergate_power_down()
869 tegra_powergate_disable_clocks(pg); in tegra_powergate_power_down()
873 err = tegra_powergate_set(pg->pmc, pg->id, false); in tegra_powergate_power_down()
877 err = tegra_powergate_unprepare_clocks(pg); in tegra_powergate_power_down()
884 tegra_powergate_enable_clocks(pg); in tegra_powergate_power_down()
886 reset_control_deassert(pg->reset); in tegra_powergate_power_down()
890 tegra_powergate_disable_clocks(pg); in tegra_powergate_power_down()
893 tegra_powergate_unprepare_clocks(pg); in tegra_powergate_power_down()
900 struct tegra_powergate *pg = to_powergate(domain); in tegra_genpd_power_on() local
901 struct device *dev = pg->pmc->dev; in tegra_genpd_power_on()
904 err = tegra_powergate_power_up(pg, true); in tegra_genpd_power_on()
907 pg->genpd.name, err); in tegra_genpd_power_on()
911 reset_control_release(pg->reset); in tegra_genpd_power_on()
919 struct tegra_powergate *pg = to_powergate(domain); in tegra_genpd_power_off() local
920 struct device *dev = pg->pmc->dev; in tegra_genpd_power_off()
923 err = reset_control_acquire(pg->reset); in tegra_genpd_power_off()
926 pg->genpd.name, err); in tegra_genpd_power_off()
930 err = tegra_powergate_power_down(pg); in tegra_genpd_power_off()
933 pg->genpd.name, err); in tegra_genpd_power_off()
934 reset_control_release(pg->reset); in tegra_genpd_power_off()
1003 struct tegra_powergate *pg; in tegra_powergate_sequence_power_up() local
1009 pg = kzalloc(sizeof(*pg), GFP_KERNEL); in tegra_powergate_sequence_power_up()
1010 if (!pg) in tegra_powergate_sequence_power_up()
1013 pg->clk_rates = kzalloc(sizeof(*pg->clk_rates), GFP_KERNEL); in tegra_powergate_sequence_power_up()
1014 if (!pg->clk_rates) { in tegra_powergate_sequence_power_up()
1015 kfree(pg->clks); in tegra_powergate_sequence_power_up()
1019 pg->id = id; in tegra_powergate_sequence_power_up()
1020 pg->clks = &clk; in tegra_powergate_sequence_power_up()
1021 pg->num_clks = 1; in tegra_powergate_sequence_power_up()
1022 pg->reset = rst; in tegra_powergate_sequence_power_up()
1023 pg->pmc = pmc; in tegra_powergate_sequence_power_up()
1025 err = tegra_powergate_power_up(pg, false); in tegra_powergate_sequence_power_up()
1030 kfree(pg->clk_rates); in tegra_powergate_sequence_power_up()
1031 kfree(pg); in tegra_powergate_sequence_power_up()
1199 static int tegra_powergate_of_get_clks(struct tegra_powergate *pg, in tegra_powergate_of_get_clks() argument
1210 pg->clks = kcalloc(count, sizeof(clk), GFP_KERNEL); in tegra_powergate_of_get_clks()
1211 if (!pg->clks) in tegra_powergate_of_get_clks()
1214 pg->clk_rates = kcalloc(count, sizeof(*pg->clk_rates), GFP_KERNEL); in tegra_powergate_of_get_clks()
1215 if (!pg->clk_rates) { in tegra_powergate_of_get_clks()
1216 kfree(pg->clks); in tegra_powergate_of_get_clks()
1221 pg->clks[i] = of_clk_get(np, i); in tegra_powergate_of_get_clks()
1222 if (IS_ERR(pg->clks[i])) { in tegra_powergate_of_get_clks()
1223 err = PTR_ERR(pg->clks[i]); in tegra_powergate_of_get_clks()
1228 pg->num_clks = count; in tegra_powergate_of_get_clks()
1234 clk_put(pg->clks[i]); in tegra_powergate_of_get_clks()
1236 kfree(pg->clk_rates); in tegra_powergate_of_get_clks()
1237 kfree(pg->clks); in tegra_powergate_of_get_clks()
1242 static int tegra_powergate_of_get_resets(struct tegra_powergate *pg, in tegra_powergate_of_get_resets() argument
1245 struct device *dev = pg->pmc->dev; in tegra_powergate_of_get_resets()
1248 pg->reset = of_reset_control_array_get_exclusive_released(np); in tegra_powergate_of_get_resets()
1249 if (IS_ERR(pg->reset)) { in tegra_powergate_of_get_resets()
1250 err = PTR_ERR(pg->reset); in tegra_powergate_of_get_resets()
1255 err = reset_control_acquire(pg->reset); in tegra_powergate_of_get_resets()
1262 err = reset_control_assert(pg->reset); in tegra_powergate_of_get_resets()
1264 err = reset_control_deassert(pg->reset); in tegra_powergate_of_get_resets()
1268 reset_control_release(pg->reset); in tegra_powergate_of_get_resets()
1273 reset_control_release(pg->reset); in tegra_powergate_of_get_resets()
1274 reset_control_put(pg->reset); in tegra_powergate_of_get_resets()
1283 struct tegra_powergate *pg; in tegra_powergate_add() local
1287 pg = kzalloc(sizeof(*pg), GFP_KERNEL); in tegra_powergate_add()
1288 if (!pg) in tegra_powergate_add()
1304 pg->id = id; in tegra_powergate_add()
1305 pg->genpd.name = np->name; in tegra_powergate_add()
1306 pg->genpd.power_off = tegra_genpd_power_off; in tegra_powergate_add()
1307 pg->genpd.power_on = tegra_genpd_power_on; in tegra_powergate_add()
1308 pg->pmc = pmc; in tegra_powergate_add()
1310 off = !tegra_powergate_is_powered(pmc, pg->id); in tegra_powergate_add()
1312 err = tegra_powergate_of_get_clks(pg, np); in tegra_powergate_add()
1318 err = tegra_powergate_of_get_resets(pg, np, off); in tegra_powergate_add()
1326 WARN_ON(tegra_powergate_power_up(pg, true)); in tegra_powergate_add()
1331 err = pm_genpd_init(&pg->genpd, NULL, off); in tegra_powergate_add()
1338 err = of_genpd_add_provider_simple(np, &pg->genpd); in tegra_powergate_add()
1345 dev_dbg(dev, "added PM domain %s\n", pg->genpd.name); in tegra_powergate_add()
1350 pm_genpd_remove(&pg->genpd); in tegra_powergate_add()
1353 reset_control_put(pg->reset); in tegra_powergate_add()
1356 while (pg->num_clks--) in tegra_powergate_add()
1357 clk_put(pg->clks[pg->num_clks]); in tegra_powergate_add()
1359 kfree(pg->clks); in tegra_powergate_add()
1365 kfree(pg); in tegra_powergate_add()
1505 struct tegra_powergate *pg = to_powergate(genpd); in tegra_powergate_remove() local
1507 reset_control_put(pg->reset); in tegra_powergate_remove()
1509 while (pg->num_clks--) in tegra_powergate_remove()
1510 clk_put(pg->clks[pg->num_clks]); in tegra_powergate_remove()
1512 kfree(pg->clks); in tegra_powergate_remove()
1514 set_bit(pg->id, pmc->powergates_available); in tegra_powergate_remove()
1516 kfree(pg); in tegra_powergate_remove()