2 * File: arch/blackfin/mach-bf561/head.S
3 * Based on: arch/blackfin/mach-bf533/head.S
7 * Description: BF561 startup file
10 * Copyright 2004-2006 Analog Devices Inc.
12 * Bugs: Enter bugs at http://blackfin.uclinux.org/
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License as published by
16 * the Free Software Foundation; either version 2 of the License, or
17 * (at your option) any later version.
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
24 * You should have received a copy of the GNU General Public License
25 * along with this program; if not, see the file COPYING, or write
26 * to the Free Software Foundation, Inc.,
27 * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
30 #include <linux/linkage.h>
31 #include <linux/init.h>
32 #include <asm/blackfin.h>
33 #include <asm/trace.h>
35 #if CONFIG_BFIN_KERNEL_CLOCK
36 #include <asm/mach-common/clocks.h>
37 #include <asm/mach/mem_init.h>
42 .extern _bf53x_relocate_l1_mem
44 #define INITIAL_STACK 0xFFB01000
49 /* R0: argument of command line string, passed from uboot, save it */
51 /* Enable Cycle Counter and Nesting Of Interrupts */
52 #ifdef CONFIG_BFIN_SCRATCH_REG_CYCLES
55 R0 = SYSCFG_SNEN | SYSCFG_CCEN;
60 /* Clear Out All the data and pointer Registers */
82 /* Clear Out All the DAG Registers */
98 trace_buffer_init(p0,r0);
102 /* Turn off the icache */
103 p0.l = LO(IMEM_CONTROL);
104 p0.h = HI(IMEM_CONTROL);
111 /* Turn off the dcache */
112 p0.l = LO(DMEM_CONTROL);
113 p0.h = HI(DMEM_CONTROL);
120 /* Initialise UART - when booting from u-boot, the UART is not disabled
121 * so if we dont initalize here, our serial console gets hosed */
122 p0.h = hi(BFIN_UART_LCR);
123 p0.l = lo(BFIN_UART_LCR);
125 w[p0] = r0.L; /* To enable DLL writes */
128 p0.h = hi(BFIN_UART_DLL);
129 p0.l = lo(BFIN_UART_DLL);
134 p0.h = hi(BFIN_UART_DLH);
135 p0.l = lo(BFIN_UART_DLH);
140 p0.h = hi(BFIN_UART_GCTL);
141 p0.l = lo(BFIN_UART_GCTL);
143 w[p0] = r0.L; /* To enable UART clock */
146 /* Initialize stack pointer */
147 sp.l = lo(INITIAL_STACK);
148 sp.h = hi(INITIAL_STACK);
152 #ifdef CONFIG_EARLY_PRINTK
154 call _init_early_exception_vectors;
158 /* Put The Code for PLL Programming and SDRAM Programming in L1 ISRAM */
159 call _bf53x_relocate_l1_mem;
160 #if CONFIG_BFIN_KERNEL_CLOCK
161 call _start_dma_code;
164 /* Code for initializing Async memory banks */
166 p2.h = hi(EBIU_AMBCTL1);
167 p2.l = lo(EBIU_AMBCTL1);
168 r0.h = hi(AMBCTL1VAL);
169 r0.l = lo(AMBCTL1VAL);
173 p2.h = hi(EBIU_AMBCTL0);
174 p2.l = lo(EBIU_AMBCTL0);
175 r0.h = hi(AMBCTL0VAL);
176 r0.l = lo(AMBCTL0VAL);
180 p2.h = hi(EBIU_AMGCTL);
181 p2.l = lo(EBIU_AMGCTL);
186 /* This section keeps the processor in supervisor mode
187 * during kernel boot. Switches to user mode at end of boot.
188 * See page 3-9 of Hardware Reference manual for documentation.
191 /* EVT15 = _real_start */
223 #if CONFIG_BFIN_KERNEL_CLOCK
224 ENTRY(_start_dma_code)
225 p0.h = hi(SICA_IWR0);
226 p0.l = lo(SICA_IWR0);
233 * - [14:09] = MSEL[5:0] : CLKIN / VCO multiplication factors
234 * - [8] = BYPASS : BYPASS the PLL, run CLKIN into CCLK/SCLK
235 * - [7] = output delay (add 200ps of delay to mem signals)
236 * - [6] = input delay (add 200ps of input delay to mem signals)
237 * - [5] = PDWN : 1=All Clocks off
238 * - [3] = STOPCK : 1=Core Clock off
239 * - [1] = PLL_OFF : 1=Disable Power to PLL
240 * - [0] = DF : 1=Pass CLKIN/2 to PLL / 0=Pass CLKIN to PLL
241 * all other bits set to zero
244 p0.h = hi(PLL_LOCKCNT);
245 p0.l = lo(PLL_LOCKCNT);
250 P2.H = hi(EBIU_SDGCTL);
251 P2.L = lo(EBIU_SDGCTL);
257 r0 = CONFIG_VCO_MULT & 63; /* Load the VCO multiplier */
258 r0 = r0 << 9; /* Shift it over, */
259 r1 = CLKIN_HALF; /* Do we need to divide CLKIN by 2?*/
261 r1 = PLL_BYPASS; /* Bypass the PLL? */
262 r1 = r1 << 8; /* Shift it over */
263 r0 = r1 | r0; /* add them all together */
266 p0.l = lo(PLL_CTL); /* Load the address */
267 cli r2; /* Disable interrupts */
269 w[p0] = r0.l; /* Set the value */
270 idle; /* Wait for the PLL to stablize */
271 sti r2; /* Enable interrupts */
278 if ! CC jump .Lcheck_again;
280 /* Configure SCLK & CCLK Dividers */
281 r0 = (CONFIG_CCLK_ACT_DIV | CONFIG_SCLK_DIV);
287 p0.l = lo(EBIU_SDRRC);
288 p0.h = hi(EBIU_SDRRC);
293 P2.H = hi(EBIU_SDGCTL);
294 P2.L = lo(EBIU_SDGCTL);
297 p0.h = hi(EBIU_SDSTAT);
298 p0.l = lo(EBIU_SDSTAT);
308 R0.L = lo(mem_SDGCTL);
309 R0.H = hi(mem_SDGCTL);
316 ENDPROC(_start_dma_code)
317 #endif /* CONFIG_BFIN_KERNEL_CLOCK */