| /* |
| * Copyright (C) 2011 Andes Technology Corporation |
| * Macpaul Lin, Andes Technology Corporation <macpaul@andestech.com> |
| * |
| * SPDX-License-Identifier: GPL-2.0+ |
| */ |
| |
| .text |
| |
| #include <common.h> |
| #include <config.h> |
| |
| #include <asm/macro.h> |
| #include <generated/asm-offsets.h> |
| |
| /* |
| * parameters for Synopsys DWC DDR2/DDR1 Memory Controller |
| */ |
| #define DDR2C_BASE_A (CONFIG_DWCDDR21MCTL_BASE) |
| #define DDR2C_CCR_A (DDR2C_BASE_A + DWCDDR21MCTL_CCR) |
| #define DDR2C_DCR_A (DDR2C_BASE_A + DWCDDR21MCTL_DCR) |
| #define DDR2C_IOCR_A (DDR2C_BASE_A + DWCDDR21MCTL_IOCR) |
| #define DDR2C_CSR_A (DDR2C_BASE_A + DWCDDR21MCTL_CSR) |
| #define DDR2C_DRR_A (DDR2C_BASE_A + DWCDDR21MCTL_DRR) |
| #define DDR2C_DLLCR0_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR0) |
| #define DDR2C_DLLCR1_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR1) |
| #define DDR2C_DLLCR2_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR2) |
| #define DDR2C_DLLCR3_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR3) |
| #define DDR2C_DLLCR4_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR4) |
| #define DDR2C_DLLCR5_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR5) |
| #define DDR2C_DLLCR6_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR6) |
| #define DDR2C_DLLCR7_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR7) |
| #define DDR2C_DLLCR8_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR8) |
| #define DDR2C_DLLCR9_A (DDR2C_BASE_A + DWCDDR21MCTL_DLLCR9) |
| #define DDR2C_RSLR0_A (DDR2C_BASE_A + DWCDDR21MCTL_RSLR0) |
| #define DDR2C_RDGR0_A (DDR2C_BASE_A + DWCDDR21MCTL_RDGR0) |
| #define DDR2C_DTAR_A (DDR2C_BASE_A + DWCDDR21MCTL_DTAR) |
| #define DDR2C_MR_A (DDR2C_BASE_A + DWCDDR21MCTL_MR) |
| |
| #define DDR2C_CCR_D CONFIG_SYS_DWCDDR21MCTL_CCR |
| #define DDR2C_CCR_D2 CONFIG_SYS_DWCDDR21MCTL_CCR2 |
| #define DDR2C_DCR_D CONFIG_SYS_DWCDDR21MCTL_DCR |
| #define DDR2C_IOCR_D CONFIG_SYS_DWCDDR21MCTL_IOCR |
| #define DDR2C_CSR_D CONFIG_SYS_DWCDDR21MCTL_CSR |
| #define DDR2C_DRR_D CONFIG_SYS_DWCDDR21MCTL_DRR |
| #define DDR2C_RSLR0_D CONFIG_SYS_DWCDDR21MCTL_RSLR0 |
| #define DDR2C_RDGR0_D CONFIG_SYS_DWCDDR21MCTL_RDGR0 |
| #define DDR2C_DTAR_D CONFIG_SYS_DWCDDR21MCTL_DTAR |
| #define DDR2C_MR_D CONFIG_SYS_DWCDDR21MCTL_MR |
| |
| #define DDR2C_DLLCR0_D CONFIG_SYS_DWCDDR21MCTL_DLLCR0 /* 0-9 are same */ |
| |
| /* |
| * parameters for the ahbc controller |
| */ |
| #define AHBC_CR_A (CONFIG_FTAHBC020S_BASE + FTAHBC020S_CR) |
| #define AHBC_BSR6_A (CONFIG_FTAHBC020S_BASE + FTAHBC020S_SLAVE_BSR_6) |
| |
| #define AHBC_BSR6_D CONFIG_SYS_FTAHBC020S_SLAVE_BSR_6 |
| |
| /* |
| * parameters for the ANDES PCU controller |
| */ |
| #define PCU_PCS4_A (CONFIG_ANDES_PCU_BASE + ANDES_PCU_PCS4) |
| #define PCU_PCS4_D CONFIG_SYS_ANDES_CPU_PCS4 |
| |
| /* |
| * numeric 7 segment display |
| */ |
| .macro led, num |
| write32 CONFIG_DEBUG_LED, \num |
| .endm |
| |
| /* |
| * Waiting for SDRAM to set up |
| */ |
| /* |
| .macro wait_sdram |
| li $r0, DDR2C_CSR_A |
| 1: |
| lwi $r1, [$r0+FTSDMC021_CR2] |
| bnez $r1, 1b |
| .endm |
| */ |
| |
| #ifndef CONFIG_SKIP_LOWLEVEL_INIT |
| .globl lowlevel_init |
| lowlevel_init: |
| move $r10, $lp |
| |
| /* U200 */ |
| ! led 0x00 |
| ! jal scale_to_500mhz |
| |
| led 0x10 |
| jal mem_init |
| |
| led 0x20 |
| jal remap |
| |
| #if (defined(NDS32_EXT_FPU_DP) || defined(NDS32_EXT_FPU_SP)) |
| led 0x2f |
| jal enable_fpu |
| #endif |
| |
| led 0x30 |
| ret $r10 |
| |
| scale_to_500mhz: |
| move $r11, $lp |
| |
| /* |
| * scale to 500Mhz |
| */ |
| led 0x01 |
| write32 PCU_PCS4_A, 0x1102000f ! save data to PCS4 |
| |
| move $lp, $r11 |
| ret |
| |
| mem_init: |
| move $r11, $lp |
| |
| /* |
| * config AHB Controller |
| */ |
| led 0x12 |
| write32 AHBC_BSR6_A, AHBC_BSR6_D |
| |
| /* |
| * config Synopsys DWC DDR2/DDR1 Memory Controller |
| */ |
| ddr2c_init: |
| set_dcr: |
| led 0x14 |
| write32 DDR2C_DCR_A, DDR2C_DCR_D ! 0x000020d4 |
| |
| auto_sizing: |
| /* |
| * ebios: $r10->$r7, $r11->$r8, $r12->$r9, $r13->$r12, $r14->$r13 |
| */ |
| set_iocr: |
| led 0x19 |
| write32 DDR2C_IOCR_A, DDR2C_IOCR_D |
| set_drr: |
| led 0x16 |
| write32 DDR2C_DRR_A, DDR2C_DRR_D ! 0x00034812 |
| set_dllcr: |
| led 0x18 |
| write32 DDR2C_DLLCR0_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR1_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR2_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR3_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR4_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR5_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR6_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR7_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR8_A, DDR2C_DLLCR0_D |
| write32 DDR2C_DLLCR9_A, DDR2C_DLLCR0_D |
| set_rslr0: |
| write32 DDR2C_RSLR0_A, DDR2C_RSLR0_D ! 0x00000040 |
| set_rdgr0: |
| write32 DDR2C_RDGR0_A, DDR2C_RDGR0_D ! 0x000055cf |
| set_dtar: |
| led 0x15 |
| write32 DDR2C_DTAR_A, DDR2C_DTAR_D ! 0x00100000 |
| set_mode: |
| led 0x17 |
| write32 DDR2C_MR_A, DDR2C_MR_D ! 0x00000852 |
| set_ccr: |
| write32 DDR2C_CCR_A, DDR2C_CCR_D |
| |
| #ifdef TRIGGER_INIT: |
| trigger_init: |
| write32 DDR2C_CCR_A, DDR2C_CCR_D ! 0x80020000 |
| |
| /* Wait for ddr init state to be set */ |
| msync ALL |
| isb |
| |
| /* Wait until the config initialization is finish */ |
| 1: |
| la $r4, DDR2C_CSR_A |
| lwi $r5, [$r4] |
| srli $r5, $r5, 23 |
| bnez $r5, 1b |
| #endif |
| |
| data_training: |
| ! write32 DDR2C_CCR_A, DDR2C_CCR_D2 ! 0x40020004 |
| |
| /* Wait for ddr init state to be set */ |
| msync ALL |
| isb |
| |
| /* wait until the ddr data trainning is complete */ |
| 1: |
| la $r4, DDR2C_CSR_A |
| lwi $r5, [$r4] |
| srli $r6, $r5, 23 |
| bnez $r6, 1b |
| |
| lwi $r1, [$r4] |
| srli $r6, $r5, 20 |
| li $r5, 0x00ffffff |
| swi $r1, [$r4] |
| bnez $r6, ddr2c_init |
| |
| led 0x1a |
| move $lp, $r11 |
| ret |
| |
| remap: |
| move $r11, $lp |
| #ifdef __NDS32_N1213_43U1H__ /* NDS32 V0 ISA - AG101 Only */ |
| bal 2f |
| relo_base: |
| move $r0, $lp |
| #else |
| relo_base: |
| mfusr $r0, $pc |
| #endif /* __NDS32_N1213_43U1H__ */ |
| |
| /* |
| * Remapping |
| */ |
| #ifdef CONFIG_MEM_REMAP |
| /* |
| * Copy ROM code to SDRAM base for memory remap layout. |
| * This is not the real relocation, the real relocation is the function |
| * relocate_code() is start.S which supports the systems is memory |
| * remapped or not. |
| */ |
| /* |
| * Doing memory remap is essential for preparing some non-OS or RTOS |
| * applications. |
| * |
| * This is also a must on ADP-AG101 board. |
| * The reason is because the ROM/FLASH circuit on PCB board. |
| * AG101-A0 board has 2 jumpers MA17 and SW5 to configure which |
| * ROM/FLASH is used to boot. |
| * |
| * When SW5 = "0101", MA17 = LO, the ROM is connected to BANK0, |
| * and the FLASH is connected to BANK1. |
| * When SW5 = "1010", MA17 = HI, the ROM is disabled (still at BANK0), |
| * and the FLASH is connected to BANK0. |
| * It will occur problem when doing flash probing if the flash is at |
| * BANK0 (0x00000000) while memory remapping was skipped. |
| * |
| * Other board like ADP-AG101P may not enable this since there is only |
| * a FLASH connected to bank0. |
| */ |
| led 0x21 |
| li $r4, PHYS_SDRAM_0_AT_INIT /* 0x10000000 */ |
| li $r5, 0x0 |
| la $r1, relo_base /* get $pc or $lp */ |
| sub $r2, $r0, $r1 |
| sethi $r6, hi20(_end) |
| ori $r6, $r6, lo12(_end) |
| add $r6, $r6, $r2 |
| 1: |
| lwi.p $r7, [$r5], #4 |
| swi.p $r7, [$r4], #4 |
| blt $r5, $r6, 1b |
| |
| /* set remap bit */ |
| /* |
| * MEM remap bit is operational |
| * - use it to map writeable memory at 0x00000000, in place of flash |
| * - before remap: flash/rom 0x00000000, sdram: 0x10000000-0x4fffffff |
| * - after remap: flash/rom 0x80000000, sdram: 0x00000000 |
| */ |
| led 0x2c |
| setbf15 AHBC_CR_A, FTAHBC020S_CR_REMAP ! 0x1 |
| |
| #endif /* #ifdef CONFIG_MEM_REMAP */ |
| move $lp, $r11 |
| 2: |
| ret |
| |
| /* |
| * enable_fpu: |
| * Some of Andes CPU version support FPU coprocessor, if so, |
| * and toolchain support FPU instruction set, we should enable it. |
| */ |
| #if (defined(NDS32_EXT_FPU_DP) || defined(NDS32_EXT_FPU_SP)) |
| enable_fpu: |
| mfsr $r0, $CPU_VER /* enable FPU if it exists */ |
| srli $r0, $r0, 3 |
| andi $r0, $r0, 1 |
| beqz $r0, 1f /* skip if no COP */ |
| mfsr $r0, $FUCOP_EXIST |
| srli $r0, $r0, 31 |
| beqz $r0, 1f /* skip if no FPU */ |
| mfsr $r0, $FUCOP_CTL |
| ori $r0, $r0, 1 |
| mtsr $r0, $FUCOP_CTL |
| 1: |
| ret |
| #endif |
| |
| .globl show_led |
| show_led: |
| li $r8, (CONFIG_DEBUG_LED) |
| swi $r7, [$r8] |
| ret |
| #endif /* #ifndef CONFIG_SKIP_LOWLEVEL_INIT */ |
