blob: 487fa8609cde217bbae6abe8a9166f22a8272bb8 [file] [log] [blame]
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +03001/*
2 * linux/arch/arm/mach-omap3/sram.S
3 *
4 * Omap3 specific functions that need to be run in internal SRAM
5 *
Paul Walmsley4267b5d2009-06-19 19:08:27 -06006 * Copyright (C) 2004, 2007, 2008 Texas Instruments, Inc.
7 * Copyright (C) 2008 Nokia Corporation
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +03008 *
Paul Walmsley4267b5d2009-06-19 19:08:27 -06009 * Rajendra Nayak <rnayak@ti.com>
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +030010 * Richard Woodruff <r-woodruff2@ti.com>
Paul Walmsley4267b5d2009-06-19 19:08:27 -060011 * Paul Walmsley
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +030012 *
13 * This program is free software; you can redistribute it and/or
14 * modify it under the terms of the GNU General Public License as
15 * published by the Free Software Foundation; either version 2 of
16 * the License, or (at your option) any later version.
17 *
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR /PURPOSE. See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, write to the Free Software
25 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
26 * MA 02111-1307 USA
27 */
28#include <linux/linkage.h>
29#include <asm/assembler.h>
30#include <mach/hardware.h>
31
32#include <mach/io.h>
33
34#include "sdrc.h"
35#include "cm.h"
36
37 .text
38
Paul Walmsleydf14e472009-06-19 19:08:28 -060039/* r4 parameters */
40#define SDRC_NO_UNLOCK_DLL 0x0
41#define SDRC_UNLOCK_DLL 0x1
42
43/* SDRC_DLLA_CTRL bit settings */
44#define DLLIDLE_MASK 0x4
45
46/* SDRC_DLLA_STATUS bit settings */
47#define LOCKSTATUS_MASK 0x4
48
49/* SDRC_POWER bit settings */
50#define SRFRONIDLEREQ_MASK 0x40
51#define PWDENA_MASK 0x4
52
53/* CM_IDLEST1_CORE bit settings */
54#define ST_SDRC_MASK 0x2
55
56/* CM_ICLKEN1_CORE bit settings */
57#define EN_SDRC_MASK 0x2
58
59/* CM_CLKSEL1_PLL bit settings */
60#define CORE_DPLL_CLKOUT_DIV_SHIFT 0x1b
61
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +030062/*
Paul Walmsley4267b5d2009-06-19 19:08:27 -060063 * omap3_sram_configure_core_dpll - change DPLL3 M2 divider
64 * r0 = new SDRC_RFR_CTRL register contents
65 * r1 = new SDRC_ACTIM_CTRLA register contents
66 * r2 = new SDRC_ACTIM_CTRLB register contents
67 * r3 = new M2 divider setting (only 1 and 2 supported right now)
68 * r4 = unlock SDRC DLL? (1 = yes, 0 = no). Only unlock DLL for
Paul Walmsley4519c2b2009-05-12 17:26:32 -060069 * SDRC rates < 83MHz
Paul Walmsleyc9812d02009-06-19 19:08:26 -060070 * r5 = number of MPU cycles to wait for SDRC to stabilize after
71 * reprogramming the SDRC when switching to a slower MPU speed
Paul Walmsley4267b5d2009-06-19 19:08:27 -060072 * r6 = new SDRC_MR_0 register value
Tero Kristo3afec6332009-06-19 19:08:29 -060073 * r7 = increasing SDRC rate? (1 = yes, 0 = no)
Paul Walmsleyc9812d02009-06-19 19:08:26 -060074 *
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +030075 */
76ENTRY(omap3_sram_configure_core_dpll)
77 stmfd sp!, {r1-r12, lr} @ store regs to stack
Paul Walmsley4519c2b2009-05-12 17:26:32 -060078 ldr r4, [sp, #52] @ pull extra args off the stack
Paul Walmsleyc9812d02009-06-19 19:08:26 -060079 ldr r5, [sp, #56] @ load extra args from the stack
Paul Walmsleyd0ba3922009-06-19 19:08:27 -060080 ldr r6, [sp, #60] @ load extra args from the stack
Tero Kristo3afec6332009-06-19 19:08:29 -060081 ldr r7, [sp, #64] @ load extra args from the stack
Paul Walmsley69d42552009-05-12 17:27:09 -060082 dsb @ flush buffered writes to interconnect
Tero Kristo3afec6332009-06-19 19:08:29 -060083 cmp r7, #1 @ if increasing SDRC clk rate,
84 bleq configure_sdrc @ program the SDRC regs early (for RFR)
Paul Walmsleydf14e472009-06-19 19:08:28 -060085 cmp r4, #SDRC_UNLOCK_DLL @ set the intended DLL state
Paul Walmsley4519c2b2009-05-12 17:26:32 -060086 bleq unlock_dll
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +030087 blne lock_dll
Paul Walmsley4267b5d2009-06-19 19:08:27 -060088 bl sdram_in_selfrefresh @ put SDRAM in self refresh, idle SDRC
89 bl configure_core_dpll @ change the DPLL3 M2 divider
90 bl enable_sdrc @ take SDRC out of idle
Paul Walmsleydf14e472009-06-19 19:08:28 -060091 cmp r4, #SDRC_UNLOCK_DLL @ wait for DLL status to change
Paul Walmsley4519c2b2009-05-12 17:26:32 -060092 bleq wait_dll_unlock
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +030093 blne wait_dll_lock
Tero Kristo3afec6332009-06-19 19:08:29 -060094 cmp r7, #1 @ if increasing SDRC clk rate,
Paul Walmsley4267b5d2009-06-19 19:08:27 -060095 beq return_to_sdram @ return to SDRAM code, otherwise,
96 bl configure_sdrc @ reprogram SDRC regs now
97 mov r12, r5
98 bl wait_clk_stable @ wait for SDRC to stabilize
Paul Walmsleyc9812d02009-06-19 19:08:26 -060099return_to_sdram:
Paul Walmsley69d42552009-05-12 17:27:09 -0600100 isb @ prevent speculative exec past here
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300101 mov r0, #0 @ return value
102 ldmfd sp!, {r1-r12, pc} @ restore regs and return
103unlock_dll:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600104 ldr r11, omap3_sdrc_dlla_ctrl
105 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600106 orr r12, r12, #DLLIDLE_MASK
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600107 str r12, [r11] @ (no OCP barrier needed)
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300108 bx lr
109lock_dll:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600110 ldr r11, omap3_sdrc_dlla_ctrl
111 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600112 bic r12, r12, #DLLIDLE_MASK
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600113 str r12, [r11] @ (no OCP barrier needed)
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300114 bx lr
115sdram_in_selfrefresh:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600116 ldr r11, omap3_sdrc_power @ read the SDRC_POWER register
117 ldr r12, [r11] @ read the contents of SDRC_POWER
118 mov r9, r12 @ keep a copy of SDRC_POWER bits
Paul Walmsleydf14e472009-06-19 19:08:28 -0600119 orr r12, r12, #SRFRONIDLEREQ_MASK @ enable self refresh on idle
120 bic r12, r12, #PWDENA_MASK @ clear PWDENA
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600121 str r12, [r11] @ write back to SDRC_POWER register
122 ldr r12, [r11] @ posted-write barrier for SDRC
Paul Walmsley4267b5d2009-06-19 19:08:27 -0600123idle_sdrc:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600124 ldr r11, omap3_cm_iclken1_core @ read the CM_ICLKEN1_CORE reg
125 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600126 bic r12, r12, #EN_SDRC_MASK @ disable iclk bit for SDRC
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600127 str r12, [r11]
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300128wait_sdrc_idle:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600129 ldr r11, omap3_cm_idlest1_core
130 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600131 and r12, r12, #ST_SDRC_MASK @ check for SDRC idle
132 cmp r12, #ST_SDRC_MASK
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300133 bne wait_sdrc_idle
134 bx lr
135configure_core_dpll:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600136 ldr r11, omap3_cm_clksel1_pll
137 ldr r12, [r11]
138 ldr r10, core_m2_mask_val @ modify m2 for core dpll
139 and r12, r12, r10
Paul Walmsleydf14e472009-06-19 19:08:28 -0600140 orr r12, r12, r3, lsl #CORE_DPLL_CLKOUT_DIV_SHIFT
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600141 str r12, [r11]
142 ldr r12, [r11] @ posted-write barrier for CM
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300143 bx lr
144wait_clk_stable:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600145 subs r12, r12, #1
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300146 bne wait_clk_stable
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300147 bx lr
148enable_sdrc:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600149 ldr r11, omap3_cm_iclken1_core
150 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600151 orr r12, r12, #EN_SDRC_MASK @ enable iclk bit for SDRC
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600152 str r12, [r11]
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300153wait_sdrc_idle1:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600154 ldr r11, omap3_cm_idlest1_core
155 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600156 and r12, r12, #ST_SDRC_MASK
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600157 cmp r12, #0
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300158 bne wait_sdrc_idle1
Paul Walmsleyfa0406a2009-05-12 17:27:09 -0600159restore_sdrc_power_val:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600160 ldr r11, omap3_sdrc_power
161 str r9, [r11] @ restore SDRC_POWER, no barrier needed
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300162 bx lr
163wait_dll_lock:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600164 ldr r11, omap3_sdrc_dlla_status
165 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600166 and r12, r12, #LOCKSTATUS_MASK
167 cmp r12, #LOCKSTATUS_MASK
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300168 bne wait_dll_lock
169 bx lr
170wait_dll_unlock:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600171 ldr r11, omap3_sdrc_dlla_status
172 ldr r12, [r11]
Paul Walmsleydf14e472009-06-19 19:08:28 -0600173 and r12, r12, #LOCKSTATUS_MASK
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600174 cmp r12, #0x0
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300175 bne wait_dll_unlock
176 bx lr
177configure_sdrc:
Paul Walmsleyb2abb272009-05-12 17:27:10 -0600178 ldr r11, omap3_sdrc_rfr_ctrl
179 str r0, [r11]
180 ldr r11, omap3_sdrc_actim_ctrla
181 str r1, [r11]
182 ldr r11, omap3_sdrc_actim_ctrlb
183 str r2, [r11]
Paul Walmsleyd0ba3922009-06-19 19:08:27 -0600184 ldr r11, omap3_sdrc_mr_0
185 str r6, [r11]
186 ldr r6, [r11] @ posted-write barrier for SDRC
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300187 bx lr
188
189omap3_sdrc_power:
190 .word OMAP34XX_SDRC_REGADDR(SDRC_POWER)
191omap3_cm_clksel1_pll:
192 .word OMAP34XX_CM_REGADDR(PLL_MOD, CM_CLKSEL1)
193omap3_cm_idlest1_core:
194 .word OMAP34XX_CM_REGADDR(CORE_MOD, CM_IDLEST)
195omap3_cm_iclken1_core:
196 .word OMAP34XX_CM_REGADDR(CORE_MOD, CM_ICLKEN1)
197omap3_sdrc_rfr_ctrl:
198 .word OMAP34XX_SDRC_REGADDR(SDRC_RFR_CTRL_0)
199omap3_sdrc_actim_ctrla:
200 .word OMAP34XX_SDRC_REGADDR(SDRC_ACTIM_CTRL_A_0)
201omap3_sdrc_actim_ctrlb:
202 .word OMAP34XX_SDRC_REGADDR(SDRC_ACTIM_CTRL_B_0)
Paul Walmsleyd0ba3922009-06-19 19:08:27 -0600203omap3_sdrc_mr_0:
204 .word OMAP34XX_SDRC_REGADDR(SDRC_MR_0)
Syed Mohammed, Khasimcc26b3b2008-10-09 17:51:41 +0300205omap3_sdrc_dlla_status:
206 .word OMAP34XX_SDRC_REGADDR(SDRC_DLLA_STATUS)
207omap3_sdrc_dlla_ctrl:
208 .word OMAP34XX_SDRC_REGADDR(SDRC_DLLA_CTRL)
209core_m2_mask_val:
210 .word 0x07FFFFFF
211
212ENTRY(omap3_sram_configure_core_dpll_sz)
213 .word . - omap3_sram_configure_core_dpll