Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (C) 2007, Guennadi Liakhovetski <lg@denx.de> |
| 3 | * |
| 4 | * (C) Copyright 2008-2010 Freescale Semiconductor, Inc. |
| 5 | * |
Wolfgang Denk | 1a45966 | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 6 | * SPDX-License-Identifier: GPL-2.0+ |
Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 7 | */ |
| 8 | |
| 9 | #include <config.h> |
| 10 | #include <asm/arch/imx-regs.h> |
Stefano Babic | a4814a6 | 2011-09-05 04:32:28 +0000 | [diff] [blame] | 11 | #include <generated/asm-offsets.h> |
Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 12 | #include "mx35pdk.h" |
Benoît Thébaudeau | 151d63c | 2012-08-20 09:54:53 +0000 | [diff] [blame] | 13 | #include <asm/arch/lowlevel_macro.S> |
Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 14 | |
| 15 | /* |
| 16 | * return soc version |
| 17 | * 0x10: TO1 |
| 18 | * 0x20: TO2 |
| 19 | * 0x30: TO3 |
| 20 | */ |
| 21 | .macro check_soc_version ret, tmp |
| 22 | ldr \tmp, =IIM_BASE_ADDR |
| 23 | ldr \ret, [\tmp, #IIM_SREV] |
| 24 | cmp \ret, #0x00 |
| 25 | moveq \tmp, #ROMPATCH_REV |
| 26 | ldreq \ret, [\tmp] |
| 27 | moveq \ret, \ret, lsl #4 |
| 28 | addne \ret, \ret, #0x10 |
| 29 | .endm |
| 30 | |
Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 31 | /* CPLD on CS5 setup */ |
| 32 | .macro init_debug_board |
| 33 | ldr r0, =DBG_BASE_ADDR |
| 34 | ldr r1, =DBG_CSCR_U_CONFIG |
| 35 | str r1, [r0, #0x00] |
| 36 | ldr r1, =DBG_CSCR_L_CONFIG |
| 37 | str r1, [r0, #0x04] |
| 38 | ldr r1, =DBG_CSCR_A_CONFIG |
| 39 | str r1, [r0, #0x08] |
| 40 | .endm |
| 41 | |
| 42 | /* clock setup */ |
| 43 | .macro init_clock |
| 44 | ldr r0, =CCM_BASE_ADDR |
| 45 | |
| 46 | /* default CLKO to 1/32 of the ARM core*/ |
| 47 | ldr r1, [r0, #CLKCTL_COSR] |
| 48 | bic r1, r1, #0x00000FF00 |
| 49 | bic r1, r1, #0x0000000FF |
| 50 | mov r2, #0x00006C00 |
| 51 | add r2, r2, #0x67 |
| 52 | orr r1, r1, r2 |
| 53 | str r1, [r0, #CLKCTL_COSR] |
| 54 | |
| 55 | ldr r2, =CCM_CCMR_CONFIG |
| 56 | str r2, [r0, #CLKCTL_CCMR] |
| 57 | |
| 58 | check_soc_version r1, r2 |
| 59 | cmp r1, #CHIP_REV_2_0 |
| 60 | ldrhs r3, =CCM_MPLL_532_HZ |
| 61 | bhs 1f |
| 62 | ldr r2, [r0, #CLKCTL_PDR0] |
| 63 | tst r2, #CLKMODE_CONSUMER |
| 64 | ldrne r3, =CCM_MPLL_532_HZ /* consumer path*/ |
| 65 | ldreq r3, =CCM_MPLL_399_HZ /* auto path*/ |
| 66 | 1: |
| 67 | str r3, [r0, #CLKCTL_MPCTL] |
| 68 | |
| 69 | ldr r1, =CCM_PPLL_300_HZ |
| 70 | str r1, [r0, #CLKCTL_PPCTL] |
| 71 | |
| 72 | ldr r1, =CCM_PDR0_CONFIG |
| 73 | bic r1, r1, #0x800000 |
| 74 | str r1, [r0, #CLKCTL_PDR0] |
| 75 | |
| 76 | ldr r1, [r0, #CLKCTL_CGR0] |
| 77 | orr r1, r1, #0x0C300000 |
| 78 | str r1, [r0, #CLKCTL_CGR0] |
| 79 | |
| 80 | ldr r1, [r0, #CLKCTL_CGR1] |
| 81 | orr r1, r1, #0x00000C00 |
| 82 | orr r1, r1, #0x00000003 |
| 83 | str r1, [r0, #CLKCTL_CGR1] |
Benoît Thébaudeau | 961a762 | 2012-11-13 09:58:25 +0000 | [diff] [blame] | 84 | |
| 85 | ldr r1, [r0, #CLKCTL_CGR2] |
| 86 | orr r1, r1, #0x00C00000 |
| 87 | str r1, [r0, #CLKCTL_CGR2] |
Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 88 | .endm |
| 89 | |
| 90 | .macro setup_sdram |
| 91 | ldr r0, =ESDCTL_BASE_ADDR |
| 92 | mov r3, #0x2000 |
| 93 | str r3, [r0, #0x0] |
| 94 | str r3, [r0, #0x8] |
| 95 | |
| 96 | /*ip(r12) has used to save lr register in upper calling*/ |
| 97 | mov fp, lr |
| 98 | |
| 99 | mov r5, #0x00 |
| 100 | mov r2, #0x00 |
| 101 | mov r1, #CSD0_BASE_ADDR |
| 102 | bl setup_sdram_bank |
Stefano Babic | 6b5acfc | 2011-08-02 14:42:36 +0200 | [diff] [blame] | 103 | |
| 104 | mov r5, #0x00 |
| 105 | mov r2, #0x00 |
| 106 | mov r1, #CSD1_BASE_ADDR |
| 107 | bl setup_sdram_bank |
Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 108 | |
| 109 | mov lr, fp |
| 110 | |
| 111 | 1: |
| 112 | ldr r3, =ESDCTL_DELAY_LINE5 |
| 113 | str r3, [r0, #0x30] |
| 114 | .endm |
| 115 | |
| 116 | .globl lowlevel_init |
| 117 | lowlevel_init: |
| 118 | mov r10, lr |
| 119 | |
Benoît Thébaudeau | 151d63c | 2012-08-20 09:54:53 +0000 | [diff] [blame] | 120 | core_init |
Stefano Babic | eae4988 | 2011-01-20 08:05:15 +0000 | [diff] [blame] | 121 | |
| 122 | init_aips |
| 123 | |
| 124 | init_max |
| 125 | |
| 126 | init_m3if |
| 127 | |
| 128 | init_clock |
| 129 | init_debug_board |
| 130 | |
| 131 | cmp pc, #PHYS_SDRAM_1 |
| 132 | blo init_sdram_start |
| 133 | cmp pc, #(PHYS_SDRAM_1 + PHYS_SDRAM_1_SIZE) |
| 134 | blo skip_sdram_setup |
| 135 | |
| 136 | init_sdram_start: |
| 137 | /*init_sdram*/ |
| 138 | setup_sdram |
| 139 | |
| 140 | skip_sdram_setup: |
| 141 | mov lr, r10 |
| 142 | mov pc, lr |
| 143 | |
| 144 | |
| 145 | /* |
| 146 | * r0: ESDCTL control base, r1: sdram slot base |
| 147 | * r2: DDR type(0:DDR2, 1:MDDR) r3, r4:working base |
| 148 | */ |
| 149 | setup_sdram_bank: |
| 150 | mov r3, #0xE |
| 151 | tst r2, #0x1 |
| 152 | orreq r3, r3, #0x300 /*DDR2*/ |
| 153 | str r3, [r0, #0x10] |
| 154 | bic r3, r3, #0x00A |
| 155 | str r3, [r0, #0x10] |
| 156 | beq 2f |
| 157 | |
| 158 | mov r3, #0x20000 |
| 159 | 1: subs r3, r3, #1 |
| 160 | bne 1b |
| 161 | |
| 162 | 2: tst r2, #0x1 |
| 163 | ldreq r3, =ESDCTL_DDR2_CONFIG |
| 164 | ldrne r3, =ESDCTL_MDDR_CONFIG |
| 165 | cmp r1, #CSD1_BASE_ADDR |
| 166 | strlo r3, [r0, #0x4] |
| 167 | strhs r3, [r0, #0xC] |
| 168 | |
| 169 | ldr r3, =ESDCTL_0x92220000 |
| 170 | strlo r3, [r0, #0x0] |
| 171 | strhs r3, [r0, #0x8] |
| 172 | mov r3, #0xDA |
| 173 | ldr r4, =ESDCTL_PRECHARGE |
| 174 | strb r3, [r1, r4] |
| 175 | |
| 176 | tst r2, #0x1 |
| 177 | bne skip_set_mode |
| 178 | |
| 179 | cmp r1, #CSD1_BASE_ADDR |
| 180 | ldr r3, =ESDCTL_0xB2220000 |
| 181 | strlo r3, [r0, #0x0] |
| 182 | strhs r3, [r0, #0x8] |
| 183 | mov r3, #0xDA |
| 184 | ldr r4, =ESDCTL_DDR2_EMR2 |
| 185 | strb r3, [r1, r4] |
| 186 | ldr r4, =ESDCTL_DDR2_EMR3 |
| 187 | strb r3, [r1, r4] |
| 188 | ldr r4, =ESDCTL_DDR2_EN_DLL |
| 189 | strb r3, [r1, r4] |
| 190 | ldr r4, =ESDCTL_DDR2_RESET_DLL |
| 191 | strb r3, [r1, r4] |
| 192 | |
| 193 | ldr r3, =ESDCTL_0x92220000 |
| 194 | strlo r3, [r0, #0x0] |
| 195 | strhs r3, [r0, #0x8] |
| 196 | mov r3, #0xDA |
| 197 | ldr r4, =ESDCTL_PRECHARGE |
| 198 | strb r3, [r1, r4] |
| 199 | |
| 200 | skip_set_mode: |
| 201 | cmp r1, #CSD1_BASE_ADDR |
| 202 | ldr r3, =ESDCTL_0xA2220000 |
| 203 | strlo r3, [r0, #0x0] |
| 204 | strhs r3, [r0, #0x8] |
| 205 | mov r3, #0xDA |
| 206 | strb r3, [r1] |
| 207 | strb r3, [r1] |
| 208 | |
| 209 | ldr r3, =ESDCTL_0xB2220000 |
| 210 | strlo r3, [r0, #0x0] |
| 211 | strhs r3, [r0, #0x8] |
| 212 | tst r2, #0x1 |
| 213 | ldreq r4, =ESDCTL_DDR2_MR |
| 214 | ldrne r4, =ESDCTL_MDDR_MR |
| 215 | mov r3, #0xDA |
| 216 | strb r3, [r1, r4] |
| 217 | ldreq r4, =ESDCTL_DDR2_OCD_DEFAULT |
| 218 | streqb r3, [r1, r4] |
| 219 | ldreq r4, =ESDCTL_DDR2_EN_DLL |
| 220 | ldrne r4, =ESDCTL_MDDR_EMR |
| 221 | strb r3, [r1, r4] |
| 222 | |
| 223 | cmp r1, #CSD1_BASE_ADDR |
| 224 | ldr r3, =ESDCTL_0x82228080 |
| 225 | strlo r3, [r0, #0x0] |
| 226 | strhs r3, [r0, #0x8] |
| 227 | |
| 228 | tst r2, #0x1 |
| 229 | moveq r4, #0x20000 |
| 230 | movne r4, #0x200 |
| 231 | 1: subs r4, r4, #1 |
| 232 | bne 1b |
| 233 | |
| 234 | str r3, [r1, #0x100] |
| 235 | ldr r4, [r1, #0x100] |
| 236 | cmp r3, r4 |
| 237 | movne r3, #1 |
| 238 | moveq r3, #0 |
| 239 | |
| 240 | mov pc, lr |