|
@@ -36,7 +36,7 @@
|
|
|
|
|
|
.text
|
|
|
|
|
|
-/* r4 parameters */
|
|
|
+/* r1 parameters */
|
|
|
#define SDRC_NO_UNLOCK_DLL 0x0
|
|
|
#define SDRC_UNLOCK_DLL 0x1
|
|
|
|
|
@@ -71,40 +71,71 @@
|
|
|
|
|
|
/*
|
|
|
* omap3_sram_configure_core_dpll - change DPLL3 M2 divider
|
|
|
- * r0 = new SDRC_RFR_CTRL register contents
|
|
|
- * r1 = new SDRC_ACTIM_CTRLA register contents
|
|
|
- * r2 = new SDRC_ACTIM_CTRLB register contents
|
|
|
- * r3 = new M2 divider setting (only 1 and 2 supported right now)
|
|
|
- * r4 = unlock SDRC DLL? (1 = yes, 0 = no). Only unlock DLL for
|
|
|
+ *
|
|
|
+ * Params passed in registers:
|
|
|
+ * r0 = new M2 divider setting (only 1 and 2 supported right now)
|
|
|
+ * r1 = unlock SDRC DLL? (1 = yes, 0 = no). Only unlock DLL for
|
|
|
* SDRC rates < 83MHz
|
|
|
- * r5 = number of MPU cycles to wait for SDRC to stabilize after
|
|
|
+ * r2 = number of MPU cycles to wait for SDRC to stabilize after
|
|
|
* reprogramming the SDRC when switching to a slower MPU speed
|
|
|
- * r6 = new SDRC_MR_0 register value
|
|
|
- * r7 = increasing SDRC rate? (1 = yes, 0 = no)
|
|
|
+ * r3 = increasing SDRC rate? (1 = yes, 0 = no)
|
|
|
+ *
|
|
|
+ * Params passed via the stack. The needed params will be copied in SRAM
|
|
|
+ * before use by the code in SRAM (SDRAM is not accessible during SDRC
|
|
|
+ * reconfiguration):
|
|
|
+ * new SDRC_RFR_CTRL_0 register contents
|
|
|
+ * new SDRC_ACTIM_CTRL_A_0 register contents
|
|
|
+ * new SDRC_ACTIM_CTRL_B_0 register contents
|
|
|
+ * new SDRC_MR_0 register value
|
|
|
+ * new SDRC_RFR_CTRL_1 register contents
|
|
|
+ * new SDRC_ACTIM_CTRL_A_1 register contents
|
|
|
+ * new SDRC_ACTIM_CTRL_B_1 register contents
|
|
|
+ * new SDRC_MR_1 register value
|
|
|
*
|
|
|
+ * If the param SDRC_RFR_CTRL_1 is 0, the parameters
|
|
|
+ * are not programmed into the SDRC CS1 registers
|
|
|
*/
|
|
|
ENTRY(omap3_sram_configure_core_dpll)
|
|
|
stmfd sp!, {r1-r12, lr} @ store regs to stack
|
|
|
- ldr r4, [sp, #52] @ pull extra args off the stack
|
|
|
- ldr r5, [sp, #56] @ load extra args from the stack
|
|
|
- ldr r6, [sp, #60] @ load extra args from the stack
|
|
|
- ldr r7, [sp, #64] @ load extra args from the stack
|
|
|
+
|
|
|
+ @ pull the extra args off the stack
|
|
|
+ @ and store them in SRAM
|
|
|
+ ldr r4, [sp, #52]
|
|
|
+ str r4, omap_sdrc_rfr_ctrl_0_val
|
|
|
+ ldr r4, [sp, #56]
|
|
|
+ str r4, omap_sdrc_actim_ctrl_a_0_val
|
|
|
+ ldr r4, [sp, #60]
|
|
|
+ str r4, omap_sdrc_actim_ctrl_b_0_val
|
|
|
+ ldr r4, [sp, #64]
|
|
|
+ str r4, omap_sdrc_mr_0_val
|
|
|
+ ldr r4, [sp, #68]
|
|
|
+ str r4, omap_sdrc_rfr_ctrl_1_val
|
|
|
+ cmp r4, #0 @ if SDRC_RFR_CTRL_1 is 0,
|
|
|
+ beq skip_cs1_params @ do not use cs1 params
|
|
|
+ ldr r4, [sp, #72]
|
|
|
+ str r4, omap_sdrc_actim_ctrl_a_1_val
|
|
|
+ ldr r4, [sp, #76]
|
|
|
+ str r4, omap_sdrc_actim_ctrl_b_1_val
|
|
|
+ ldr r4, [sp, #80]
|
|
|
+ str r4, omap_sdrc_mr_1_val
|
|
|
+skip_cs1_params:
|
|
|
dsb @ flush buffered writes to interconnect
|
|
|
- cmp r7, #1 @ if increasing SDRC clk rate,
|
|
|
+
|
|
|
+ cmp r3, #1 @ if increasing SDRC clk rate,
|
|
|
bleq configure_sdrc @ program the SDRC regs early (for RFR)
|
|
|
- cmp r4, #SDRC_UNLOCK_DLL @ set the intended DLL state
|
|
|
+ cmp r1, #SDRC_UNLOCK_DLL @ set the intended DLL state
|
|
|
bleq unlock_dll
|
|
|
blne lock_dll
|
|
|
bl sdram_in_selfrefresh @ put SDRAM in self refresh, idle SDRC
|
|
|
bl configure_core_dpll @ change the DPLL3 M2 divider
|
|
|
bl enable_sdrc @ take SDRC out of idle
|
|
|
- cmp r4, #SDRC_UNLOCK_DLL @ wait for DLL status to change
|
|
|
+ cmp r1, #SDRC_UNLOCK_DLL @ wait for DLL status to change
|
|
|
bleq wait_dll_unlock
|
|
|
blne wait_dll_lock
|
|
|
- cmp r7, #1 @ if increasing SDRC clk rate,
|
|
|
+ cmp r3, #1 @ if increasing SDRC clk rate,
|
|
|
beq return_to_sdram @ return to SDRAM code, otherwise,
|
|
|
bl configure_sdrc @ reprogram SDRC regs now
|
|
|
- mov r12, r5
|
|
|
+ mov r12, r2
|
|
|
bl wait_clk_stable @ wait for SDRC to stabilize
|
|
|
return_to_sdram:
|
|
|
isb @ prevent speculative exec past here
|
|
@@ -149,7 +180,7 @@ configure_core_dpll:
|
|
|
ldr r12, [r11]
|
|
|
ldr r10, core_m2_mask_val @ modify m2 for core dpll
|
|
|
and r12, r12, r10
|
|
|
- orr r12, r12, r3, lsl #CORE_DPLL_CLKOUT_DIV_SHIFT
|
|
|
+ orr r12, r12, r0, lsl #CORE_DPLL_CLKOUT_DIV_SHIFT
|
|
|
str r12, [r11]
|
|
|
ldr r12, [r11] @ posted-write barrier for CM
|
|
|
bx lr
|
|
@@ -187,15 +218,34 @@ wait_dll_unlock:
|
|
|
bne wait_dll_unlock
|
|
|
bx lr
|
|
|
configure_sdrc:
|
|
|
- ldr r11, omap3_sdrc_rfr_ctrl
|
|
|
- str r0, [r11]
|
|
|
- ldr r11, omap3_sdrc_actim_ctrla
|
|
|
- str r1, [r11]
|
|
|
- ldr r11, omap3_sdrc_actim_ctrlb
|
|
|
- str r2, [r11]
|
|
|
+ ldr r12, omap_sdrc_rfr_ctrl_0_val @ fetch value from SRAM
|
|
|
+ ldr r11, omap3_sdrc_rfr_ctrl_0 @ fetch addr from SRAM
|
|
|
+ str r12, [r11] @ store
|
|
|
+ ldr r12, omap_sdrc_actim_ctrl_a_0_val
|
|
|
+ ldr r11, omap3_sdrc_actim_ctrl_a_0
|
|
|
+ str r12, [r11]
|
|
|
+ ldr r12, omap_sdrc_actim_ctrl_b_0_val
|
|
|
+ ldr r11, omap3_sdrc_actim_ctrl_b_0
|
|
|
+ str r12, [r11]
|
|
|
+ ldr r12, omap_sdrc_mr_0_val
|
|
|
ldr r11, omap3_sdrc_mr_0
|
|
|
- str r6, [r11]
|
|
|
- ldr r6, [r11] @ posted-write barrier for SDRC
|
|
|
+ str r12, [r11]
|
|
|
+ ldr r12, omap_sdrc_rfr_ctrl_1_val
|
|
|
+ cmp r12, #0 @ if SDRC_RFR_CTRL_1 is 0,
|
|
|
+ beq skip_cs1_prog @ do not program cs1 params
|
|
|
+ ldr r11, omap3_sdrc_rfr_ctrl_1
|
|
|
+ str r12, [r11]
|
|
|
+ ldr r12, omap_sdrc_actim_ctrl_a_1_val
|
|
|
+ ldr r11, omap3_sdrc_actim_ctrl_a_1
|
|
|
+ str r12, [r11]
|
|
|
+ ldr r12, omap_sdrc_actim_ctrl_b_1_val
|
|
|
+ ldr r11, omap3_sdrc_actim_ctrl_b_1
|
|
|
+ str r12, [r11]
|
|
|
+ ldr r12, omap_sdrc_mr_1_val
|
|
|
+ ldr r11, omap3_sdrc_mr_1
|
|
|
+ str r12, [r11]
|
|
|
+skip_cs1_prog:
|
|
|
+ ldr r12, [r11] @ posted-write barrier for SDRC
|
|
|
bx lr
|
|
|
|
|
|
omap3_sdrc_power:
|
|
@@ -206,14 +256,40 @@ omap3_cm_idlest1_core:
|
|
|
.word OMAP34XX_CM_REGADDR(CORE_MOD, CM_IDLEST)
|
|
|
omap3_cm_iclken1_core:
|
|
|
.word OMAP34XX_CM_REGADDR(CORE_MOD, CM_ICLKEN1)
|
|
|
-omap3_sdrc_rfr_ctrl:
|
|
|
+
|
|
|
+omap3_sdrc_rfr_ctrl_0:
|
|
|
.word OMAP34XX_SDRC_REGADDR(SDRC_RFR_CTRL_0)
|
|
|
-omap3_sdrc_actim_ctrla:
|
|
|
+omap3_sdrc_rfr_ctrl_1:
|
|
|
+ .word OMAP34XX_SDRC_REGADDR(SDRC_RFR_CTRL_1)
|
|
|
+omap3_sdrc_actim_ctrl_a_0:
|
|
|
.word OMAP34XX_SDRC_REGADDR(SDRC_ACTIM_CTRL_A_0)
|
|
|
-omap3_sdrc_actim_ctrlb:
|
|
|
+omap3_sdrc_actim_ctrl_a_1:
|
|
|
+ .word OMAP34XX_SDRC_REGADDR(SDRC_ACTIM_CTRL_A_1)
|
|
|
+omap3_sdrc_actim_ctrl_b_0:
|
|
|
.word OMAP34XX_SDRC_REGADDR(SDRC_ACTIM_CTRL_B_0)
|
|
|
+omap3_sdrc_actim_ctrl_b_1:
|
|
|
+ .word OMAP34XX_SDRC_REGADDR(SDRC_ACTIM_CTRL_B_1)
|
|
|
omap3_sdrc_mr_0:
|
|
|
.word OMAP34XX_SDRC_REGADDR(SDRC_MR_0)
|
|
|
+omap3_sdrc_mr_1:
|
|
|
+ .word OMAP34XX_SDRC_REGADDR(SDRC_MR_1)
|
|
|
+omap_sdrc_rfr_ctrl_0_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+omap_sdrc_rfr_ctrl_1_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+omap_sdrc_actim_ctrl_a_0_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+omap_sdrc_actim_ctrl_a_1_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+omap_sdrc_actim_ctrl_b_0_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+omap_sdrc_actim_ctrl_b_1_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+omap_sdrc_mr_0_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+omap_sdrc_mr_1_val:
|
|
|
+ .word 0xDEADBEEF
|
|
|
+
|
|
|
omap3_sdrc_dlla_status:
|
|
|
.word OMAP34XX_SDRC_REGADDR(SDRC_DLLA_STATUS)
|
|
|
omap3_sdrc_dlla_ctrl:
|
|
@@ -223,3 +299,4 @@ core_m2_mask_val:
|
|
|
|
|
|
ENTRY(omap3_sram_configure_core_dpll_sz)
|
|
|
.word . - omap3_sram_configure_core_dpll
|
|
|
+
|