Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 1 | /* |
| 2 | * linux/arch/arm/mach-omap2/sleep.S |
| 3 | * |
| 4 | * (C) Copyright 2004 |
| 5 | * Texas Instruments, <www.ti.com> |
| 6 | * Richard Woodruff <r-woodruff2@ti.com> |
| 7 | * |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 8 | * (C) Copyright 2006 Nokia Corporation |
| 9 | * Fixed idle loop sleep |
| 10 | * Igor Stoppa <igor.stoppa@nokia.com> |
| 11 | * |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 12 | * This program is free software; you can redistribute it and/or |
| 13 | * modify it under the terms of the GNU General Public License as |
| 14 | * published by the Free Software Foundation; either version 2 of |
| 15 | * the License, or (at your option) any later version. |
| 16 | * |
| 17 | * This program is distributed in the hope that it will be useful, |
| 18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR /PURPOSE. See the |
| 20 | * GNU General Public License for more details. |
| 21 | * |
| 22 | * You should have received a copy of the GNU General Public License |
| 23 | * along with this program; if not, write to the Free Software |
| 24 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 25 | * MA 02111-1307 USA |
| 26 | */ |
| 27 | |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 28 | #include <linux/linkage.h> |
| 29 | #include <asm/assembler.h> |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 30 | |
Tony Lindgren | ce491cf | 2009-10-20 09:40:47 -0700 | [diff] [blame] | 31 | #include <plat/omap24xx.h> |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 32 | |
Paul Walmsley | 4459598 | 2008-03-18 10:04:51 +0200 | [diff] [blame] | 33 | #include "sdrc.h" |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 34 | |
Paul Walmsley | 4459598 | 2008-03-18 10:04:51 +0200 | [diff] [blame] | 35 | /* First address of reserved address space? apparently valid for OMAP2 & 3 */ |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 36 | #define A_SDRC0_V (0xC0000000) |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 37 | |
| 38 | .text |
| 39 | |
| 40 | /* |
| 41 | * Forces OMAP into idle state |
| 42 | * |
| 43 | * omap24xx_idle_loop_suspend() - This bit of code just executes the WFI |
| 44 | * for normal idles. |
| 45 | * |
| 46 | * Note: This code get's copied to internal SRAM at boot. When the OMAP |
| 47 | * wakes up it continues execution at the point it went to sleep. |
| 48 | */ |
Jean Pihet | b6338bd | 2011-02-02 16:38:06 +0100 | [diff] [blame] | 49 | .align 3 |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 50 | ENTRY(omap24xx_idle_loop_suspend) |
| 51 | stmfd sp!, {r0, lr} @ save registers on stack |
| 52 | mov r0, #0 @ clear for mcr setup |
| 53 | mcr p15, 0, r0, c7, c0, 4 @ wait for interrupt |
| 54 | ldmfd sp!, {r0, pc} @ restore regs and return |
| 55 | |
| 56 | ENTRY(omap24xx_idle_loop_suspend_sz) |
| 57 | .word . - omap24xx_idle_loop_suspend |
| 58 | |
| 59 | /* |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 60 | * omap24xx_cpu_suspend() - Forces OMAP into deep sleep state by completing |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 61 | * SDRC shutdown then ARM shutdown. Upon wake MPU is back on so just restore |
| 62 | * SDRC. |
| 63 | * |
| 64 | * Input: |
| 65 | * R0 : DLL ctrl value pre-Sleep |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 66 | * R1 : SDRC_DLLA_CTRL |
| 67 | * R2 : SDRC_POWER |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 68 | * |
| 69 | * The if the DPLL is going to AutoIdle. It seems like the DPLL may be back on |
| 70 | * when we get called, but the DLL probably isn't. We will wait a bit more in |
| 71 | * case the DPLL isn't quite there yet. The code will wait on DLL for DDR even |
| 72 | * if in unlocked mode. |
| 73 | * |
| 74 | * For less than 242x-ES2.2 upon wake from a sleep mode where the external |
| 75 | * oscillator was stopped, a timing bug exists where a non-stabilized 12MHz |
| 76 | * clock can pass into the PRCM can cause problems at DSP and IVA. |
| 77 | * To work around this the code will switch to the 32kHz source prior to sleep. |
| 78 | * Post sleep we will shift back to using the DPLL. Apparently, |
| 79 | * CM_IDLEST_CLKGEN does not reflect the full clock change so you need to wait |
| 80 | * 3x12MHz + 3x32kHz clocks for a full switch. |
| 81 | * |
| 82 | * The DLL load value is not kept in RETENTION or OFF. It needs to be restored |
| 83 | * at wake |
| 84 | */ |
Jean Pihet | b6338bd | 2011-02-02 16:38:06 +0100 | [diff] [blame] | 85 | .align 3 |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 86 | ENTRY(omap24xx_cpu_suspend) |
| 87 | stmfd sp!, {r0 - r12, lr} @ save registers on stack |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 88 | mov r3, #0x0 @ clear for mcr call |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 89 | mcr p15, 0, r3, c7, c10, 4 @ memory barrier, hope SDR/DDR finished |
| 90 | nop |
| 91 | nop |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 92 | ldr r4, [r2] @ read SDRC_POWER |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 93 | orr r4, r4, #0x40 @ enable self refresh on idle req |
| 94 | mov r5, #0x2000 @ set delay (DPLL relock + DLL relock) |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 95 | str r4, [r2] @ make it so |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 96 | nop |
Kevin Hilman | 0dc23d7 | 2009-01-29 08:57:18 -0800 | [diff] [blame] | 97 | mcr p15, 0, r3, c7, c0, 4 @ wait for interrupt |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 98 | nop |
| 99 | loop: |
| 100 | subs r5, r5, #0x1 @ awake, wait just a bit |
| 101 | bne loop |
| 102 | |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 103 | /* The DPLL has to be on before we take the DDR out of self refresh */ |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 104 | bic r4, r4, #0x40 @ now clear self refresh bit. |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 105 | str r4, [r2] @ write to SDRC_POWER |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 106 | ldr r4, A_SDRC0 @ make a clock happen |
Tony Lindgren | 1835f1d | 2008-10-06 15:49:15 +0300 | [diff] [blame] | 107 | ldr r4, [r4] @ read A_SDRC0 |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 108 | nop @ start auto refresh only after clk ok |
| 109 | movs r0, r0 @ see if DDR or SDR |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 110 | strne r0, [r1] @ rewrite DLLA to force DLL reload |
| 111 | addne r1, r1, #0x8 @ move to DLLB |
| 112 | strne r0, [r1] @ rewrite DLLB to force DLL reload |
| 113 | |
| 114 | mov r5, #0x1000 |
| 115 | loop2: |
| 116 | subs r5, r5, #0x1 |
| 117 | bne loop2 |
| 118 | /* resume*/ |
| 119 | ldmfd sp!, {r0 - r12, pc} @ restore regs and return |
| 120 | |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 121 | A_SDRC0: |
| 122 | .word A_SDRC0_V |
Tony Lindgren | 670c104 | 2006-04-02 17:46:25 +0100 | [diff] [blame] | 123 | |
| 124 | ENTRY(omap24xx_cpu_suspend_sz) |
| 125 | .word . - omap24xx_cpu_suspend |