1
2
3
4
5
6
7
8
9
10
11
12 #include <linux/linkage.h>
13 #include <linux/init.h>
14 #include <asm/assembler.h>
15 #include <asm/asm-offsets.h>
16 #include <asm/hwcap.h>
17 #include <asm/pgtable-hwdef.h>
18 #include <asm/pgtable.h>
19 #include <asm/ptrace.h>
20
21 #include "proc-macros.S"
22
23
24
25
26
27
28
29
30
31 #define MAX_AREA_SIZE 32768
32
33
34
35
36 #define CACHE_DLINESIZE 32
37
38
39
40
41 #define CACHE_DSEGMENTS 16
42
43
44
45
46 #define CACHE_DENTRIES 64
47
48
49
50
51
52
53 #define CACHE_DLIMIT 32768
54
55 .text
56
57
58
59 ENTRY(cpu_arm1022_proc_init)
60 ret lr
61
62
63
64
65 ENTRY(cpu_arm1022_proc_fin)
66 mrc p15, 0, r0, c1, c0, 0 @ ctrl register
67 bic r0, r0, #0x1000 @ ...i............
68 bic r0, r0, #0x000e @ ............wca.
69 mcr p15, 0, r0, c1, c0, 0 @ disable caches
70 ret lr
71
72
73
74
75
76
77
78
79
80
81 .align 5
82 .pushsection .idmap.text, "ax"
83 ENTRY(cpu_arm1022_reset)
84 mov ip, #0
85 mcr p15, 0, ip, c7, c7, 0 @ invalidate I,D caches
86 mcr p15, 0, ip, c7, c10, 4 @ drain WB
87 #ifdef CONFIG_MMU
88 mcr p15, 0, ip, c8, c7, 0 @ invalidate I & D TLBs
89 #endif
90 mrc p15, 0, ip, c1, c0, 0 @ ctrl register
91 bic ip, ip, #0x000f @ ............wcam
92 bic ip, ip, #0x1100 @ ...i...s........
93 mcr p15, 0, ip, c1, c0, 0 @ ctrl register
94 ret r0
95 ENDPROC(cpu_arm1022_reset)
96 .popsection
97
98
99
100
101 .align 5
102 ENTRY(cpu_arm1022_do_idle)
103 mcr p15, 0, r0, c7, c0, 4 @ Wait for interrupt
104 ret lr
105
106
107
108 .align 5
109
110
111
112
113
114
115 ENTRY(arm1022_flush_icache_all)
116 #ifndef CONFIG_CPU_ICACHE_DISABLE
117 mov r0, #0
118 mcr p15, 0, r0, c7, c5, 0 @ invalidate I cache
119 #endif
120 ret lr
121 ENDPROC(arm1022_flush_icache_all)
122
123
124
125
126
127
128
129 ENTRY(arm1022_flush_user_cache_all)
130
131
132
133
134
135
136 ENTRY(arm1022_flush_kern_cache_all)
137 mov r2, #VM_EXEC
138 mov ip, #0
139 __flush_whole_cache:
140 #ifndef CONFIG_CPU_DCACHE_DISABLE
141 mov r1, #(CACHE_DSEGMENTS - 1) << 5 @ 16 segments
142 1: orr r3, r1, #(CACHE_DENTRIES - 1) << 26 @ 64 entries
143 2: mcr p15, 0, r3, c7, c14, 2 @ clean+invalidate D index
144 subs r3, r3, #1 << 26
145 bcs 2b @ entries 63 to 0
146 subs r1, r1, #1 << 5
147 bcs 1b @ segments 15 to 0
148 #endif
149 tst r2, #VM_EXEC
150 #ifndef CONFIG_CPU_ICACHE_DISABLE
151 mcrne p15, 0, ip, c7, c5, 0 @ invalidate I cache
152 #endif
153 mcrne p15, 0, ip, c7, c10, 4 @ drain WB
154 ret lr
155
156
157
158
159
160
161
162
163
164
165
166 ENTRY(arm1022_flush_user_cache_range)
167 mov ip, #0
168 sub r3, r1, r0 @ calculate total size
169 cmp r3, #CACHE_DLIMIT
170 bhs __flush_whole_cache
171
172 #ifndef CONFIG_CPU_DCACHE_DISABLE
173 1: mcr p15, 0, r0, c7, c14, 1 @ clean+invalidate D entry
174 add r0, r0, #CACHE_DLINESIZE
175 cmp r0, r1
176 blo 1b
177 #endif
178 tst r2, #VM_EXEC
179 #ifndef CONFIG_CPU_ICACHE_DISABLE
180 mcrne p15, 0, ip, c7, c5, 0 @ invalidate I cache
181 #endif
182 mcrne p15, 0, ip, c7, c10, 4 @ drain WB
183 ret lr
184
185
186
187
188
189
190
191
192
193
194
195 ENTRY(arm1022_coherent_kern_range)
196
197
198
199
200
201
202
203
204
205
206
207
208 ENTRY(arm1022_coherent_user_range)
209 mov ip, #0
210 bic r0, r0, #CACHE_DLINESIZE - 1
211 1:
212 #ifndef CONFIG_CPU_DCACHE_DISABLE
213 mcr p15, 0, r0, c7, c10, 1 @ clean D entry
214 #endif
215 #ifndef CONFIG_CPU_ICACHE_DISABLE
216 mcr p15, 0, r0, c7, c5, 1 @ invalidate I entry
217 #endif
218 add r0, r0, #CACHE_DLINESIZE
219 cmp r0, r1
220 blo 1b
221 mcr p15, 0, ip, c7, c10, 4 @ drain WB
222 mov r0, #0
223 ret lr
224
225
226
227
228
229
230
231
232
233
234 ENTRY(arm1022_flush_kern_dcache_area)
235 mov ip, #0
236 #ifndef CONFIG_CPU_DCACHE_DISABLE
237 add r1, r0, r1
238 1: mcr p15, 0, r0, c7, c14, 1 @ clean+invalidate D entry
239 add r0, r0, #CACHE_DLINESIZE
240 cmp r0, r1
241 blo 1b
242 #endif
243 mcr p15, 0, ip, c7, c10, 4 @ drain WB
244 ret lr
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259 arm1022_dma_inv_range:
260 mov ip, #0
261 #ifndef CONFIG_CPU_DCACHE_DISABLE
262 tst r0, #CACHE_DLINESIZE - 1
263 bic r0, r0, #CACHE_DLINESIZE - 1
264 mcrne p15, 0, r0, c7, c10, 1 @ clean D entry
265 tst r1, #CACHE_DLINESIZE - 1
266 mcrne p15, 0, r1, c7, c10, 1 @ clean D entry
267 1: mcr p15, 0, r0, c7, c6, 1 @ invalidate D entry
268 add r0, r0, #CACHE_DLINESIZE
269 cmp r0, r1
270 blo 1b
271 #endif
272 mcr p15, 0, ip, c7, c10, 4 @ drain WB
273 ret lr
274
275
276
277
278
279
280
281
282
283
284
285 arm1022_dma_clean_range:
286 mov ip, #0
287 #ifndef CONFIG_CPU_DCACHE_DISABLE
288 bic r0, r0, #CACHE_DLINESIZE - 1
289 1: mcr p15, 0, r0, c7, c10, 1 @ clean D entry
290 add r0, r0, #CACHE_DLINESIZE
291 cmp r0, r1
292 blo 1b
293 #endif
294 mcr p15, 0, ip, c7, c10, 4 @ drain WB
295 ret lr
296
297
298
299
300
301
302
303
304
305 ENTRY(arm1022_dma_flush_range)
306 mov ip, #0
307 #ifndef CONFIG_CPU_DCACHE_DISABLE
308 bic r0, r0, #CACHE_DLINESIZE - 1
309 1: mcr p15, 0, r0, c7, c14, 1 @ clean+invalidate D entry
310 add r0, r0, #CACHE_DLINESIZE
311 cmp r0, r1
312 blo 1b
313 #endif
314 mcr p15, 0, ip, c7, c10, 4 @ drain WB
315 ret lr
316
317
318
319
320
321
322
323 ENTRY(arm1022_dma_map_area)
324 add r1, r1, r0
325 cmp r2, #DMA_TO_DEVICE
326 beq arm1022_dma_clean_range
327 bcs arm1022_dma_inv_range
328 b arm1022_dma_flush_range
329 ENDPROC(arm1022_dma_map_area)
330
331
332
333
334
335
336
337 ENTRY(arm1022_dma_unmap_area)
338 ret lr
339 ENDPROC(arm1022_dma_unmap_area)
340
341 .globl arm1022_flush_kern_cache_louis
342 .equ arm1022_flush_kern_cache_louis, arm1022_flush_kern_cache_all
343
344 @ define struct cpu_cache_fns (see <asm/cacheflush.h> and proc-macros.S)
345 define_cache_functions arm1022
346
347 .align 5
348 ENTRY(cpu_arm1022_dcache_clean_area)
349 #ifndef CONFIG_CPU_DCACHE_DISABLE
350 mov ip, #0
351 1: mcr p15, 0, r0, c7, c10, 1 @ clean D entry
352 add r0, r0, #CACHE_DLINESIZE
353 subs r1, r1, #CACHE_DLINESIZE
354 bhi 1b
355 #endif
356 ret lr
357
358
359
360
361
362
363
364
365
366
367 .align 5
368 ENTRY(cpu_arm1022_switch_mm)
369 #ifdef CONFIG_MMU
370 #ifndef CONFIG_CPU_DCACHE_DISABLE
371 mov r1, #(CACHE_DSEGMENTS - 1) << 5 @ 16 segments
372 1: orr r3, r1, #(CACHE_DENTRIES - 1) << 26 @ 64 entries
373 2: mcr p15, 0, r3, c7, c14, 2 @ clean+invalidate D index
374 subs r3, r3, #1 << 26
375 bcs 2b @ entries 63 to 0
376 subs r1, r1, #1 << 5
377 bcs 1b @ segments 15 to 0
378 #endif
379 mov r1, #0
380 #ifndef CONFIG_CPU_ICACHE_DISABLE
381 mcr p15, 0, r1, c7, c5, 0 @ invalidate I cache
382 #endif
383 mcr p15, 0, r1, c7, c10, 4 @ drain WB
384 mcr p15, 0, r0, c2, c0, 0 @ load page table pointer
385 mcr p15, 0, r1, c8, c7, 0 @ invalidate I & D TLBs
386 #endif
387 ret lr
388
389
390
391
392
393
394 .align 5
395 ENTRY(cpu_arm1022_set_pte_ext)
396 #ifdef CONFIG_MMU
397 armv3_set_pte_ext
398 mov r0, r0
399 #ifndef CONFIG_CPU_DCACHE_DISABLE
400 mcr p15, 0, r0, c7, c10, 1 @ clean D entry
401 #endif
402 #endif
403 ret lr
404
405 .type __arm1022_setup, #function
406 __arm1022_setup:
407 mov r0, #0
408 mcr p15, 0, r0, c7, c7 @ invalidate I,D caches on v4
409 mcr p15, 0, r0, c7, c10, 4 @ drain write buffer on v4
410 #ifdef CONFIG_MMU
411 mcr p15, 0, r0, c8, c7 @ invalidate I,D TLBs on v4
412 #endif
413 adr r5, arm1022_crval
414 ldmia r5, {r5, r6}
415 mrc p15, 0, r0, c1, c0 @ get control register v4
416 bic r0, r0, r5
417 orr r0, r0, r6
418 #ifdef CONFIG_CPU_CACHE_ROUND_ROBIN
419 orr r0, r0, #0x4000 @ .R..............
420 #endif
421 ret lr
422 .size __arm1022_setup, . - __arm1022_setup
423
424
425
426
427
428
429
430 .type arm1022_crval, #object
431 arm1022_crval:
432 crval clear=0x00007f3f, mmuset=0x00003935, ucset=0x00001930
433
434 __INITDATA
435 @ define struct processor (see <asm/proc-fns.h> and proc-macros.S)
436 define_processor_functions arm1022, dabort=v4t_early_abort, pabort=legacy_pabort
437
438 .section ".rodata"
439
440 string cpu_arch_name, "armv5te"
441 string cpu_elf_name, "v5"
442 string cpu_arm1022_name, "ARM1022"
443
444 .align
445
446 .section ".proc.info.init", #alloc
447
448 .type __arm1022_proc_info,#object
449 __arm1022_proc_info:
450 .long 0x4105a220 @ ARM 1022E (v5TE)
451 .long 0xff0ffff0
452 .long PMD_TYPE_SECT | \
453 PMD_BIT4 | \
454 PMD_SECT_AP_WRITE | \
455 PMD_SECT_AP_READ
456 .long PMD_TYPE_SECT | \
457 PMD_BIT4 | \
458 PMD_SECT_AP_WRITE | \
459 PMD_SECT_AP_READ
460 initfn __arm1022_setup, __arm1022_proc_info
461 .long cpu_arch_name
462 .long cpu_elf_name
463 .long HWCAP_SWP | HWCAP_HALF | HWCAP_THUMB | HWCAP_EDSP
464 .long cpu_arm1022_name
465 .long arm1022_processor_functions
466 .long v4wbi_tlb_fns
467 .long v4wb_user_fns
468 .long arm1022_cache_fns
469 .size __arm1022_proc_info, . - __arm1022_proc_info