soc: rockchip: power-domain: avoid infinite loop
In some cases, we have met the infinite loop in rockchip_pmu_set_idle_request() or rockchip_do_pmu_set_power_domain(). As the crosbug.com/p/57351 reported, the boot hangs right after this [1.629163] bootconsole [uart8250] disabled [1.639286] [drm:drm_core_init] Initialized drm 1.1.0 20060810 [1.645926] [drm:drm_get_platform_dev] Initialized vgem 1.0.0 20120112.. [1.654558] iommu: Adding device ff8f0000.vop to group 0 [1.660569] iommu: Adding device ff900000.vop to group 1 <hang> This patch adds the error message and timeout to avoid infinite loop if it fails to get the ack. Signed-off-by: Caesar Wang <wxt@rock-chips.com> Signed-off-by: Heiko Stuebner <heiko@sntech.de>
This commit is contained in:
parent
3f2fe461c7
commit
e4c8cd82d5
@ -9,6 +9,7 @@
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
|
#include <linux/iopoll.h>
|
||||||
#include <linux/err.h>
|
#include <linux/err.h>
|
||||||
#include <linux/pm_clock.h>
|
#include <linux/pm_clock.h>
|
||||||
#include <linux/pm_domain.h>
|
#include <linux/pm_domain.h>
|
||||||
@ -105,12 +106,24 @@ static bool rockchip_pmu_domain_is_idle(struct rockchip_pm_domain *pd)
|
|||||||
return (val & pd_info->idle_mask) == pd_info->idle_mask;
|
return (val & pd_info->idle_mask) == pd_info->idle_mask;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static unsigned int rockchip_pmu_read_ack(struct rockchip_pmu *pmu)
|
||||||
|
{
|
||||||
|
unsigned int val;
|
||||||
|
|
||||||
|
regmap_read(pmu->regmap, pmu->info->ack_offset, &val);
|
||||||
|
return val;
|
||||||
|
}
|
||||||
|
|
||||||
static int rockchip_pmu_set_idle_request(struct rockchip_pm_domain *pd,
|
static int rockchip_pmu_set_idle_request(struct rockchip_pm_domain *pd,
|
||||||
bool idle)
|
bool idle)
|
||||||
{
|
{
|
||||||
const struct rockchip_domain_info *pd_info = pd->info;
|
const struct rockchip_domain_info *pd_info = pd->info;
|
||||||
|
struct generic_pm_domain *genpd = &pd->genpd;
|
||||||
struct rockchip_pmu *pmu = pd->pmu;
|
struct rockchip_pmu *pmu = pd->pmu;
|
||||||
|
unsigned int target_ack;
|
||||||
unsigned int val;
|
unsigned int val;
|
||||||
|
bool is_idle;
|
||||||
|
int ret;
|
||||||
|
|
||||||
if (pd_info->req_mask == 0)
|
if (pd_info->req_mask == 0)
|
||||||
return 0;
|
return 0;
|
||||||
@ -120,12 +133,26 @@ static int rockchip_pmu_set_idle_request(struct rockchip_pm_domain *pd,
|
|||||||
|
|
||||||
dsb(sy);
|
dsb(sy);
|
||||||
|
|
||||||
do {
|
/* Wait util idle_ack = 1 */
|
||||||
regmap_read(pmu->regmap, pmu->info->ack_offset, &val);
|
target_ack = idle ? pd_info->ack_mask : 0;
|
||||||
} while ((val & pd_info->ack_mask) != (idle ? pd_info->ack_mask : 0));
|
ret = readx_poll_timeout_atomic(rockchip_pmu_read_ack, pmu, val,
|
||||||
|
(val & pd_info->ack_mask) == target_ack,
|
||||||
|
0, 10000);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(pmu->dev,
|
||||||
|
"failed to get ack on domain '%s', val=0x%x\n",
|
||||||
|
genpd->name, val);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
while (rockchip_pmu_domain_is_idle(pd) != idle)
|
ret = readx_poll_timeout_atomic(rockchip_pmu_domain_is_idle, pd,
|
||||||
cpu_relax();
|
is_idle, is_idle == idle, 0, 10000);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(pmu->dev,
|
||||||
|
"failed to set idle on domain '%s', val=%d\n",
|
||||||
|
genpd->name, is_idle);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@ -198,6 +225,8 @@ static void rockchip_do_pmu_set_power_domain(struct rockchip_pm_domain *pd,
|
|||||||
bool on)
|
bool on)
|
||||||
{
|
{
|
||||||
struct rockchip_pmu *pmu = pd->pmu;
|
struct rockchip_pmu *pmu = pd->pmu;
|
||||||
|
struct generic_pm_domain *genpd = &pd->genpd;
|
||||||
|
bool is_on;
|
||||||
|
|
||||||
if (pd->info->pwr_mask == 0)
|
if (pd->info->pwr_mask == 0)
|
||||||
return;
|
return;
|
||||||
@ -207,8 +236,13 @@ static void rockchip_do_pmu_set_power_domain(struct rockchip_pm_domain *pd,
|
|||||||
|
|
||||||
dsb(sy);
|
dsb(sy);
|
||||||
|
|
||||||
while (rockchip_pmu_domain_is_on(pd) != on)
|
if (readx_poll_timeout_atomic(rockchip_pmu_domain_is_on, pd, is_on,
|
||||||
cpu_relax();
|
is_on == on, 0, 10000)) {
|
||||||
|
dev_err(pmu->dev,
|
||||||
|
"failed to set domain '%s', val=%d\n",
|
||||||
|
genpd->name, is_on);
|
||||||
|
return;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rockchip_pd_power(struct rockchip_pm_domain *pd, bool power_on)
|
static int rockchip_pd_power(struct rockchip_pm_domain *pd, bool power_on)
|
||||||
|
Loading…
Reference in New Issue
Block a user