167 lines
3.4 KiB
ArmAsm
167 lines
3.4 KiB
ArmAsm
|
/* SPDX-License-Identifier: GPL-2.0+ */
|
||
|
/*
|
||
|
* (C) Copyright 2013 Philippe Reynes <tremyfr@yahoo.fr>
|
||
|
*/
|
||
|
|
||
|
#include <config.h>
|
||
|
#include <generated/asm-offsets.h>
|
||
|
#include <asm/macro.h>
|
||
|
#include <asm/arch/imx-regs.h>
|
||
|
#include "apf27.h"
|
||
|
|
||
|
.macro init_aipi
|
||
|
/*
|
||
|
* setup AIPI1 and AIPI2
|
||
|
*/
|
||
|
write32 AIPI1_PSR0, ACFG_AIPI1_PSR0_VAL
|
||
|
write32 AIPI1_PSR1, ACFG_AIPI1_PSR1_VAL
|
||
|
write32 AIPI2_PSR0, ACFG_AIPI2_PSR0_VAL
|
||
|
write32 AIPI2_PSR1, ACFG_AIPI2_PSR1_VAL
|
||
|
|
||
|
/* Change SDRAM signal strengh */
|
||
|
ldr r0, =GPCR
|
||
|
ldr r1, =ACFG_GPCR_VAL
|
||
|
ldr r5, [r0]
|
||
|
orr r5, r5, r1
|
||
|
str r5, [r0]
|
||
|
|
||
|
.endm /* init_aipi */
|
||
|
|
||
|
.macro init_clock
|
||
|
ldr r0, =CSCR
|
||
|
/* disable MPLL/SPLL first */
|
||
|
ldr r1, [r0]
|
||
|
bic r1, r1, #(CSCR_MPEN|CSCR_SPEN)
|
||
|
str r1, [r0]
|
||
|
|
||
|
/*
|
||
|
* pll clock initialization predefined in apf27.h
|
||
|
*/
|
||
|
write32 MPCTL0, ACFG_MPCTL0_VAL
|
||
|
write32 SPCTL0, ACFG_SPCTL0_VAL
|
||
|
|
||
|
write32 CSCR, ACFG_CSCR_VAL|CSCR_MPLL_RESTART|CSCR_SPLL_RESTART
|
||
|
|
||
|
/*
|
||
|
* add some delay here
|
||
|
*/
|
||
|
mov r1, #0x1000
|
||
|
1: subs r1, r1, #0x1
|
||
|
bne 1b
|
||
|
|
||
|
/* peripheral clock divider */
|
||
|
write32 PCDR0, ACFG_PCDR0_VAL
|
||
|
write32 PCDR1, ACFG_PCDR1_VAL
|
||
|
|
||
|
/* Configure PCCR0 and PCCR1 */
|
||
|
write32 PCCR0, ACFG_PCCR0_VAL
|
||
|
write32 PCCR1, ACFG_PCCR1_VAL
|
||
|
|
||
|
.endm /* init_clock */
|
||
|
|
||
|
.macro init_ddr
|
||
|
/* wait for SDRAM/LPDDR ready (SDRAMRDY) */
|
||
|
ldr r0, =IMX_ESD_BASE
|
||
|
ldr r4, =ESDMISC_SDRAM_RDY
|
||
|
2: ldr r1, [r0, #ESDMISC_ROF]
|
||
|
ands r1, r1, r4
|
||
|
bpl 2b
|
||
|
|
||
|
/* LPDDR Soft Reset Mobile/Low Power DDR SDRAM. */
|
||
|
ldr r0, =IMX_ESD_BASE
|
||
|
ldr r4, =ACFG_ESDMISC_VAL
|
||
|
orr r1, r4, #ESDMISC_MDDR_DL_RST
|
||
|
str r1, [r0, #ESDMISC_ROF]
|
||
|
|
||
|
/* Hold for more than 200ns */
|
||
|
ldr r1, =0x10000
|
||
|
1: subs r1, r1, #0x1
|
||
|
bne 1b
|
||
|
|
||
|
str r4, [r0]
|
||
|
|
||
|
ldr r0, =IMX_ESD_BASE
|
||
|
ldr r1, =ACFG_SDRAM_ESDCFG_REGISTER_VAL
|
||
|
str r1, [r0, #ESDCFG0_ROF]
|
||
|
|
||
|
ldr r0, =IMX_ESD_BASE
|
||
|
ldr r1, =ACFG_PRECHARGE_CMD
|
||
|
str r1, [r0, #ESDCTL0_ROF]
|
||
|
|
||
|
/* write8(0xA0001000, any value) */
|
||
|
ldr r1, =PHYS_SDRAM_1+ACFG_SDRAM_PRECHARGE_ALL_VAL
|
||
|
strb r2, [r1]
|
||
|
|
||
|
ldr r1, =ACFG_AUTOREFRESH_CMD
|
||
|
str r1, [r0, #ESDCTL0_ROF]
|
||
|
|
||
|
ldr r4, =PHYS_SDRAM_1 /* CSD0 base address */
|
||
|
|
||
|
ldr r6,=0x7 /* load loop counter */
|
||
|
1: str r5,[r4] /* run auto-refresh cycle to array 0 */
|
||
|
subs r6,r6,#1
|
||
|
bne 1b
|
||
|
|
||
|
ldr r1, =ACFG_SET_MODE_REG_CMD
|
||
|
str r1, [r0, #ESDCTL0_ROF]
|
||
|
|
||
|
/* set standard mode register */
|
||
|
ldr r4, = PHYS_SDRAM_1+ACFG_SDRAM_MODE_REGISTER_VAL
|
||
|
strb r2, [r4]
|
||
|
|
||
|
/* set extended mode register */
|
||
|
ldr r4, =PHYS_SDRAM_1+ACFG_SDRAM_EXT_MODE_REGISTER_VAL
|
||
|
strb r5, [r4]
|
||
|
|
||
|
ldr r1, =ACFG_NORMAL_RW_CMD
|
||
|
str r1, [r0, #ESDCTL0_ROF]
|
||
|
|
||
|
/* 2nd sdram */
|
||
|
ldr r0, =IMX_ESD_BASE
|
||
|
ldr r1, =ACFG_SDRAM_ESDCFG_REGISTER_VAL
|
||
|
str r1, [r0, #ESDCFG1_ROF]
|
||
|
|
||
|
ldr r0, =IMX_ESD_BASE
|
||
|
ldr r1, =ACFG_PRECHARGE_CMD
|
||
|
str r1, [r0, #ESDCTL1_ROF]
|
||
|
|
||
|
/* write8(0xB0001000, any value) */
|
||
|
ldr r1, =PHYS_SDRAM_2+ACFG_SDRAM_PRECHARGE_ALL_VAL
|
||
|
strb r2, [r1]
|
||
|
|
||
|
ldr r1, =ACFG_AUTOREFRESH_CMD
|
||
|
str r1, [r0, #ESDCTL1_ROF]
|
||
|
|
||
|
ldr r4, =PHYS_SDRAM_2 /* CSD1 base address */
|
||
|
|
||
|
ldr r6,=0x7 /* load loop counter */
|
||
|
1: str r5,[r4] /* run auto-refresh cycle to array 0 */
|
||
|
subs r6,r6,#1
|
||
|
bne 1b
|
||
|
|
||
|
ldr r1, =ACFG_SET_MODE_REG_CMD
|
||
|
str r1, [r0, #ESDCTL1_ROF]
|
||
|
|
||
|
/* set standard mode register */
|
||
|
ldr r4, =PHYS_SDRAM_2+ACFG_SDRAM_MODE_REGISTER_VAL
|
||
|
strb r2, [r4]
|
||
|
|
||
|
/* set extended mode register */
|
||
|
ldr r4, =PHYS_SDRAM_2+ACFG_SDRAM_EXT_MODE_REGISTER_VAL
|
||
|
strb r2, [r4]
|
||
|
|
||
|
ldr r1, =ACFG_NORMAL_RW_CMD
|
||
|
str r1, [r0, #ESDCTL1_ROF]
|
||
|
.endm /* init_ddr */
|
||
|
|
||
|
.globl lowlevel_init
|
||
|
lowlevel_init:
|
||
|
|
||
|
init_aipi
|
||
|
init_clock
|
||
|
#ifdef CONFIG_SPL_BUILD
|
||
|
init_ddr
|
||
|
#endif
|
||
|
|
||
|
mov pc, lr
|