shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-06 19:08:57 +09:00
Code Issues Packages Projects Releases Wiki Activity

soc: rockchip: power-domain: support qos init

Browse Source 
init qos once when pd is initialized.
e.g:
	&qos_vop {
		priority-init = <0x202>;
		mode-init = <0x1>;
		bandwidth-init = <0x281>;
		saturation-init = <0x41>;
		extcontrol-init = <0x1>;
	};

Change-Id: I2ff600e97e772f209dd29400cd1fde2edb66dd2b
Signed-off-by: Elaine Zhang <zhangqing@rock-chips.com>
This commit is contained in:
Elaine Zhang
2020-04-27 15:54:53 +08:00
committed by Tao Huang
parent 0cf912946e
commit 4910bdcba8
1 changed files with 110 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

120
drivers/soc/rockchip/pm_domains.c
View File

@@ -15,6 +15,7 @@
#include <linux/of_platform.h>
#include <linux/clk.h>
#include <linux/regmap.h>
#include <linux/slab.h>
#include <linux/mfd/syscon.h>
#include <linux/pm_runtime.h>
#include <linux/regulator/consumer.h>
@@ -633,6 +634,46 @@ static void rockchip_pd_detach_dev(struct generic_pm_domain *genpd,
pm_clk_destroy(dev);
}
static void rockchip_pd_qos_init(struct rockchip_pm_domain *pd,
bool **qos_is_need_init)
{
int i, is_pd_on;
is_pd_on = rockchip_pmu_domain_is_on(pd);
if (!is_pd_on)
rockchip_pd_power(pd, true);
for (i = 0; i < pd->num_qos; i++) {
if (qos_is_need_init[0][i])
regmap_write(pd->qos_regmap[i],
QOS_PRIORITY,
pd->qos_save_regs[0][i]);
if (qos_is_need_init[1][i])
regmap_write(pd->qos_regmap[i],
QOS_MODE,
pd->qos_save_regs[1][i]);
if (qos_is_need_init[2][i])
regmap_write(pd->qos_regmap[i],
QOS_BANDWIDTH,
pd->qos_save_regs[2][i]);
if (qos_is_need_init[3][i])
regmap_write(pd->qos_regmap[i],
QOS_SATURATION,
pd->qos_save_regs[3][i]);
if (qos_is_need_init[4][i])
regmap_write(pd->qos_regmap[i],
QOS_EXTCONTROL,
pd->qos_save_regs[4][i]);
}
if (!is_pd_on)
rockchip_pd_power(pd, false);
}
static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
struct device_node *node)
{
@@ -641,8 +682,10 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
struct device_node *qos_node;
int num_qos = 0, num_qos_reg = 0;
int i, j;
u32 id;
u32 id, val;
int error;
bool *qos_is_need_init[MAX_QOS_REGS_NUM] = { NULL };
bool is_qos_need_init = false;
error = of_property_read_u32(node, "reg", &id);
if (error) {
@@ -719,15 +762,27 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
goto err_unprepare_clocks;
}
for (j = 0; j < MAX_QOS_REGS_NUM; j++) {
pd->qos_save_regs[j] = devm_kcalloc(pmu->dev,
pd->num_qos,
sizeof(u32),
GFP_KERNEL);
if (!pd->qos_save_regs[j]) {
error = -ENOMEM;
goto err_unprepare_clocks;
}
pd->qos_save_regs[0] = (u32 *)devm_kmalloc(pmu->dev,
sizeof(u32) *
MAX_QOS_REGS_NUM *
pd->num_qos,
GFP_KERNEL);
if (!pd->qos_save_regs[0]) {
error = -ENOMEM;
goto err_unprepare_clocks;
}
qos_is_need_init[0] = kzalloc(sizeof(bool) *
MAX_QOS_REGS_NUM *
pd->num_qos,
GFP_KERNEL);
if (!qos_is_need_init[0]) {
error = -ENOMEM;
goto err_unprepare_clocks;
}
for (i = 1; i < MAX_QOS_REGS_NUM; i++) {
pd->qos_save_regs[i] = pd->qos_save_regs[i - 1] +
num_qos;
qos_is_need_init[i] = qos_is_need_init[i - 1] + num_qos;
}
for (j = 0; j < num_qos; j++) {
@@ -744,6 +799,46 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
of_node_put(qos_node);
goto err_unprepare_clocks;
}
if (!of_property_read_u32(qos_node,
"priority-init",
&val)) {
pd->qos_save_regs[0][j] = val;
qos_is_need_init[0][j] = true;
is_qos_need_init = true;
}
if (!of_property_read_u32(qos_node,
"mode-init",
&val)) {
pd->qos_save_regs[1][j] = val;
qos_is_need_init[1][j] = true;
is_qos_need_init = true;
}
if (!of_property_read_u32(qos_node,
"bandwidth-init",
&val)) {
pd->qos_save_regs[2][j] = val;
qos_is_need_init[2][j] = true;
is_qos_need_init = true;
}
if (!of_property_read_u32(qos_node,
"saturation-init",
&val)) {
pd->qos_save_regs[3][j] = val;
qos_is_need_init[3][j] = true;
is_qos_need_init = true;
}
if (!of_property_read_u32(qos_node,
"extcontrol-init",
&val)) {
pd->qos_save_regs[4][j] = val;
qos_is_need_init[4][j] = true;
is_qos_need_init = true;
}
num_qos_reg++;
}
of_node_put(qos_node);
@@ -775,6 +870,10 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
}
}
#endif
if (is_qos_need_init)
rockchip_pd_qos_init(pd, &qos_is_need_init[0]);
kfree(qos_is_need_init[0]);
pm_genpd_init(&pd->genpd, NULL, !rockchip_pmu_domain_is_on(pd));
@@ -782,6 +881,7 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
return 0;
err_unprepare_clocks:
kfree(qos_is_need_init[0]);
clk_bulk_unprepare(pd->num_clks, pd->clks);
err_put_clocks:
clk_bulk_put(pd->num_clks, pd->clks);