| /* |
| * Copyright 2004-2007 Analog Devices Inc. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, see the file COPYING, or write |
| * to the Free Software Foundation, Inc., |
| * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
| */ |
| |
| #include <linux/cpu.h> |
| |
| #include <asm/cacheflush.h> |
| #include <asm/blackfin.h> |
| #include <asm/cplb.h> |
| #include <asm/cplbinit.h> |
| |
| #if defined(CONFIG_BFIN_ICACHE) |
| void __init bfin_icache_init(void) |
| { |
| unsigned long *table = icplb_table; |
| unsigned long ctrl; |
| int i; |
| |
| for (i = 0; i < MAX_CPLBS; i++) { |
| unsigned long addr = *table++; |
| unsigned long data = *table++; |
| if (addr == (unsigned long)-1) |
| break; |
| bfin_write32(ICPLB_ADDR0 + i * 4, addr); |
| bfin_write32(ICPLB_DATA0 + i * 4, data); |
| } |
| ctrl = bfin_read_IMEM_CONTROL(); |
| ctrl |= IMC | ENICPLB; |
| bfin_write_IMEM_CONTROL(ctrl); |
| SSYNC(); |
| } |
| #endif |
| |
| #if defined(CONFIG_BFIN_DCACHE) |
| void __init bfin_dcache_init(void) |
| { |
| unsigned long *table = dcplb_table; |
| unsigned long ctrl; |
| int i; |
| |
| for (i = 0; i < MAX_CPLBS; i++) { |
| unsigned long addr = *table++; |
| unsigned long data = *table++; |
| if (addr == (unsigned long)-1) |
| break; |
| bfin_write32(DCPLB_ADDR0 + i * 4, addr); |
| bfin_write32(DCPLB_DATA0 + i * 4, data); |
| } |
| ctrl = bfin_read_DMEM_CONTROL(); |
| ctrl |= DMEM_CNTR; |
| bfin_write_DMEM_CONTROL(ctrl); |
| SSYNC(); |
| } |
| #endif |