2 * U-boot - cpu.c CPU specific functions
4 * Copyright (c) 2005-2007 Analog Devices Inc.
6 * (C) Copyright 2000-2004
7 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
9 * See file CREDITS for list of people who contributed to this
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.
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
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., 51 Franklin St, Fifth Floor, Boston,
29 #include <asm/blackfin.h>
31 #include <asm/entry.h>
38 extern unsigned int icplb_table[page_descriptor_table_size][2];
39 extern unsigned int dcplb_table[page_descriptor_table_size][2];
41 int do_reset(cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
43 __asm__ __volatile__("cli r3;" "P0 = %0;" "JUMP (P0);"::"r"(L1_ISRAM)
49 /* These functions are just used to satisfy the linker */
55 int cleanup_before_linux(void)
60 void icache_enable(void)
62 unsigned int *I0, *I1;
65 if ((*pCHIPID >> 28) < 2)
68 /* Before enable icache, disable it first */
70 I0 = (unsigned int *)ICPLB_ADDR0;
71 I1 = (unsigned int *)ICPLB_DATA0;
73 /* make sure the locked ones go in first */
74 for (i = 0; i < page_descriptor_table_size; i++) {
75 if (CPLB_LOCK & icplb_table[i][1]) {
76 debug("adding %02i %02i 0x%08x 0x%08x\n", i, j,
77 icplb_table[i][0], icplb_table[i][1]);
78 *I0++ = icplb_table[i][0];
79 *I1++ = icplb_table[i][1];
84 for (i = 0; i < page_descriptor_table_size; i++) {
85 if (!(CPLB_LOCK & icplb_table[i][1])) {
86 debug("adding %02i %02i 0x%08x 0x%08x\n", i, j,
87 icplb_table[i][0], icplb_table[i][1]);
88 *I0++ = icplb_table[i][0];
89 *I1++ = icplb_table[i][1];
97 /* Fill the rest with invalid entry */
100 debug("filling %i with 0", j);
109 *(unsigned int *)IMEM_CONTROL = IMC | ENICPLB;
114 void icache_disable(void)
116 if ((*pCHIPID >> 28) < 2)
121 *(unsigned int *)IMEM_CONTROL &= ~(IMC | ENICPLB);
126 int icache_status(void)
129 value = *(unsigned int *)IMEM_CONTROL;
131 if (value & (IMC | ENICPLB))
137 void dcache_enable(void)
139 unsigned int *I0, *I1;
143 /* Before enable dcache, disable it first */
145 I0 = (unsigned int *)DCPLB_ADDR0;
146 I1 = (unsigned int *)DCPLB_DATA0;
148 /* make sure the locked ones go in first */
149 for (i = 0; i < page_descriptor_table_size; i++) {
150 if (CPLB_LOCK & dcplb_table[i][1]) {
151 debug("adding %02i %02i 0x%08x 0x%08x\n", i, j,
152 dcplb_table[i][0], dcplb_table[i][1]);
153 *I0++ = dcplb_table[i][0];
154 *I1++ = dcplb_table[i][1];
157 debug("skip %02i %02i 0x%08x 0x%08x\n", i, j,
158 dcplb_table[i][0], dcplb_table[i][1]);
162 for (i = 0; i < page_descriptor_table_size; i++) {
163 if (!(CPLB_LOCK & dcplb_table[i][1])) {
164 debug("adding %02i %02i 0x%08x 0x%08x\n", i, j,
165 dcplb_table[i][0], dcplb_table[i][1]);
166 *I0++ = dcplb_table[i][0];
167 *I1++ = dcplb_table[i][1];
175 /* Fill the rest with invalid entry */
177 for (; j < 16; j++) {
178 debug("filling %i with 0", j);
184 temp = *(unsigned int *)DMEM_CONTROL;
187 *(unsigned int *)DMEM_CONTROL =
188 ACACHE_BCACHE | ENDCPLB | PORT_PREF0 | temp;
193 void dcache_disable(void)
195 unsigned int *I0, *I1;
201 *(unsigned int *)DMEM_CONTROL &=
202 ~(ACACHE_BCACHE | ENDCPLB | PORT_PREF0);
206 /* after disable dcache,
207 * clear it so we don't confuse the next application
209 I0 = (unsigned int *)DCPLB_ADDR0;
210 I1 = (unsigned int *)DCPLB_DATA0;
212 for (i = 0; i < 16; i++) {
218 int dcache_status(void)
221 value = *(unsigned int *)DMEM_CONTROL;
223 if (value & (ENDCPLB))