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

soc: rockchip: power-domain: support qos node status get

Browse Source 
check if qos node is available for use.

Change-Id: Ife40ee58664cd53a9705cda934b92d886ca35522
Signed-off-by: Elaine Zhang <zhangqing@rock-chips.com>
This commit is contained in:
Elaine Zhang
2018-11-06 16:47:57 +08:00
committed by Tao Huang
parent c31ce8bf63
commit 8b9bedf44e
1 changed files with 21 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -511,6 +511,7 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
const struct rockchip_domain_info *pd_info;
struct rockchip_pm_domain *pd;
struct device_node *qos_node;
int num_qos = 0, num_qos_reg = 0;
int i, j;
u32 id;
int error;
@@ -572,8 +573,14 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
if (error)
goto err_put_clocks;
pd->num_qos = of_count_phandle_with_args(node, "pm_qos",
NULL);
num_qos = of_count_phandle_with_args(node, "pm_qos", NULL);
for (j = 0; j < num_qos; j++) {
qos_node = of_parse_phandle(node, "pm_qos", j);
if (qos_node && of_device_is_available(qos_node))
pd->num_qos++;
of_node_put(qos_node);
}
if (pd->num_qos > 0) {
pd->qos_regmap = devm_kcalloc(pmu->dev, pd->num_qos,
@@ -595,19 +602,25 @@ static int rockchip_pm_add_one_domain(struct rockchip_pmu *pmu,
}
}
for (j = 0; j < pd->num_qos; j++) {
for (j = 0; j < num_qos; j++) {
qos_node = of_parse_phandle(node, "pm_qos", j);
if (!qos_node) {
error = -ENODEV;
goto err_unprepare_clocks;
}
pd->qos_regmap[j] = syscon_node_to_regmap(qos_node);
if (IS_ERR(pd->qos_regmap[j])) {
error = -ENODEV;
of_node_put(qos_node);
goto err_unprepare_clocks;
if (of_device_is_available(qos_node)) {
pd->qos_regmap[num_qos_reg] =
syscon_node_to_regmap(qos_node);
if (IS_ERR(pd->qos_regmap[num_qos_reg])) {
error = -ENODEV;
of_node_put(qos_node);
goto err_unprepare_clocks;
}
num_qos_reg++;
}
of_node_put(qos_node);
if (num_qos_reg > pd->num_qos)
goto err_unprepare_clocks;
}
}