Commit | Line | Data |
---|---|---|
b97b8a99 BS |
1 | /* |
2 | * Copyright 2004-2007 Analog Devices Inc. | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License as published by | |
6 | * the Free Software Foundation; either version 2 of the License, or | |
7 | * (at your option) any later version. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 | * GNU General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License | |
15 | * along with this program; if not, see the file COPYING, or write | |
16 | * to the Free Software Foundation, Inc., | |
17 | * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA | |
18 | */ | |
19 | ||
20 | #include <linux/cpu.h> | |
21 | ||
22 | #include <asm/cacheflush.h> | |
23 | #include <asm/blackfin.h> | |
24 | #include <asm/cplb.h> | |
25 | #include <asm/cplbinit.h> | |
26 | ||
27 | #if defined(CONFIG_BFIN_ICACHE) | |
b8a98989 | 28 | void __cpuinit bfin_icache_init(struct cplb_entry *icplb_tbl) |
b97b8a99 BS |
29 | { |
30 | unsigned long ctrl; | |
31 | int i; | |
32 | ||
33 | SSYNC(); | |
34 | for (i = 0; i < MAX_CPLBS; i++) { | |
35 | bfin_write32(ICPLB_ADDR0 + i * 4, icplb_tbl[i].addr); | |
36 | bfin_write32(ICPLB_DATA0 + i * 4, icplb_tbl[i].data); | |
37 | } | |
38 | ctrl = bfin_read_IMEM_CONTROL(); | |
39 | ctrl |= IMC | ENICPLB; | |
40 | bfin_write_IMEM_CONTROL(ctrl); | |
41 | SSYNC(); | |
42 | } | |
43 | #endif | |
44 | ||
45 | #if defined(CONFIG_BFIN_DCACHE) | |
b8a98989 | 46 | void __cpuinit bfin_dcache_init(struct cplb_entry *dcplb_tbl) |
b97b8a99 BS |
47 | { |
48 | unsigned long ctrl; | |
49 | int i; | |
50 | ||
51 | SSYNC(); | |
52 | for (i = 0; i < MAX_CPLBS; i++) { | |
53 | bfin_write32(DCPLB_ADDR0 + i * 4, dcplb_tbl[i].addr); | |
54 | bfin_write32(DCPLB_DATA0 + i * 4, dcplb_tbl[i].data); | |
55 | } | |
56 | ||
57 | ctrl = bfin_read_DMEM_CONTROL(); | |
e522c846 GY |
58 | |
59 | /* | |
60 | * Anomaly notes: | |
61 | * 05000287 - We implement workaround #2 - Change the DMEM_CONTROL | |
62 | * register, so that the port preferences for DAG0 and DAG1 are set | |
63 | * to port B | |
64 | */ | |
65 | ctrl |= DMEM_CNTR | PORT_PREF0 | (ANOMALY_05000287 ? PORT_PREF1 : 0); | |
b97b8a99 BS |
66 | bfin_write_DMEM_CONTROL(ctrl); |
67 | SSYNC(); | |
68 | } | |
69 | #endif |