diff options
| author | Scott Williams <scwilliams@nvidia.com> | 2011-07-21 16:06:08 -0700 |
|---|---|---|
| committer | Dan Willemsen <dwillemsen@nvidia.com> | 2012-03-22 23:27:14 -0700 |
| commit | e220ecd23769abf09e83808550165d0fcc03bcb7 (patch) | |
| tree | 1d8088eadbfadcd1e2784b5f40863b0319fe203d /arch/arm/mach-tegra/sleep-t3.S | |
| parent | 2955af8ae7fd2e6010c63ee4acc0ad8d11d4daee (diff) | |
ARM: tegra3: power: Add LP2 power mode support for CPU 0
Add support for forced Tegra3 LP2 low power mode on the boot processor
(CPU 0) via the cluster control interface when all others are offline.
Switching to the LP CPU mode is also enabled with this change.
LP2 in idle and LP2 mode on the secondary processors is not yet
supported.
Change-Id: Icb898729f093be5e006c413f701532dd45228687
Signed-off-by: Scott Williams <scwilliams@nvidia.com>
Signed-off-by: Dan Willemsen <dwillemsen@nvidia.com>
Rebase-Id: Rd5d8c2b0addfd6853033670b992ae082e4a0d9c8
Diffstat (limited to 'arch/arm/mach-tegra/sleep-t3.S')
| -rw-r--r-- | arch/arm/mach-tegra/sleep-t3.S | 93 |
1 files changed, 93 insertions, 0 deletions
diff --git a/arch/arm/mach-tegra/sleep-t3.S b/arch/arm/mach-tegra/sleep-t3.S index 769ef6f1fd32..b234ab3a671f 100644 --- a/arch/arm/mach-tegra/sleep-t3.S +++ b/arch/arm/mach-tegra/sleep-t3.S @@ -69,7 +69,9 @@ ENTRY(tegra3_hotplug_shutdown) bl tegra3_cpu_reset mov pc, lr @ should never get here ENDPROC(tegra3_hotplug_shutdown) +#endif +#if defined(CONFIG_HOTPLUG_CPU) || defined(CONFIG_PM_SLEEP) /* * tegra3_cpu_reset(unsigned long flags) * @@ -127,3 +129,94 @@ wfe_war: ENDPROC(tegra3_cpu_reset) #endif + +#ifdef CONFIG_PM_SLEEP +/* + * tegra3_sleep_cpu(unsigned long v2p) + * + * enters suspend in LP2 by turning off the mmu and jumping to + * tegra3_tear_down_cpu + */ +ENTRY(tegra3_sleep_cpu) + mov r3, lr @ set resume address to lr + bl tegra_cpu_save + + mov32 r1, tegra3_tear_down_cpu + add r1, r1, r0 + b tegra_turn_off_mmu +ENDPROC(tegra3_sleep_cpu) + +/* + * tegra3_tear_down_cpu + * + * Switches the CPU cluster to PLL-P and enters sleep. + */ +ENTRY(tegra3_tear_down_cpu) + bl tegra_cpu_pllp + b tegra3_enter_sleep +ENDPROC(tegra3_tear_down_cpu) + +/* START OF ROUTINES COPIED TO IRAM */ + .align L1_CACHE_SHIFT + .globl tegra3_iram_start +tegra3_iram_start: + +/* + * tegra3_lp1_reset + * + * reset vector for LP1 restore; copied into IRAM during suspend. + * brings the system back up to a safe starting point (SDRAM out of + * self-refresh, PLLC, PLLM and PLLP reenabled, CPU running on PLLP, + * system clock running on the same PLL that it suspended at), and + * jumps to tegra_lp2_startup to restore PLLX and virtual addressing. + * physical address of tegra_lp2_startup expected to be stored in + * PMC_SCRATCH41 + * + * NOTE: THIS *MUST* BE RELOCATED TO TEGRA_IRAM_CODE_AREA AND MUST BE FIRST. + */ + +/* !!!FIXME!!! Add LP1/LP1 code */ + +/* + * tegra3_enter_sleep + * + * uses flow controller to enter sleep state + * executes from IRAM with SDRAM in selfrefresh when target state is LP0 or LP1 + * executes from SDRAM with target state is LP2 + */ +tegra3_enter_sleep: + mov32 r7, TEGRA_TMRUS_BASE + ldr r1, [r7] + mov32 r4, TEGRA_PMC_BASE + str r1, [r4, #PMC_SCRATCH38] + dsb + mov32 r6, TEGRA_FLOW_CTRL_BASE + cpu_id r1 + + cpu_to_csr_reg r2, r1 + ldr r0, [r6, r2] + orr r0, r0, #FLOW_CTRL_CSR_INTR_FLAG | FLOW_CTRL_CSR_EVENT_FLAG + str r0, [r6, r2] + + mov r0, #FLOW_CTRL_WAIT_FOR_INTERRUPT + orr r0, r0, #FLOW_CTRL_HALT_CPU_IRQ | FLOW_CTRL_HALT_CPU_FIQ + cpu_to_halt_reg r2, r1 + str r0, [r6, r2] + dsb + ldr r0, [r6, r2] /* memory barrier */ + +halted: + dsb + isb + wfi /* CPU should be power gated here */ + + /* !!!FIXME!!! Implement halt failure handler */ + b halted + + .ltorg +/* dummy symbol for end of IRAM */ + .align L1_CACHE_SHIFT + .globl tegra3_iram_end +tegra3_iram_end: + b . +#endif |