Commit | Line | Data |
---|---|---|
23bdf86a LB |
1 | /* |
2 | * linux/arch/arm/mm/proc-xsc3.S | |
3 | * | |
4 | * Original Author: Matthew Gilbert | |
57fee39f | 5 | * Current Maintainer: Lennert Buytenhek <buytenh@wantstofly.org> |
23bdf86a LB |
6 | * |
7 | * Copyright 2004 (C) Intel Corp. | |
850b4293 | 8 | * Copyright 2005 (C) MontaVista Software, Inc. |
23bdf86a LB |
9 | * |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License version 2 as | |
12 | * published by the Free Software Foundation. | |
13 | * | |
850b4293 LB |
14 | * MMU functions for the Intel XScale3 Core (XSC3). The XSC3 core is |
15 | * an extension to Intel's original XScale core that adds the following | |
23bdf86a LB |
16 | * features: |
17 | * | |
18 | * - ARMv6 Supersections | |
19 | * - Low Locality Reference pages (replaces mini-cache) | |
20 | * - 36-bit addressing | |
21 | * - L2 cache | |
850b4293 | 22 | * - Cache coherency if chipset supports it |
23bdf86a | 23 | * |
850b4293 | 24 | * Based on original XScale code by Nicolas Pitre. |
23bdf86a LB |
25 | */ |
26 | ||
27 | #include <linux/linkage.h> | |
28 | #include <linux/init.h> | |
29 | #include <asm/assembler.h> | |
5ec9407d | 30 | #include <asm/hwcap.h> |
23bdf86a | 31 | #include <asm/pgtable.h> |
b48340af | 32 | #include <asm/pgtable-hwdef.h> |
23bdf86a LB |
33 | #include <asm/page.h> |
34 | #include <asm/ptrace.h> | |
35 | #include "proc-macros.S" | |
36 | ||
37 | /* | |
38 | * This is the maximum size of an area which will be flushed. If the | |
39 | * area is larger than this, then we flush the whole cache. | |
40 | */ | |
41 | #define MAX_AREA_SIZE 32768 | |
42 | ||
43 | /* | |
850b4293 | 44 | * The cache line size of the L1 I, L1 D and unified L2 cache. |
23bdf86a LB |
45 | */ |
46 | #define CACHELINESIZE 32 | |
47 | ||
48 | /* | |
850b4293 | 49 | * The size of the L1 D cache. |
23bdf86a LB |
50 | */ |
51 | #define CACHESIZE 32768 | |
52 | ||
23bdf86a | 53 | /* |
850b4293 LB |
54 | * This macro is used to wait for a CP15 write and is needed when we |
55 | * have to ensure that the last operation to the coprocessor was | |
56 | * completed before continuing with operation. | |
23bdf86a LB |
57 | */ |
58 | .macro cpwait_ret, lr, rd | |
59 | mrc p15, 0, \rd, c2, c0, 0 @ arbitrary read of cp15 | |
60 | sub pc, \lr, \rd, LSR #32 @ wait for completion and | |
61 | @ flush instruction pipeline | |
62 | .endm | |
63 | ||
64 | /* | |
850b4293 | 65 | * This macro cleans and invalidates the entire L1 D cache. |
23bdf86a LB |
66 | */ |
67 | ||
68 | .macro clean_d_cache rd, rs | |
69 | mov \rd, #0x1f00 | |
70 | orr \rd, \rd, #0x00e0 | |
850b4293 | 71 | 1: mcr p15, 0, \rd, c7, c14, 2 @ clean/invalidate L1 D line |
23bdf86a LB |
72 | adds \rd, \rd, #0x40000000 |
73 | bcc 1b | |
74 | subs \rd, \rd, #0x20 | |
75 | bpl 1b | |
76 | .endm | |
77 | ||
78 | .text | |
79 | ||
80 | /* | |
81 | * cpu_xsc3_proc_init() | |
82 | * | |
83 | * Nothing too exciting at the moment | |
84 | */ | |
85 | ENTRY(cpu_xsc3_proc_init) | |
86 | mov pc, lr | |
87 | ||
88 | /* | |
89 | * cpu_xsc3_proc_fin() | |
90 | */ | |
91 | ENTRY(cpu_xsc3_proc_fin) | |
23bdf86a LB |
92 | mrc p15, 0, r0, c1, c0, 0 @ ctrl register |
93 | bic r0, r0, #0x1800 @ ...IZ........... | |
94 | bic r0, r0, #0x0006 @ .............CA. | |
95 | mcr p15, 0, r0, c1, c0, 0 @ disable caches | |
9ca03a21 | 96 | mov pc, lr |
23bdf86a LB |
97 | |
98 | /* | |
99 | * cpu_xsc3_reset(loc) | |
100 | * | |
101 | * Perform a soft reset of the system. Put the CPU into the | |
102 | * same state as it would be if it had been reset, and branch | |
103 | * to what would be the reset vector. | |
104 | * | |
105 | * loc: location to jump to for soft reset | |
106 | */ | |
107 | .align 5 | |
1a4baafa | 108 | .pushsection .idmap.text, "ax" |
23bdf86a LB |
109 | ENTRY(cpu_xsc3_reset) |
110 | mov r1, #PSR_F_BIT|PSR_I_BIT|SVC_MODE | |
111 | msr cpsr_c, r1 @ reset CPSR | |
112 | mrc p15, 0, r1, c1, c0, 0 @ ctrl register | |
23bdf86a | 113 | bic r1, r1, #0x3900 @ ..VIZ..S........ |
850b4293 | 114 | bic r1, r1, #0x0086 @ ........B....CA. |
23bdf86a | 115 | mcr p15, 0, r1, c1, c0, 0 @ ctrl register |
850b4293 | 116 | mcr p15, 0, ip, c7, c7, 0 @ invalidate L1 caches and BTB |
23bdf86a LB |
117 | bic r1, r1, #0x0001 @ ...............M |
118 | mcr p15, 0, r1, c1, c0, 0 @ ctrl register | |
119 | @ CAUTION: MMU turned off from this point. We count on the pipeline | |
120 | @ already containing those two last instructions to survive. | |
850b4293 | 121 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs |
23bdf86a | 122 | mov pc, r0 |
1a4baafa WD |
123 | ENDPROC(cpu_xsc3_reset) |
124 | .popsection | |
23bdf86a LB |
125 | |
126 | /* | |
127 | * cpu_xsc3_do_idle() | |
128 | * | |
129 | * Cause the processor to idle | |
130 | * | |
131 | * For now we do nothing but go to idle mode for every case | |
132 | * | |
133 | * XScale supports clock switching, but using idle mode support | |
134 | * allows external hardware to react to system state changes. | |
23bdf86a LB |
135 | */ |
136 | .align 5 | |
137 | ||
138 | ENTRY(cpu_xsc3_do_idle) | |
139 | mov r0, #1 | |
850b4293 | 140 | mcr p14, 0, r0, c7, c0, 0 @ go to idle |
23bdf86a LB |
141 | mov pc, lr |
142 | ||
143 | /* ================================= CACHE ================================ */ | |
144 | ||
c8c90860 MW |
145 | /* |
146 | * flush_icache_all() | |
147 | * | |
148 | * Unconditionally clean and invalidate the entire icache. | |
149 | */ | |
150 | ENTRY(xsc3_flush_icache_all) | |
151 | mov r0, #0 | |
152 | mcr p15, 0, r0, c7, c5, 0 @ invalidate I cache | |
153 | mov pc, lr | |
154 | ENDPROC(xsc3_flush_icache_all) | |
155 | ||
23bdf86a LB |
156 | /* |
157 | * flush_user_cache_all() | |
158 | * | |
159 | * Invalidate all cache entries in a particular address | |
160 | * space. | |
161 | */ | |
162 | ENTRY(xsc3_flush_user_cache_all) | |
163 | /* FALLTHROUGH */ | |
164 | ||
165 | /* | |
166 | * flush_kern_cache_all() | |
167 | * | |
168 | * Clean and invalidate the entire cache. | |
169 | */ | |
170 | ENTRY(xsc3_flush_kern_cache_all) | |
171 | mov r2, #VM_EXEC | |
172 | mov ip, #0 | |
173 | __flush_whole_cache: | |
174 | clean_d_cache r0, r1 | |
175 | tst r2, #VM_EXEC | |
850b4293 LB |
176 | mcrne p15, 0, ip, c7, c5, 0 @ invalidate L1 I cache and BTB |
177 | mcrne p15, 0, ip, c7, c10, 4 @ data write barrier | |
178 | mcrne p15, 0, ip, c7, c5, 4 @ prefetch flush | |
23bdf86a LB |
179 | mov pc, lr |
180 | ||
181 | /* | |
182 | * flush_user_cache_range(start, end, vm_flags) | |
183 | * | |
184 | * Invalidate a range of cache entries in the specified | |
185 | * address space. | |
186 | * | |
187 | * - start - start address (may not be aligned) | |
188 | * - end - end address (exclusive, may not be aligned) | |
189 | * - vma - vma_area_struct describing address space | |
190 | */ | |
191 | .align 5 | |
192 | ENTRY(xsc3_flush_user_cache_range) | |
193 | mov ip, #0 | |
194 | sub r3, r1, r0 @ calculate total size | |
195 | cmp r3, #MAX_AREA_SIZE | |
196 | bhs __flush_whole_cache | |
197 | ||
198 | 1: tst r2, #VM_EXEC | |
850b4293 LB |
199 | mcrne p15, 0, r0, c7, c5, 1 @ invalidate L1 I line |
200 | mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line | |
23bdf86a LB |
201 | add r0, r0, #CACHELINESIZE |
202 | cmp r0, r1 | |
203 | blo 1b | |
204 | tst r2, #VM_EXEC | |
850b4293 LB |
205 | mcrne p15, 0, ip, c7, c5, 6 @ invalidate BTB |
206 | mcrne p15, 0, ip, c7, c10, 4 @ data write barrier | |
207 | mcrne p15, 0, ip, c7, c5, 4 @ prefetch flush | |
23bdf86a LB |
208 | mov pc, lr |
209 | ||
210 | /* | |
211 | * coherent_kern_range(start, end) | |
212 | * | |
850b4293 | 213 | * Ensure coherency between the I cache and the D cache in the |
23bdf86a LB |
214 | * region described by start. If you have non-snooping |
215 | * Harvard caches, you need to implement this function. | |
216 | * | |
217 | * - start - virtual start address | |
218 | * - end - virtual end address | |
219 | * | |
220 | * Note: single I-cache line invalidation isn't used here since | |
221 | * it also trashes the mini I-cache used by JTAG debuggers. | |
222 | */ | |
223 | ENTRY(xsc3_coherent_kern_range) | |
224 | /* FALLTHROUGH */ | |
225 | ENTRY(xsc3_coherent_user_range) | |
226 | bic r0, r0, #CACHELINESIZE - 1 | |
850b4293 | 227 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line |
23bdf86a LB |
228 | add r0, r0, #CACHELINESIZE |
229 | cmp r0, r1 | |
230 | blo 1b | |
231 | mov r0, #0 | |
850b4293 LB |
232 | mcr p15, 0, r0, c7, c5, 0 @ invalidate L1 I cache and BTB |
233 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier | |
234 | mcr p15, 0, r0, c7, c5, 4 @ prefetch flush | |
23bdf86a LB |
235 | mov pc, lr |
236 | ||
237 | /* | |
2c9b9c84 | 238 | * flush_kern_dcache_area(void *addr, size_t size) |
23bdf86a LB |
239 | * |
240 | * Ensure no D cache aliasing occurs, either with itself or | |
850b4293 | 241 | * the I cache. |
23bdf86a | 242 | * |
2c9b9c84 RK |
243 | * - addr - kernel address |
244 | * - size - region size | |
23bdf86a | 245 | */ |
2c9b9c84 RK |
246 | ENTRY(xsc3_flush_kern_dcache_area) |
247 | add r1, r0, r1 | |
850b4293 | 248 | 1: mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line |
23bdf86a LB |
249 | add r0, r0, #CACHELINESIZE |
250 | cmp r0, r1 | |
251 | blo 1b | |
252 | mov r0, #0 | |
850b4293 LB |
253 | mcr p15, 0, r0, c7, c5, 0 @ invalidate L1 I cache and BTB |
254 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier | |
255 | mcr p15, 0, r0, c7, c5, 4 @ prefetch flush | |
23bdf86a LB |
256 | mov pc, lr |
257 | ||
258 | /* | |
259 | * dma_inv_range(start, end) | |
260 | * | |
261 | * Invalidate (discard) the specified virtual address range. | |
262 | * May not write back any entries. If 'start' or 'end' | |
263 | * are not cache line aligned, those lines must be written | |
264 | * back. | |
265 | * | |
266 | * - start - virtual start address | |
267 | * - end - virtual end address | |
268 | */ | |
702b94bf | 269 | xsc3_dma_inv_range: |
23bdf86a LB |
270 | tst r0, #CACHELINESIZE - 1 |
271 | bic r0, r0, #CACHELINESIZE - 1 | |
850b4293 | 272 | mcrne p15, 0, r0, c7, c10, 1 @ clean L1 D line |
23bdf86a | 273 | tst r1, #CACHELINESIZE - 1 |
850b4293 | 274 | mcrne p15, 0, r1, c7, c10, 1 @ clean L1 D line |
850b4293 | 275 | 1: mcr p15, 0, r0, c7, c6, 1 @ invalidate L1 D line |
23bdf86a LB |
276 | add r0, r0, #CACHELINESIZE |
277 | cmp r0, r1 | |
278 | blo 1b | |
850b4293 | 279 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
23bdf86a LB |
280 | mov pc, lr |
281 | ||
282 | /* | |
283 | * dma_clean_range(start, end) | |
284 | * | |
285 | * Clean the specified virtual address range. | |
286 | * | |
287 | * - start - virtual start address | |
288 | * - end - virtual end address | |
289 | */ | |
702b94bf | 290 | xsc3_dma_clean_range: |
23bdf86a | 291 | bic r0, r0, #CACHELINESIZE - 1 |
850b4293 | 292 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line |
23bdf86a LB |
293 | add r0, r0, #CACHELINESIZE |
294 | cmp r0, r1 | |
295 | blo 1b | |
850b4293 | 296 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
23bdf86a LB |
297 | mov pc, lr |
298 | ||
299 | /* | |
300 | * dma_flush_range(start, end) | |
301 | * | |
302 | * Clean and invalidate the specified virtual address range. | |
303 | * | |
304 | * - start - virtual start address | |
305 | * - end - virtual end address | |
306 | */ | |
307 | ENTRY(xsc3_dma_flush_range) | |
308 | bic r0, r0, #CACHELINESIZE - 1 | |
850b4293 | 309 | 1: mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line |
23bdf86a LB |
310 | add r0, r0, #CACHELINESIZE |
311 | cmp r0, r1 | |
312 | blo 1b | |
850b4293 | 313 | mcr p15, 0, r0, c7, c10, 4 @ data write barrier |
23bdf86a LB |
314 | mov pc, lr |
315 | ||
a9c9147e RK |
316 | /* |
317 | * dma_map_area(start, size, dir) | |
318 | * - start - kernel virtual start address | |
319 | * - size - size of region | |
320 | * - dir - DMA direction | |
321 | */ | |
322 | ENTRY(xsc3_dma_map_area) | |
323 | add r1, r1, r0 | |
324 | cmp r2, #DMA_TO_DEVICE | |
325 | beq xsc3_dma_clean_range | |
326 | bcs xsc3_dma_inv_range | |
327 | b xsc3_dma_flush_range | |
328 | ENDPROC(xsc3_dma_map_area) | |
329 | ||
330 | /* | |
331 | * dma_unmap_area(start, size, dir) | |
332 | * - start - kernel virtual start address | |
333 | * - size - size of region | |
334 | * - dir - DMA direction | |
335 | */ | |
336 | ENTRY(xsc3_dma_unmap_area) | |
337 | mov pc, lr | |
338 | ENDPROC(xsc3_dma_unmap_area) | |
339 | ||
031bd879 LP |
340 | .globl xsc3_flush_kern_cache_louis |
341 | .equ xsc3_flush_kern_cache_louis, xsc3_flush_kern_cache_all | |
342 | ||
c21898f9 DM |
343 | @ define struct cpu_cache_fns (see <asm/cacheflush.h> and proc-macros.S) |
344 | define_cache_functions xsc3 | |
23bdf86a LB |
345 | |
346 | ENTRY(cpu_xsc3_dcache_clean_area) | |
850b4293 | 347 | 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line |
23bdf86a LB |
348 | add r0, r0, #CACHELINESIZE |
349 | subs r1, r1, #CACHELINESIZE | |
350 | bhi 1b | |
351 | mov pc, lr | |
352 | ||
353 | /* =============================== PageTable ============================== */ | |
354 | ||
355 | /* | |
356 | * cpu_xsc3_switch_mm(pgd) | |
357 | * | |
358 | * Set the translation base pointer to be as described by pgd. | |
359 | * | |
360 | * pgd: new page tables | |
361 | */ | |
362 | .align 5 | |
363 | ENTRY(cpu_xsc3_switch_mm) | |
364 | clean_d_cache r1, r2 | |
850b4293 LB |
365 | mcr p15, 0, ip, c7, c5, 0 @ invalidate L1 I cache and BTB |
366 | mcr p15, 0, ip, c7, c10, 4 @ data write barrier | |
367 | mcr p15, 0, ip, c7, c5, 4 @ prefetch flush | |
23bdf86a | 368 | orr r0, r0, #0x18 @ cache the page table in L2 |
23bdf86a | 369 | mcr p15, 0, r0, c2, c0, 0 @ load page table pointer |
850b4293 | 370 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs |
23bdf86a LB |
371 | cpwait_ret lr, ip |
372 | ||
373 | /* | |
ad1ae2fe | 374 | * cpu_xsc3_set_pte_ext(ptep, pte, ext) |
23bdf86a LB |
375 | * |
376 | * Set a PTE and flush it out | |
23bdf86a | 377 | */ |
9e8b5199 RK |
378 | cpu_xsc3_mt_table: |
379 | .long 0x00 @ L_PTE_MT_UNCACHED | |
40df2d1d | 380 | .long PTE_EXT_TEX(1) @ L_PTE_MT_BUFFERABLE |
6bee00db | 381 | .long PTE_EXT_TEX(5) | PTE_CACHEABLE @ L_PTE_MT_WRITETHROUGH |
40df2d1d RK |
382 | .long PTE_CACHEABLE | PTE_BUFFERABLE @ L_PTE_MT_WRITEBACK |
383 | .long PTE_EXT_TEX(1) | PTE_BUFFERABLE @ L_PTE_MT_DEV_SHARED | |
639b0ae7 | 384 | .long 0x00 @ unused |
9e8b5199 RK |
385 | .long 0x00 @ L_PTE_MT_MINICACHE (not present) |
386 | .long PTE_EXT_TEX(5) | PTE_CACHEABLE | PTE_BUFFERABLE @ L_PTE_MT_WRITEALLOC (not present?) | |
639b0ae7 | 387 | .long 0x00 @ unused |
9e8b5199 RK |
388 | .long PTE_EXT_TEX(1) @ L_PTE_MT_DEV_WC |
389 | .long 0x00 @ unused | |
40df2d1d RK |
390 | .long PTE_CACHEABLE | PTE_BUFFERABLE @ L_PTE_MT_DEV_CACHED |
391 | .long PTE_EXT_TEX(2) @ L_PTE_MT_DEV_NONSHARED | |
db5b7169 | 392 | .long 0x00 @ unused |
9e8b5199 RK |
393 | .long 0x00 @ unused |
394 | .long 0x00 @ unused | |
395 | ||
23bdf86a | 396 | .align 5 |
ad1ae2fe | 397 | ENTRY(cpu_xsc3_set_pte_ext) |
da091653 | 398 | xscale_set_pte_ext_prologue |
23bdf86a | 399 | |
da091653 | 400 | tst r1, #L_PTE_SHARED @ shared? |
9e8b5199 RK |
401 | and r1, r1, #L_PTE_MT_MASK |
402 | adr ip, cpu_xsc3_mt_table | |
403 | ldr ip, [ip, r1] | |
404 | orrne r2, r2, #PTE_EXT_COHERENT @ interlock: mask in coherent bit | |
405 | bic r2, r2, #0x0c @ clear old C,B bits | |
406 | orr r2, r2, ip | |
23bdf86a | 407 | |
da091653 | 408 | xscale_set_pte_ext_epilogue |
23bdf86a LB |
409 | mov pc, lr |
410 | ||
411 | .ltorg | |
23bdf86a LB |
412 | .align |
413 | ||
f6b0fa02 | 414 | .globl cpu_xsc3_suspend_size |
de8e71ca | 415 | .equ cpu_xsc3_suspend_size, 4 * 6 |
b6c7aabd | 416 | #ifdef CONFIG_ARM_CPU_SUSPEND |
f6b0fa02 | 417 | ENTRY(cpu_xsc3_do_suspend) |
de8e71ca | 418 | stmfd sp!, {r4 - r9, lr} |
f6b0fa02 RK |
419 | mrc p14, 0, r4, c6, c0, 0 @ clock configuration, for turbo mode |
420 | mrc p15, 0, r5, c15, c1, 0 @ CP access reg | |
421 | mrc p15, 0, r6, c13, c0, 0 @ PID | |
422 | mrc p15, 0, r7, c3, c0, 0 @ domain ID | |
de8e71ca RK |
423 | mrc p15, 0, r8, c1, c0, 1 @ auxiliary control reg |
424 | mrc p15, 0, r9, c1, c0, 0 @ control reg | |
f6b0fa02 | 425 | bic r4, r4, #2 @ clear frequency change bit |
de8e71ca RK |
426 | stmia r0, {r4 - r9} @ store cp regs |
427 | ldmia sp!, {r4 - r9, pc} | |
f6b0fa02 RK |
428 | ENDPROC(cpu_xsc3_do_suspend) |
429 | ||
430 | ENTRY(cpu_xsc3_do_resume) | |
de8e71ca | 431 | ldmia r0, {r4 - r9} @ load cp regs |
f6b0fa02 RK |
432 | mov ip, #0 |
433 | mcr p15, 0, ip, c7, c7, 0 @ invalidate I & D caches, BTB | |
434 | mcr p15, 0, ip, c7, c10, 4 @ drain write (&fill) buffer | |
435 | mcr p15, 0, ip, c7, c5, 4 @ flush prefetch buffer | |
436 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I & D TLBs | |
437 | mcr p14, 0, r4, c6, c0, 0 @ clock configuration, turbo mode. | |
438 | mcr p15, 0, r5, c15, c1, 0 @ CP access reg | |
439 | mcr p15, 0, r6, c13, c0, 0 @ PID | |
440 | mcr p15, 0, r7, c3, c0, 0 @ domain ID | |
de8e71ca RK |
441 | orr r1, r1, #0x18 @ cache the page table in L2 |
442 | mcr p15, 0, r1, c2, c0, 0 @ translation table base addr | |
443 | mcr p15, 0, r8, c1, c0, 1 @ auxiliary control reg | |
444 | mov r0, r9 @ control register | |
f6b0fa02 RK |
445 | b cpu_resume_mmu |
446 | ENDPROC(cpu_xsc3_do_resume) | |
f6b0fa02 RK |
447 | #endif |
448 | ||
5085f3ff | 449 | __CPUINIT |
23bdf86a LB |
450 | |
451 | .type __xsc3_setup, #function | |
452 | __xsc3_setup: | |
453 | mov r0, #PSR_F_BIT|PSR_I_BIT|SVC_MODE | |
454 | msr cpsr_c, r0 | |
850b4293 LB |
455 | mcr p15, 0, ip, c7, c7, 0 @ invalidate L1 caches and BTB |
456 | mcr p15, 0, ip, c7, c10, 4 @ data write barrier | |
457 | mcr p15, 0, ip, c7, c5, 4 @ prefetch flush | |
458 | mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs | |
23bdf86a | 459 | orr r4, r4, #0x18 @ cache the page table in L2 |
23bdf86a | 460 | mcr p15, 0, r4, c2, c0, 0 @ load page table pointer |
850b4293 | 461 | |
345a3229 | 462 | mov r0, #1 << 6 @ cp6 access for early sched_clock |
850b4293 LB |
463 | mcr p15, 0, r0, c15, c1, 0 @ write CP access register |
464 | ||
23bdf86a LB |
465 | mrc p15, 0, r0, c1, c0, 1 @ get auxiliary control reg |
466 | and r0, r0, #2 @ preserve bit P bit setting | |
23bdf86a | 467 | orr r0, r0, #(1 << 10) @ enable L2 for LLR cache |
23bdf86a | 468 | mcr p15, 0, r0, c1, c0, 1 @ set auxiliary control reg |
22b19086 RK |
469 | |
470 | adr r5, xsc3_crval | |
471 | ldmia r5, {r5, r6} | |
548c6af4 HZ |
472 | |
473 | #ifdef CONFIG_CACHE_XSC3L2 | |
474 | mrc p15, 1, r0, c0, c0, 1 @ get L2 present information | |
475 | ands r0, r0, #0xf8 | |
476 | orrne r6, r6, #(1 << 26) @ enable L2 if present | |
477 | #endif | |
478 | ||
23bdf86a | 479 | mrc p15, 0, r0, c1, c0, 0 @ get control register |
850b4293 LB |
480 | bic r0, r0, r5 @ ..V. ..R. .... ..A. |
481 | orr r0, r0, r6 @ ..VI Z..S .... .C.M (mmu) | |
482 | @ ...I Z..S .... .... (uc) | |
23bdf86a LB |
483 | mov pc, lr |
484 | ||
485 | .size __xsc3_setup, . - __xsc3_setup | |
486 | ||
22b19086 RK |
487 | .type xsc3_crval, #object |
488 | xsc3_crval: | |
850b4293 | 489 | crval clear=0x04002202, mmuset=0x00003905, ucset=0x00001900 |
22b19086 | 490 | |
23bdf86a LB |
491 | __INITDATA |
492 | ||
c21898f9 DM |
493 | @ define struct processor (see <asm/proc-fns.h> and proc-macros.S) |
494 | define_processor_functions xsc3, dabort=v5t_early_abort, pabort=legacy_pabort, suspend=1 | |
23bdf86a LB |
495 | |
496 | .section ".rodata" | |
497 | ||
c21898f9 DM |
498 | string cpu_arch_name, "armv5te" |
499 | string cpu_elf_name, "v5" | |
500 | string cpu_xsc3_name, "XScale-V3 based processor" | |
23bdf86a LB |
501 | |
502 | .align | |
503 | ||
504 | .section ".proc.info.init", #alloc, #execinstr | |
505 | ||
c21898f9 DM |
506 | .macro xsc3_proc_info name:req, cpu_val:req, cpu_mask:req |
507 | .type __\name\()_proc_info,#object | |
508 | __\name\()_proc_info: | |
509 | .long \cpu_val | |
510 | .long \cpu_mask | |
8799ee9f RK |
511 | .long PMD_TYPE_SECT | \ |
512 | PMD_SECT_BUFFERABLE | \ | |
513 | PMD_SECT_CACHEABLE | \ | |
514 | PMD_SECT_AP_WRITE | \ | |
515 | PMD_SECT_AP_READ | |
850b4293 | 516 | .long PMD_TYPE_SECT | \ |
8799ee9f RK |
517 | PMD_SECT_AP_WRITE | \ |
518 | PMD_SECT_AP_READ | |
23bdf86a LB |
519 | b __xsc3_setup |
520 | .long cpu_arch_name | |
521 | .long cpu_elf_name | |
522 | .long HWCAP_SWP|HWCAP_HALF|HWCAP_THUMB|HWCAP_FAST_MULT|HWCAP_EDSP | |
523 | .long cpu_xsc3_name | |
524 | .long xsc3_processor_functions | |
525 | .long v4wbi_tlb_fns | |
526 | .long xsc3_mc_user_fns | |
527 | .long xsc3_cache_fns | |
c21898f9 DM |
528 | .size __\name\()_proc_info, . - __\name\()_proc_info |
529 | .endm | |
59c7bcd4 | 530 | |
c21898f9 | 531 | xsc3_proc_info xsc3, 0x69056000, 0xffffe000 |
59c7bcd4 | 532 | |
c21898f9 DM |
533 | /* Note: PXA935 changed its implementor ID from Intel to Marvell */ |
534 | xsc3_proc_info xsc3_pxa935, 0x56056000, 0xffffe000 |