]>
Commit | Line | Data |
---|---|---|
74f4304e WD |
1 | /* |
2 | * (C) Copyright 2002 | |
3 | * Sysgo Real-Time Solutions, GmbH <www.elinos.com> | |
4 | * Marius Groeger <mgroeger@sysgo.de> | |
5 | * | |
6 | * (C) Copyright 2002 | |
792a09eb | 7 | * Gary Jennejohn, DENX Software Engineering, <garyj@denx.de> |
74f4304e WD |
8 | * |
9 | * See file CREDITS for list of people who contributed to this | |
10 | * project. | |
11 | * | |
12 | * This program is free software; you can redistribute it and/or | |
13 | * modify it under the terms of the GNU General Public License as | |
14 | * published by the Free Software Foundation; either version 2 of | |
15 | * the License, or (at your option) any later version. | |
16 | * | |
17 | * This program is distributed in the hope that it will be useful, | |
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
fe7eb5d8 | 19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
74f4304e WD |
20 | * GNU General Public License for more details. |
21 | * | |
22 | * You should have received a copy of the GNU General Public License | |
23 | * along with this program; if not, write to the Free Software | |
24 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
25 | * MA 02111-1307 USA | |
26 | */ | |
27 | ||
28 | /* | |
29 | * CPU specific code | |
30 | */ | |
31 | ||
32 | #include <common.h> | |
33 | #include <command.h> | |
34 | #include <arm946es.h> | |
677e62f4 | 35 | #include <asm/system.h> |
74f4304e | 36 | |
d87080b7 WD |
37 | #ifdef CONFIG_USE_IRQ |
38 | DECLARE_GLOBAL_DATA_PTR; | |
39 | #endif | |
40 | ||
b3acb6cd | 41 | static void cache_flush(void); |
74f4304e | 42 | |
74f4304e WD |
43 | int cpu_init (void) |
44 | { | |
45 | /* | |
46 | * setup up stacks if necessary | |
47 | */ | |
48 | #ifdef CONFIG_USE_IRQ | |
6d0f6bcf | 49 | IRQ_STACK_START = _armboot_start - CONFIG_SYS_MALLOC_LEN - CONFIG_SYS_GBL_DATA_SIZE - 4; |
74f4304e WD |
50 | FIQ_STACK_START = IRQ_STACK_START - CONFIG_STACKSIZE_IRQ; |
51 | #endif | |
52 | return 0; | |
53 | } | |
54 | ||
55 | int cleanup_before_linux (void) | |
56 | { | |
57 | /* | |
58 | * this function is called just before we call linux | |
59 | * it prepares the processor for linux | |
60 | * | |
61 | * we turn off caches etc ... | |
62 | */ | |
63 | ||
74f4304e WD |
64 | disable_interrupts (); |
65 | ||
fe7eb5d8 WD |
66 | /* ARM926E-S needs the protection unit enabled for the icache to have |
67 | * been enabled - left for possible later use | |
74f4304e | 68 | * should turn off the protection unit as well.... |
fe7eb5d8 | 69 | */ |
74f4304e | 70 | /* turn off I/D-cache */ |
b3acb6cd JCPV |
71 | icache_disable(); |
72 | dcache_disable(); | |
74f4304e | 73 | /* flush I/D-cache */ |
b3acb6cd JCPV |
74 | cache_flush(); |
75 | ||
76 | return 0; | |
74f4304e WD |
77 | } |
78 | ||
b3acb6cd JCPV |
79 | /* flush I/D-cache */ |
80 | static void cache_flush (void) | |
74f4304e | 81 | { |
b3acb6cd | 82 | unsigned long i = 0; |
74f4304e | 83 | |
b3acb6cd JCPV |
84 | asm ("mcr p15, 0, %0, c7, c5, 0": :"r" (i)); |
85 | asm ("mcr p15, 0, %0, c7, c6, 0": :"r" (i)); | |
74f4304e | 86 | } |