diff options
| -rw-r--r-- | arch/arm/mach-ux500/prcmu-db8500.c | 26 | ||||
| -rw-r--r-- | arch/arm/mach-ux500/prcmu-regs-db8500.h | 3 |
2 files changed, 28 insertions, 1 deletions
diff --git a/arch/arm/mach-ux500/prcmu-db8500.c b/arch/arm/mach-ux500/prcmu-db8500.c index 69c431b610b..d49747bf5ee 100644 --- a/arch/arm/mach-ux500/prcmu-db8500.c +++ b/arch/arm/mach-ux500/prcmu-db8500.c @@ -1407,6 +1407,28 @@ static int request_reg_clock(u8 clock, bool enable) return 0; } +static int request_sga_clock(u8 clock, bool enable) +{ + u32 val; + int ret; + + if (enable && cpu_is_u8500v20()) { + val = readl(_PRCMU_BASE + PRCM_CGATING_BYPASS); + writel(val | PRCM_CGATING_BYPASS_ICN2, + _PRCMU_BASE + PRCM_CGATING_BYPASS); + } + + ret = request_reg_clock(clock, enable); + + if (!ret && !enable && cpu_is_u8500v20()) { + val = readl(_PRCMU_BASE + PRCM_CGATING_BYPASS); + writel(val & ~PRCM_CGATING_BYPASS_ICN2, + _PRCMU_BASE + PRCM_CGATING_BYPASS); + } + + return ret; +} + /** * prcmu_request_clock() - Request for a clock to be enabled or disabled. * @clock: The clock for which the request is made. @@ -1417,7 +1439,9 @@ static int request_reg_clock(u8 clock, bool enable) */ int prcmu_request_clock(u8 clock, bool enable) { - if (clock < PRCMU_NUM_REG_CLOCKS) + if (clock == PRCMU_SGACLK) + return request_sga_clock(clock, enable); + else if (clock < PRCMU_NUM_REG_CLOCKS) return request_reg_clock(clock, enable); else if (clock == PRCMU_TIMCLK) return request_timclk(enable); diff --git a/arch/arm/mach-ux500/prcmu-regs-db8500.h b/arch/arm/mach-ux500/prcmu-regs-db8500.h index 7ae1218f6ba..a6fafb97888 100644 --- a/arch/arm/mach-ux500/prcmu-regs-db8500.h +++ b/arch/arm/mach-ux500/prcmu-regs-db8500.h @@ -159,4 +159,7 @@ #define PRCM_DDR_SUBSYS_APE_MINBW 0x438 +#define PRCM_CGATING_BYPASS 0x134 +#define PRCM_CGATING_BYPASS_ICN2 BIT(6) + #endif /* __MACH_PRCMU__REGS_H */ |