board/cradle/lowlevel_init.S

   1 /*
   2  * Most of this taken from Redboot hal_platform_setup.h with cleanup
   3  *
   4  * See file CREDITS for list of people who contributed to this
   5  * project.
   6  *
   7  * This program is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU General Public License as
   9  * published by the Free Software Foundation; either version 2 of
  10  * the License, or (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  20  * MA 02111-1307 USA
  21  */
  22
  23 #include <config.h>
  24 #include <version.h>
  25 #include <asm/arch/pxa-regs.h>
  26
  27 DRAM_SIZE:  .long   CFG_DRAM_SIZE
  28
  29 /* wait for coprocessor write complete */
  30    .macro CPWAIT reg
  31    mrc  p15,0,\reg,c2,c0,0
  32    mov  \reg,\reg
  33    sub  pc,pc,#4
  34    .endm
  35
  36    .macro SET_LED val
  37    ldr   r6, =CRADLE_LED_CLR_REG
  38    ldr   r7, =0
  39    str   r7, [r6]
  40    ldr   r6, =CRADLE_LED_SET_REG
  41    ldr   r7, =\val
  42    str   r7, [r6]
  43    .endm
  44
  45
  46 .globl lowlevel_init
  47 lowlevel_init:
  48
  49     mov      r10, lr
  50
  51     /* Set up GPIO pins first */
  52
  53    ldr      r0,   =GPSR0
  54    ldr      r1,   =CFG_GPSR0_VAL
  55    str      r1,   [r0]
  56
  57    ldr      r0,   =GPSR1
  58    ldr      r1,   =CFG_GPSR1_VAL
  59    str      r1,   [r0]
  60
  61    ldr      r0,   =GPSR2
  62    ldr      r1,   =CFG_GPSR2_VAL
  63    str      r1,   [r0]
  64
  65    ldr      r0,   =GPCR0
  66    ldr      r1,   =CFG_GPCR0_VAL
  67    str      r1,   [r0]
  68
  69    ldr      r0,   =GPCR1
  70    ldr      r1,   =CFG_GPCR1_VAL
  71    str      r1,   [r0]
  72
  73    ldr      r0,   =GPCR2
  74    ldr      r1,   =CFG_GPCR2_VAL
  75    str      r1,   [r0]
  76
  77    ldr      r0,   =GRER0
  78    ldr      r1,   =CFG_GRER0_VAL
  79    str      r1,   [r0]
  80
  81    ldr      r0,   =GRER1
  82    ldr      r1,   =CFG_GRER1_VAL
  83    str      r1,   [r0]
  84
  85    ldr      r0,   =GRER2
  86    ldr      r1,   =CFG_GRER2_VAL
  87    str      r1,   [r0]
  88
  89    ldr      r0,   =GFER0
  90    ldr      r1,   =CFG_GFER0_VAL
  91    str      r1,   [r0]
  92
  93    ldr      r0,   =GFER1
  94    ldr      r1,   =CFG_GFER1_VAL
  95    str      r1,   [r0]
  96
  97    ldr      r0,   =GFER2
  98    ldr      r1,   =CFG_GFER2_VAL
  99    str      r1,   [r0]
 100
 101    ldr      r0,   =GPDR0
 102    ldr      r1,   =CFG_GPDR0_VAL
 103    str      r1,   [r0]
 104
 105    ldr      r0,   =GPDR1
 106    ldr      r1,   =CFG_GPDR1_VAL
 107    str      r1,   [r0]
 108
 109    ldr      r0,   =GPDR2
 110    ldr      r1,   =CFG_GPDR2_VAL
 111    str      r1,   [r0]
 112
 113    ldr      r0,   =GAFR0_L
 114    ldr      r1,   =CFG_GAFR0_L_VAL
 115    str      r1,   [r0]
 116
 117    ldr      r0,   =GAFR0_U
 118    ldr      r1,   =CFG_GAFR0_U_VAL
 119    str      r1,   [r0]
 120
 121    ldr      r0,   =GAFR1_L
 122    ldr      r1,   =CFG_GAFR1_L_VAL
 123    str      r1,   [r0]
 124
 125    ldr      r0,   =GAFR1_U
 126    ldr      r1,   =CFG_GAFR1_U_VAL
 127    str      r1,   [r0]
 128
 129    ldr      r0,   =GAFR2_L
 130    ldr      r1,   =CFG_GAFR2_L_VAL
 131    str      r1,   [r0]
 132
 133    ldr      r0,   =GAFR2_U
 134    ldr      r1,   =CFG_GAFR2_U_VAL
 135    str      r1,   [r0]
 136
 137    /* enable GPIO pins */
 138    ldr      r0,   =PSSR
 139    ldr      r1,   =CFG_PSSR_VAL
 140    str      r1,   [r0]
 141
 142    SET_LED 1
 143
 144    ldr    r3, =MSC1             /* low - bank 2 Lubbock Registers / SRAM */
 145    ldr    r2, =CFG_MSC1_VAL     /* high - bank 3 Ethernet Controller */
 146    str    r2, [r3]              /* need to set MSC1 before trying to write to the HEX LEDs */
 147    ldr    r2, [r3]              /* need to read it back to make sure the value latches (see MSC section of manual) */
 148
 149
 150 /*********************************************************************
 151     Initlialize Memory Controller
 152
 153     See PXA250 Operating System Developer's Guide
 154
 155     pause for 200 uSecs- allow internal clocks to settle
 156     *Note: only need this if hard reset... doing it anyway for now
 157 */
 158
 159     @ Step 1
 160    @ ---- Wait 200 usec
 161    ldr r3, =OSCR       @ reset the OS Timer Count to zero
 162    mov r2, #0
 163    str r2, [r3]
 164    ldr r4, =0x300         @ really 0x2E1 is about 200usec, so 0x300 should be plenty
 165 1:
 166    ldr r2, [r3]
 167    cmp r4, r2
 168    bgt 1b
 169
 170    SET_LED 2
 171
 172 mem_init:
 173         @ get memory controller base address
 174         ldr     r1,  =MEMC_BASE
 175
 176
 177 @****************************************************************************
 178 @  Step 2
 179 @
 180
 181    @ Step 2a
 182    @ write msc0, read back to ensure data latches
 183    @
 184    ldr     r2,   =CFG_MSC0_VAL
 185    str     r2,   [r1, #MSC0_OFFSET]
 186    ldr     r2,   [r1, #MSC0_OFFSET]
 187
 188    @ write msc1
 189    ldr     r2,  =CFG_MSC1_VAL
 190    str     r2,  [r1, #MSC1_OFFSET]
 191    ldr     r2,  [r1, #MSC1_OFFSET]
 192
 193    @ write msc2
 194    ldr     r2,  =CFG_MSC2_VAL
 195    str     r2,  [r1, #MSC2_OFFSET]
 196    ldr     r2,  [r1, #MSC2_OFFSET]
 197
 198    @ Step 2b
 199    @ write mecr
 200    ldr     r2,  =CFG_MECR_VAL
 201    str     r2,  [r1, #MECR_OFFSET]
 202
 203    @ write mcmem0
 204    ldr     r2,  =CFG_MCMEM0_VAL
 205    str     r2,  [r1, #MCMEM0_OFFSET]
 206
 207    @ write mcmem1
 208    ldr     r2,  =CFG_MCMEM1_VAL
 209    str     r2,  [r1, #MCMEM1_OFFSET]
 210
 211    @ write mcatt0
 212    ldr     r2,  =CFG_MCATT0_VAL
 213    str     r2,  [r1, #MCATT0_OFFSET]
 214
 215    @ write mcatt1
 216    ldr     r2,  =CFG_MCATT1_VAL
 217    str     r2,  [r1, #MCATT1_OFFSET]
 218
 219    @ write mcio0
 220    ldr     r2,  =CFG_MCIO0_VAL
 221    str     r2,  [r1, #MCIO0_OFFSET]
 222
 223    @ write mcio1
 224    ldr     r2,  =CFG_MCIO1_VAL
 225    str     r2,  [r1, #MCIO1_OFFSET]
 226
 227    /*SET_LED 3 */
 228
 229    @ Step 2c
 230    @ fly-by-dma is defeatured on this part
 231    @ write flycnfg
 232    @ldr     r2,  =CFG_FLYCNFG_VAL
 233    @str     r2,  [r1, #FLYCNFG_OFFSET]
 234
 235 /* FIXME Does this sequence really make sense */
 236 #ifdef REDBOOT_WAY
 237    @ Step 2d
 238    @ get the mdrefr settings
 239    ldr     r3,  =CFG_MDREFR_VAL
 240
 241    @ extract DRI field (we need a valid DRI field)
 242    @
 243    ldr     r2,  =0xFFF
 244
 245    @ valid DRI field in r3
 246    @
 247    and     r3,  r3,  r2
 248
 249    @ get the reset state of MDREFR
 250    @
 251    ldr     r4,  [r1, #MDREFR_OFFSET]
 252
 253    @ clear the DRI field
 254    @
 255    bic     r4,  r4,  r2
 256
 257    @ insert the valid DRI field loaded above
 258    @
 259    orr     r4,  r4,  r3
 260
 261    @ write back mdrefr
 262    @
 263    str     r4,  [r1, #MDREFR_OFFSET]
 264
 265    @ *Note: preserve the mdrefr value in r4 *
 266
 267    /*SET_LED 4 */
 268
 269 @****************************************************************************
 270 @  Step 3
 271 @
 272 @ NO SRAM
 273
 274    mov   pc, r10
 275
 276
 277 @****************************************************************************
 278 @  Step 4
 279 @
 280
 281    @ Assumes previous mdrefr value in r4, if not then read current mdrefr
 282
 283    @ clear the free-running clock bits
 284    @ (clear K0Free, K1Free, K2Free
 285    @
 286    bic     r4,  r4,  #(0x00800000 | 0x01000000 | 0x02000000)
 287
 288    @ set K0RUN for CPLD clock
 289    @
 290    orr   r4,  r4,  #0x00002000
 291
 292    @ set K1RUN if bank 0 installed
 293    @
 294    orr   r4,  r4,  #0x00010000
 295
 296    @ write back mdrefr
 297    @
 298    str     r4,  [r1, #MDREFR_OFFSET]
 299    ldr     r4,  [r1, #MDREFR_OFFSET]
 300
 301    @ deassert SLFRSH
 302    @
 303    bic     r4,  r4,  #0x00400000
 304
 305    @ write back mdrefr
 306    @
 307    str     r4,  [r1, #MDREFR_OFFSET]
 308
 309    @ assert E1PIN
 310    @
 311    orr     r4,  r4,  #0x00008000
 312
 313    @ write back mdrefr
 314    @
 315    str     r4,  [r1, #MDREFR_OFFSET]
 316    ldr     r4,  [r1, #MDREFR_OFFSET]
 317    nop
 318    nop
 319 #else
 320    @ Step 2d
 321    @ get the mdrefr settings
 322    ldr     r3,  =CFG_MDREFR_VAL
 323
 324    @ write back mdrefr
 325    @
 326    str     r4,  [r1, #MDREFR_OFFSET]
 327
 328    @  Step 4
 329
 330    @ set K0RUN for CPLD clock
 331    @
 332    orr   r4,  r4,  #0x00002000
 333
 334    @ set K1RUN for bank 0
 335    @
 336    orr   r4,  r4,  #0x00010000
 337
 338    @ write back mdrefr
 339    @
 340    str     r4,  [r1, #MDREFR_OFFSET]
 341    ldr     r4,  [r1, #MDREFR_OFFSET]
 342
 343    @ deassert SLFRSH
 344    @
 345    bic     r4,  r4,  #0x00400000
 346
 347    @ write back mdrefr
 348    @
 349    str     r4,  [r1, #MDREFR_OFFSET]
 350
 351    @ assert E1PIN
 352    @
 353    orr     r4,  r4,  #0x00008000
 354
 355    @ write back mdrefr
 356    @
 357    str     r4,  [r1, #MDREFR_OFFSET]
 358    ldr     r4,  [r1, #MDREFR_OFFSET]
 359    nop
 360    nop
 361 #endif
 362
 363    @ Step 4d
 364    @ fetch platform value of mdcnfg
 365    @
 366    ldr     r2,  =CFG_MDCNFG_VAL
 367
 368    @ disable all sdram banks
 369    @
 370    bic     r2,  r2,  #(MDCNFG_DE0 | MDCNFG_DE1)
 371    bic     r2,  r2,  #(MDCNFG_DE2 | MDCNFG_DE3)
 372
 373    @ program banks 0/1 for bus width
 374    @
 375    bic   r2,  r2,  #MDCNFG_DWID0      @0=32-bit
 376
 377    @ write initial value of mdcnfg, w/o enabling sdram banks
 378    @
 379    str     r2,  [r1, #MDCNFG_OFFSET]
 380
 381    @ Step 4e
 382    @ pause for 200 uSecs
 383    @
 384    ldr r3, =OSCR       @ reset the OS Timer Count to zero
 385    mov r2, #0
 386    str r2, [r3]
 387    ldr r4, =0x300                       @ really 0x2E1 is about 200usec, so 0x300 should be plenty
 388 1:
 389    ldr r2, [r3]
 390    cmp r4, r2
 391    bgt 1b
 392
 393    /*SET_LED 5 */
 394
 395    /* Why is this here??? */
 396    mov    r0, #0x78                @turn everything off
 397    mcr    p15, 0, r0, c1, c0, 0      @(caches off, MMU off, etc.)
 398
 399    @ Step 4f
 400    @ Access memory *not yet enabled* for CBR refresh cycles (8)
 401    @ - CBR is generated for all banks
 402
 403    ldr     r2, =CFG_DRAM_BASE
 404    str     r2, [r2]
 405    str     r2, [r2]
 406    str     r2, [r2]
 407    str     r2, [r2]
 408    str     r2, [r2]
 409    str     r2, [r2]
 410    str     r2, [r2]
 411    str     r2, [r2]
 412
 413    @ Step 4g
 414    @get memory controller base address
 415    @
 416    ldr     r1,  =MEMC_BASE
 417
 418    @fetch current mdcnfg value
 419    @
 420    ldr     r3,  [r1, #MDCNFG_OFFSET]
 421
 422    @enable sdram bank 0 if installed (must do for any populated bank)
 423    @
 424    orr     r3,  r3,  #MDCNFG_DE0
 425
 426    @write back mdcnfg, enabling the sdram bank(s)
 427    @
 428    str     r3,  [r1, #MDCNFG_OFFSET]
 429
 430    @ Step 4h
 431    @ write mdmrs
 432    @
 433    ldr     r2,  =CFG_MDMRS_VAL
 434    str     r2,  [r1, #MDMRS_OFFSET]
 435
 436    @ Done Memory Init
 437
 438    /*SET_LED 6 */
 439
 440    @********************************************************************
 441    @ Disable (mask) all interrupts at the interrupt controller
 442    @
 443
 444    @ clear the interrupt level register (use IRQ, not FIQ)
 445    @
 446    mov     r1, #0
 447    ldr     r2,  =ICLR
 448    str     r1,  [r2]
 449
 450    @ Set interrupt mask register
 451    @
 452    ldr     r1,  =CFG_ICMR_VAL
 453    ldr     r2,  =ICMR
 454    str     r1,  [r2]
 455
 456    @ ********************************************************************
 457    @ Disable the peripheral clocks, and set the core clock
 458    @
 459
 460         @ Turn Off ALL on-chip peripheral clocks for re-configuration
 461         @
 462    ldr     r1,  =CKEN
 463    mov     r2,  #0
 464    str     r2,  [r1]
 465
 466    @ set core clocks
 467    @
 468    ldr     r2,  =CFG_CCCR_VAL
 469    ldr     r1,  =CCCR
 470    str     r2,  [r1]
 471
 472 #ifdef ENABLE32KHZ
 473    @ enable the 32Khz oscillator for RTC and PowerManager
 474    @
 475    ldr     r1,  =OSCC
 476    mov     r2,  #OSCC_OON
 477    str     r2,  [r1]
 478
 479    @ NOTE:  spin here until OSCC.OOK get set,
 480    @        meaning the PLL has settled.
 481    @
 482 60:
 483    ldr     r2, [r1]
 484    ands    r2, r2, #1
 485    beq     60b
 486 #endif
 487
 488         @ Turn on needed clocks
 489         @
 490    ldr     r1,  =CKEN
 491    ldr     r2,  =CFG_CKEN_VAL
 492    str     r2,  [r1]
 493
 494    /*SET_LED 7 */
 495
 496 /* Is this needed???? */
 497 #define NODEBUG
 498 #ifdef NODEBUG
 499    /*Disable software and data breakpoints */
 500    mov   r0,#0
 501    mcr   p15,0,r0,c14,c8,0  /* ibcr0 */
 502    mcr   p15,0,r0,c14,c9,0  /* ibcr1 */
 503    mcr   p15,0,r0,c14,c4,0  /* dbcon */
 504
 505    /*Enable all debug functionality */
 506    mov   r0,#0x80000000
 507    mcr   p14,0,r0,c10,c0,0  /* dcsr */
 508
 509 #endif
 510
 511    /*SET_LED 8 */
 512
 513    mov   pc, r10
 514
 515 @ End lowlevel_init