board/renesas/ecovec/lowlevel_init.S

   1 /*
   2  * Copyright (C) 2011 Renesas Solutions Corp.
   3  * Copyright (C) 2011 Nobuhiro Iwamatsu <nobuhiro.Iwamatsu.yj@renesas.com>
   4  *
   5  * board/renesas/ecovec/lowlevel_init.S
   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/processor.h>
  26 #include <asm/macro.h>
  27 #include <configs/ecovec.h>
  28
  29         .global lowlevel_init
  30
  31         .text
  32         .align  2
  33
  34 lowlevel_init:
  35
  36         /* jump to 0xA0020000 if bit 1 of PVDR_A */
  37         mov.l   PVDR_A, r1
  38         mov.l   PVDR_D, r2
  39         mov.b   @r1, r0
  40         tst     r0, r2
  41         bt      1f
  42         mov.l   JUMP_A, r1
  43         jmp     @r1
  44         nop
  45
  46 1:
  47         /* Disable watchdog */
  48         write16 RWTCSR_A, RWTCSR_D
  49
  50         /* MMU Disable */
  51         write32 MMUCR_A, MMUCR_D
  52
  53         /* Setup clocks */
  54         write32 PLLCR_A, PLLCR_D
  55         write32 FRQCRA_A, FRQCRA_D
  56         write32 FRQCRB_A, FRQCRB_D
  57
  58         wait_timer TIMER_D
  59
  60         write32 MMSELR_A, MMSELR_D
  61
  62         /* Srtup BSC */
  63         write32 CMNCR_A, CMNCR_D
  64         write32 CS0BCR_A, CS0BCR_D
  65         write32 CS0WCR_A, CS0WCR_D
  66
  67         wait_timer TIMER_D
  68
  69         /* Setup SDRAM */
  70         write32 DBPDCNT0_A,     DBPDCNT0_D0
  71         write32 DBCONF_A,       DBCONF_D
  72         write32 DBTR0_A,        DBTR0_D
  73         write32 DBTR1_A,        DBTR1_D
  74         write32 DBTR2_A,        DBTR2_D
  75         write32 DBTR3_A,        DBTR3_D
  76         write32 DBKIND_A,       DBKIND_D
  77         write32 DBCKECNT_A,     DBCKECNT_D
  78
  79         wait_timer TIMER_D
  80
  81         write32 DBCMDCNT_A,     DBCMDCNT_D0
  82         write32 DBMRCNT_A, DBMRCNT_D0
  83         write32 DBMRCNT_A, DBMRCNT_D1
  84         write32 DBMRCNT_A, DBMRCNT_D2
  85         write32 DBMRCNT_A, DBMRCNT_D3
  86         write32 DBCMDCNT_A, DBCMDCNT_D0
  87         write32 DBCMDCNT_A, DBCMDCNT_D1
  88         write32 DBCMDCNT_A, DBCMDCNT_D1
  89         write32 DBMRCNT_A, DBMRCNT_D4
  90         write32 DBMRCNT_A, DBMRCNT_D5
  91         write32 DBMRCNT_A, DBMRCNT_D6
  92
  93         wait_timer TIMER_D
  94
  95         write32 DBEN_A, DBEN_D
  96         write32 DBRFPDN1_A, DBRFPDN1_D
  97         write32 DBRFPDN2_A, DBRFPDN2_D
  98         write32 DBCMDCNT_A, DBCMDCNT_D0
  99
 100
 101         /* Dummy read */
 102         mov.l DUMMY_A ,r1
 103         synco
 104         mov.l @r1, r0
 105         synco
 106
 107         mov.l SDRAM_A ,r1
 108         synco
 109         mov.l @r1, r0
 110         synco
 111         wait_timer TIMER_D
 112
 113         add #4, r1
 114         synco
 115         mov.l @r1, r0
 116         synco
 117         wait_timer TIMER_D
 118
 119         add #4, r1
 120         synco
 121         mov.l @r1, r0
 122         synco
 123         wait_timer TIMER_D
 124
 125         add #4, r1
 126         synco
 127         mov.l @r1, r0
 128         synco
 129         wait_timer TIMER_D
 130
 131         write32 DBCMDCNT_A, DBCMDCNT_D0
 132         write32 DBCMDCNT_A, DBCMDCNT_D1
 133         write32 DBPDCNT0_A, DBPDCNT0_D1
 134         write32 DBRFPDN0_A, DBRFPDN0_D
 135
 136         wait_timer TIMER_D
 137
 138         write32 CCR_A, CCR_D
 139
 140         stc     sr, r0
 141         mov.l   SR_MASK_D, r1
 142         and     r1, r0
 143         ldc     r0, sr
 144
 145         rts
 146
 147         .align  2
 148
 149 PVDR_A:         .long   PVDR
 150 PVDR_D:         .long   0x00000001
 151 JUMP_A:         .long   CONFIG_ECOVEC_ROMIMAGE_ADDR
 152 TIMER_D:        .long   64
 153 RWTCSR_A:       .long   RWTCSR
 154 RWTCSR_D:       .long   0x0000A507
 155 MMUCR_A:        .long   MMUCR
 156 MMUCR_D:        .long   0x00000004
 157 PLLCR_A:        .long   PLLCR
 158 PLLCR_D:        .long   0x00004000
 159 FRQCRA_A:       .long   FRQCRA
 160 FRQCRA_D:       .long   0x8E003508
 161 FRQCRB_A:       .long   FRQCRB
 162 FRQCRB_D:       .long   0x0
 163 MMSELR_A:       .long   MMSELR
 164 MMSELR_D:       .long   0xA5A50000
 165 CMNCR_A:        .long   CMNCR
 166 CMNCR_D:        .long   0x00000013
 167 CS0BCR_A:       .long   CS0BCR
 168 CS0BCR_D:       .long   0x11110400
 169 CS0WCR_A:       .long   CS0WCR
 170 CS0WCR_D:       .long   0x00000440
 171 DBPDCNT0_A:     .long   DBPDCNT0
 172 DBPDCNT0_D0: .long      0x00000181
 173 DBPDCNT0_D1: .long      0x00000080
 174 DBCONF_A:       .long   DBCONF
 175 DBCONF_D:       .long   0x015B0002
 176 DBTR0_A:        .long   DBTR0
 177 DBTR0_D:        .long   0x03061502
 178 DBTR1_A:        .long   DBTR1
 179 DBTR1_D:        .long   0x02020102
 180 DBTR2_A:        .long   DBTR2
 181 DBTR2_D:        .long   0x01090305
 182 DBTR3_A:        .long   DBTR3
 183 DBTR3_D:        .long   0x00000002
 184 DBKIND_A:       .long   DBKIND
 185 DBKIND_D:       .long   0x00000005
 186 DBCKECNT_A:     .long   DBCKECNT
 187 DBCKECNT_D:     .long   0x00000001
 188 DBCMDCNT_A:     .long   DBCMDCNT
 189 DBCMDCNT_D0:.long       0x2
 190 DBCMDCNT_D1:.long       0x4
 191 DBMRCNT_A:      .long   DBMRCNT
 192 DBMRCNT_D0:     .long   0x00020000
 193 DBMRCNT_D1:     .long   0x00030000
 194 DBMRCNT_D2:     .long   0x00010040
 195 DBMRCNT_D3:     .long   0x00000532
 196 DBMRCNT_D4:     .long   0x00000432
 197 DBMRCNT_D5:     .long   0x000103C0
 198 DBMRCNT_D6:     .long   0x00010040
 199 DBEN_A:         .long   DBEN
 200 DBEN_D:         .long   0x01
 201 DBRFPDN0_A:     .long   DBRFPDN0
 202 DBRFPDN1_A:     .long   DBRFPDN1
 203 DBRFPDN2_A:     .long   DBRFPDN2
 204 DBRFPDN0_D:     .long   0x00010000
 205 DBRFPDN1_D:     .long   0x00000613
 206 DBRFPDN2_D:     .long   0x238C003A
 207 SDRAM_A:        .long   0xa8000000
 208 DUMMY_A:        .long   0x0c400000
 209 CCR_A:          .long   CCR
 210 CCR_D:          .long   0x0000090B
 211 SR_MASK_D:      .long   0xEFFFFF0F