at91: Don't try to restore the PLL settings when the PLLs were turned off previously. We run into this problem with the PLLB on the at91: ohci-at91 disables the PLLB when going to suspend. The slowclock code however tries to do the same: It saves the PLLB register value and when restoring the value during resume, it wait's for the PLLB to lock again. However the PLL will never lock and the loop would run into it's timeout because the slowclock code just stored and restored an empty register. This fixes the problem by only restoring PLLA/PLLB when the registers were != 0. Signed-off-by: Julien Langer --- arch/arm/mach-at91/pm_slowclock.S | 14 ++++++++++++++ 1 files changed, 14 insertions(+), 0 deletions(-) diff --git a/arch/arm/mach-at91/pm_slowclock.S b/arch/arm/mach-at91/pm_slowclock.S index dc6d730..dbc8f0a 100644 --- a/arch/arm/mach-at91/pm_slowclock.S +++ b/arch/arm/mach-at91/pm_slowclock.S @@ -201,20 +201,28 @@ ENTRY(at91_slow_clock) ldr r3, [r1, #(AT91_CKGR_PLLAR - AT91_PMC)] str r3, .saved_pllar + cmp r3, #0 + beq 3f + mov r3, #AT91_PMC_PLLCOUNT orr r3, r3, #(1 << 29) /* bit 29 always set */ str r3, [r1, #(AT91_CKGR_PLLAR - AT91_PMC)] wait_pllaunlock +3: /* Save PLLB setting and disable it */ ldr r3, [r1, #(AT91_CKGR_PLLBR - AT91_PMC)] str r3, .saved_pllbr + cmp r3, #0 + beq 4f + mov r3, #AT91_PMC_PLLCOUNT str r3, [r1, #(AT91_CKGR_PLLBR - AT91_PMC)] wait_pllbunlock +4: /* Turn off the main oscillator */ ldr r3, [r1, #(AT91_CKGR_MOR - AT91_PMC)] bic r3, r3, #AT91_PMC_MOSCEN @@ -232,16 +240,22 @@ ENTRY(at91_slow_clock) /* Restore PLLB setting */ ldr r3, .saved_pllbr + cmp r3, #0 + beq 5f str r3, [r1, #(AT91_CKGR_PLLBR - AT91_PMC)] wait_pllblock +5: /* Restore PLLA setting */ ldr r3, .saved_pllar + cmp r3, #0 + beq 6f str r3, [r1, #(AT91_CKGR_PLLAR - AT91_PMC)] wait_pllalock +6: #ifdef SLOWDOWN_MASTER_CLOCK /* * First set PRES if it was not 0,