1
2
3
4
5
6
7 #include <linux/linkage.h>
8 #include <linux/init.h>
9 #include <asm/assembler.h>
10 #include <asm/memory.h>
11 #include <asm/page.h>
12 #include "proc-macros.S"
13
14
15
16
17 #define CACHE_DLINESIZE 32
18
19
20
21
22 #if defined(CONFIG_CPU_SA110)
23 # define CACHE_DSIZE 16384
24 #elif defined(CONFIG_CPU_SA1100)
25 # define CACHE_DSIZE 8192
26 #else
27 # error Unknown cache size
28 #endif
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44 #define CACHE_DLIMIT (CACHE_DSIZE * 4)
45
46 .data
47 .align 2
48 flush_base:
49 .long FLUSH_BASE
50 .text
51
52
53
54
55
56
57 ENTRY(v4wb_flush_icache_all)
58 mov r0, #0
59 mcr p15, 0, r0, c7, c5, 0 @ invalidate I cache
60 ret lr
61 ENDPROC(v4wb_flush_icache_all)
62
63
64
65
66
67
68
69 ENTRY(v4wb_flush_user_cache_all)
70
71
72
73
74
75
76 ENTRY(v4wb_flush_kern_cache_all)
77 mov ip, #0
78 mcr p15, 0, ip, c7, c5, 0 @ invalidate I cache
79 __flush_whole_cache:
80 ldr r3, =flush_base
81 ldr r1, [r3, #0]
82 eor r1, r1, #CACHE_DSIZE
83 str r1, [r3, #0]
84 add r2, r1, #CACHE_DSIZE
85 1: ldr r3, [r1], #32
86 cmp r1, r2
87 blo 1b
88 #ifdef FLUSH_BASE_MINICACHE
89 add r2, r2, #FLUSH_BASE_MINICACHE - FLUSH_BASE
90 sub r1, r2, #512 @ only 512 bytes
91 1: ldr r3, [r1], #32
92 cmp r1, r2
93 blo 1b
94 #endif
95 mcr p15, 0, ip, c7, c10, 4 @ drain write buffer
96 ret lr
97
98
99
100
101
102
103
104
105
106
107
108 ENTRY(v4wb_flush_user_cache_range)
109 mov ip, #0
110 sub r3, r1, r0 @ calculate total size
111 tst r2, #VM_EXEC @ executable region?
112 mcrne p15, 0, ip, c7, c5, 0 @ invalidate I cache
113
114 cmp r3, #CACHE_DLIMIT @ total size >= limit?
115 bhs __flush_whole_cache @ flush whole D cache
116
117 1: mcr p15, 0, r0, c7, c10, 1 @ clean D entry
118 mcr p15, 0, r0, c7, c6, 1 @ invalidate D entry
119 add r0, r0, #CACHE_DLINESIZE
120 cmp r0, r1
121 blo 1b
122 tst r2, #VM_EXEC
123 mcrne p15, 0, ip, c7, c10, 4 @ drain write buffer
124 ret lr
125
126
127
128
129
130
131
132
133
134
135 ENTRY(v4wb_flush_kern_dcache_area)
136 add r1, r0, r1
137
138
139
140
141
142
143
144
145
146
147
148
149 ENTRY(v4wb_coherent_kern_range)
150
151
152
153
154
155
156
157
158
159
160
161
162 ENTRY(v4wb_coherent_user_range)
163 bic r0, r0, #CACHE_DLINESIZE - 1
164 1: mcr p15, 0, r0, c7, c10, 1 @ clean D entry
165 mcr p15, 0, r0, c7, c6, 1 @ invalidate D entry
166 add r0, r0, #CACHE_DLINESIZE
167 cmp r0, r1
168 blo 1b
169 mov r0, #0
170 mcr p15, 0, r0, c7, c5, 0 @ invalidate I cache
171 mcr p15, 0, r0, c7, c10, 4 @ drain WB
172 ret lr
173
174
175
176
177
178
179
180
181
182
183
184
185
186 v4wb_dma_inv_range:
187 tst r0, #CACHE_DLINESIZE - 1
188 bic r0, r0, #CACHE_DLINESIZE - 1
189 mcrne p15, 0, r0, c7, c10, 1 @ clean D entry
190 tst r1, #CACHE_DLINESIZE - 1
191 mcrne p15, 0, r1, c7, c10, 1 @ clean D entry
192 1: mcr p15, 0, r0, c7, c6, 1 @ invalidate D entry
193 add r0, r0, #CACHE_DLINESIZE
194 cmp r0, r1
195 blo 1b
196 mcr p15, 0, r0, c7, c10, 4 @ drain write buffer
197 ret lr
198
199
200
201
202
203
204
205
206
207 v4wb_dma_clean_range:
208 bic r0, r0, #CACHE_DLINESIZE - 1
209 1: mcr p15, 0, r0, c7, c10, 1 @ clean D entry
210 add r0, r0, #CACHE_DLINESIZE
211 cmp r0, r1
212 blo 1b
213 mcr p15, 0, r0, c7, c10, 4 @ drain write buffer
214 ret lr
215
216
217
218
219
220
221
222
223
224
225
226 .globl v4wb_dma_flush_range
227 .set v4wb_dma_flush_range, v4wb_coherent_kern_range
228
229
230
231
232
233
234
235 ENTRY(v4wb_dma_map_area)
236 add r1, r1, r0
237 cmp r2, #DMA_TO_DEVICE
238 beq v4wb_dma_clean_range
239 bcs v4wb_dma_inv_range
240 b v4wb_dma_flush_range
241 ENDPROC(v4wb_dma_map_area)
242
243
244
245
246
247
248
249 ENTRY(v4wb_dma_unmap_area)
250 ret lr
251 ENDPROC(v4wb_dma_unmap_area)
252
253 .globl v4wb_flush_kern_cache_louis
254 .equ v4wb_flush_kern_cache_louis, v4wb_flush_kern_cache_all
255
256 __INITDATA
257
258 @ define struct cpu_cache_fns (see <asm/cacheflush.h> and proc-macros.S)
259 define_cache_functions v4wb