1
2
3
4
5
6
7
8
9#include <linux/init.h>
10#include <asm/blackfin.h>
11#include <asm/cplbinit.h>
12
13
14
15
16void blackfin_invalidate_entire_dcache(void)
17{
18 u32 dmem = bfin_read_DMEM_CONTROL();
19 bfin_write_DMEM_CONTROL(dmem & ~0xc);
20 SSYNC();
21 bfin_write_DMEM_CONTROL(dmem);
22 SSYNC();
23}
24
25
26
27
28void blackfin_invalidate_entire_icache(void)
29{
30 u32 imem = bfin_read_IMEM_CONTROL();
31 bfin_write_IMEM_CONTROL(imem & ~0x4);
32 SSYNC();
33 bfin_write_IMEM_CONTROL(imem);
34 SSYNC();
35}
36
37#if defined(CONFIG_BFIN_ICACHE) || defined(CONFIG_BFIN_DCACHE)
38
39static void
40bfin_cache_init(struct cplb_entry *cplb_tbl, unsigned long cplb_addr,
41 unsigned long cplb_data, unsigned long mem_control,
42 unsigned long mem_mask)
43{
44 int i;
45
46 for (i = 0; i < MAX_CPLBS; i++) {
47 bfin_write32(cplb_addr + i * 4, cplb_tbl[i].addr);
48 bfin_write32(cplb_data + i * 4, cplb_tbl[i].data);
49 }
50
51 _enable_cplb(mem_control, mem_mask);
52}
53
54#ifdef CONFIG_BFIN_ICACHE
55void __cpuinit bfin_icache_init(struct cplb_entry *icplb_tbl)
56{
57 bfin_cache_init(icplb_tbl, ICPLB_ADDR0, ICPLB_DATA0, IMEM_CONTROL,
58 (IMC | ENICPLB));
59}
60#endif
61
62#ifdef CONFIG_BFIN_DCACHE
63void __cpuinit bfin_dcache_init(struct cplb_entry *dcplb_tbl)
64{
65
66
67
68
69
70
71 bfin_cache_init(dcplb_tbl, DCPLB_ADDR0, DCPLB_DATA0, DMEM_CONTROL,
72 (DMEM_CNTR | PORT_PREF0 | (ANOMALY_05000287 ? PORT_PREF1 : 0)));
73}
74#endif
75
76#endif
77