1
2
3
4
5
6
7
8
9
10
11
12#include <linux/init.h>
13#include <linux/mman.h>
14#include <linux/mm.h>
15#include <linux/fs.h>
16#include <linux/threads.h>
17#include <asm/addrspace.h>
18#include <asm/page.h>
19#include <asm/processor.h>
20#include <asm/cache.h>
21#include <asm/io.h>
22#include <linux/uaccess.h>
23#include <asm/mmu_context.h>
24#include <asm/cacheflush.h>
25
26
27
28
29
30static inline void cache_wback_all(void)
31{
32 unsigned long ways, waysize, addrstart;
33
34 ways = current_cpu_data.dcache.ways;
35 waysize = current_cpu_data.dcache.sets;
36 waysize <<= current_cpu_data.dcache.entry_shift;
37
38 addrstart = CACHE_OC_ADDRESS_ARRAY;
39
40 do {
41 unsigned long addr;
42
43 for (addr = addrstart;
44 addr < addrstart + waysize;
45 addr += current_cpu_data.dcache.linesz) {
46 unsigned long data;
47 int v = SH_CACHE_UPDATED | SH_CACHE_VALID;
48
49 data = __raw_readl(addr);
50
51 if ((data & v) == v)
52 __raw_writel(data & ~v, addr);
53
54 }
55
56 addrstart += current_cpu_data.dcache.way_incr;
57 } while (--ways);
58}
59
60
61
62
63
64
65static void sh7705_flush_icache_range(void *args)
66{
67 struct flusher_data *data = args;
68 unsigned long start, end;
69
70 start = data->addr1;
71 end = data->addr2;
72
73 __flush_wback_region((void *)start, end - start);
74}
75
76
77
78
79static void __flush_dcache_page(unsigned long phys)
80{
81 unsigned long ways, waysize, addrstart;
82 unsigned long flags;
83
84 phys |= SH_CACHE_VALID;
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99 local_irq_save(flags);
100 jump_to_uncached();
101
102 ways = current_cpu_data.dcache.ways;
103 waysize = current_cpu_data.dcache.sets;
104 waysize <<= current_cpu_data.dcache.entry_shift;
105
106 addrstart = CACHE_OC_ADDRESS_ARRAY;
107
108 do {
109 unsigned long addr;
110
111 for (addr = addrstart;
112 addr < addrstart + waysize;
113 addr += current_cpu_data.dcache.linesz) {
114 unsigned long data;
115
116 data = __raw_readl(addr) & (0x1ffffC00 | SH_CACHE_VALID);
117 if (data == phys) {
118 data &= ~(SH_CACHE_VALID | SH_CACHE_UPDATED);
119 __raw_writel(data, addr);
120 }
121 }
122
123 addrstart += current_cpu_data.dcache.way_incr;
124 } while (--ways);
125
126 back_to_cached();
127 local_irq_restore(flags);
128}
129
130
131
132
133
134static void sh7705_flush_dcache_page(void *arg)
135{
136 struct page *page = arg;
137 struct address_space *mapping = page_mapping_file(page);
138
139 if (mapping && !mapping_mapped(mapping))
140 clear_bit(PG_dcache_clean, &page->flags);
141 else
142 __flush_dcache_page(__pa(page_address(page)));
143}
144
145static void sh7705_flush_cache_all(void *args)
146{
147 unsigned long flags;
148
149 local_irq_save(flags);
150 jump_to_uncached();
151
152 cache_wback_all();
153 back_to_cached();
154 local_irq_restore(flags);
155}
156
157
158
159
160
161
162static void sh7705_flush_cache_page(void *args)
163{
164 struct flusher_data *data = args;
165 unsigned long pfn = data->addr2;
166
167 __flush_dcache_page(pfn << PAGE_SHIFT);
168}
169
170
171
172
173
174
175
176
177
178static void sh7705_flush_icache_page(void *page)
179{
180 __flush_purge_region(page_address(page), PAGE_SIZE);
181}
182
183void __init sh7705_cache_init(void)
184{
185 local_flush_icache_range = sh7705_flush_icache_range;
186 local_flush_dcache_page = sh7705_flush_dcache_page;
187 local_flush_cache_all = sh7705_flush_cache_all;
188 local_flush_cache_mm = sh7705_flush_cache_all;
189 local_flush_cache_dup_mm = sh7705_flush_cache_all;
190 local_flush_cache_range = sh7705_flush_cache_all;
191 local_flush_cache_page = sh7705_flush_cache_page;
192 local_flush_icache_page = sh7705_flush_icache_page;
193}
194