| blob | 596213699f37ac8a52d580ae70df8303bc344c94 |
1 /*
2 * linux/arch/arm/mm/proc-xsc3.S
3 *
4 * Original Author: Matthew Gilbert
5 * Current Maintainer: Lennert Buytenhek <buytenh@wantstofly.org>
6 *
7 * Copyright 2004 (C) Intel Corp.
8 * Copyright 2005 (C) MontaVista Software, Inc.
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 *
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
16 * features:
17 *
18 * - ARMv6 Supersections
19 * - Low Locality Reference pages (replaces mini-cache)
20 * - 36-bit addressing
21 * - L2 cache
22 * - Cache coherency if chipset supports it
23 *
24 * Based on original XScale code by Nicolas Pitre.
25 */
27 #include <linux/linkage.h>
28 #include <linux/init.h>
29 #include <asm/assembler.h>
30 #include <asm/hwcap.h>
31 #include <mach/hardware.h>
32 #include <asm/pgtable.h>
33 #include <asm/pgtable-hwdef.h>
34 #include <asm/page.h>
35 #include <asm/ptrace.h>
36 #include "proc-macros.S"
38 /*
39 * This is the maximum size of an area which will be flushed. If the
40 * area is larger than this, then we flush the whole cache.
41 */
42 #define MAX_AREA_SIZE 32768
44 /*
45 * The cache line size of the L1 I, L1 D and unified L2 cache.
46 */
47 #define CACHELINESIZE 32
49 /*
50 * The size of the L1 D cache.
51 */
52 #define CACHESIZE 32768
54 /*
55 * This macro is used to wait for a CP15 write and is needed when we
56 * have to ensure that the last operation to the coprocessor was
57 * completed before continuing with operation.
58 */
59 .macro cpwait_ret, lr, rd
60 mrc p15, 0, \rd, c2, c0, 0 @ arbitrary read of cp15
61 sub pc, \lr, \rd, LSR #32 @ wait for completion and
62 @ flush instruction pipeline
63 .endm
65 /*
66 * This macro cleans and invalidates the entire L1 D cache.
67 */
69 .macro clean_d_cache rd, rs
70 mov \rd, #0x1f00
71 orr \rd, \rd, #0x00e0
72 1: mcr p15, 0, \rd, c7, c14, 2 @ clean/invalidate L1 D line
73 adds \rd, \rd, #0x40000000
74 bcc 1b
75 subs \rd, \rd, #0x20
76 bpl 1b
77 .endm
79 .text
81 /*
82 * cpu_xsc3_proc_init()
83 *
84 * Nothing too exciting at the moment
85 */
86 ENTRY(cpu_xsc3_proc_init)
87 mov pc, lr
89 /*
90 * cpu_xsc3_proc_fin()
91 */
92 ENTRY(cpu_xsc3_proc_fin)
93 mrc p15, 0, r0, c1, c0, 0 @ ctrl register
94 bic r0, r0, #0x1800 @ ...IZ...........
95 bic r0, r0, #0x0006 @ .............CA.
96 mcr p15, 0, r0, c1, c0, 0 @ disable caches
97 mov pc, lr
99 /*
100 * cpu_xsc3_reset(loc)
101 *
102 * Perform a soft reset of the system. Put the CPU into the
103 * same state as it would be if it had been reset, and branch
104 * to what would be the reset vector.
105 *
106 * loc: location to jump to for soft reset
107 */
108 .align 5
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
113 bic r1, r1, #0x3900 @ ..VIZ..S........
114 bic r1, r1, #0x0086 @ ........B....CA.
115 mcr p15, 0, r1, c1, c0, 0 @ ctrl register
116 mcr p15, 0, ip, c7, c7, 0 @ invalidate L1 caches and BTB
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.
121 mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs
122 mov pc, r0
124 /*
125 * cpu_xsc3_do_idle()
126 *
127 * Cause the processor to idle
128 *
129 * For now we do nothing but go to idle mode for every case
130 *
131 * XScale supports clock switching, but using idle mode support
132 * allows external hardware to react to system state changes.
133 */
134 .align 5
136 ENTRY(cpu_xsc3_do_idle)
137 mov r0, #1
138 mcr p14, 0, r0, c7, c0, 0 @ go to idle
139 mov pc, lr
141 /* ================================= CACHE ================================ */
143 /*
144 * flush_icache_all()
145 *
146 * Unconditionally clean and invalidate the entire icache.
147 */
148 ENTRY(xsc3_flush_icache_all)
149 mov r0, #0
150 mcr p15, 0, r0, c7, c5, 0 @ invalidate I cache
151 mov pc, lr
152 ENDPROC(xsc3_flush_icache_all)
154 /*
155 * flush_user_cache_all()
156 *
157 * Invalidate all cache entries in a particular address
158 * space.
159 */
160 ENTRY(xsc3_flush_user_cache_all)
161 /* FALLTHROUGH */
163 /*
164 * flush_kern_cache_all()
165 *
166 * Clean and invalidate the entire cache.
167 */
168 ENTRY(xsc3_flush_kern_cache_all)
169 mov r2, #VM_EXEC
170 mov ip, #0
171 __flush_whole_cache:
172 clean_d_cache r0, r1
173 tst r2, #VM_EXEC
174 mcrne p15, 0, ip, c7, c5, 0 @ invalidate L1 I cache and BTB
175 mcrne p15, 0, ip, c7, c10, 4 @ data write barrier
176 mcrne p15, 0, ip, c7, c5, 4 @ prefetch flush
177 mov pc, lr
179 /*
180 * flush_user_cache_range(start, end, vm_flags)
181 *
182 * Invalidate a range of cache entries in the specified
183 * address space.
184 *
185 * - start - start address (may not be aligned)
186 * - end - end address (exclusive, may not be aligned)
187 * - vma - vma_area_struct describing address space
188 */
189 .align 5
190 ENTRY(xsc3_flush_user_cache_range)
191 mov ip, #0
192 sub r3, r1, r0 @ calculate total size
193 cmp r3, #MAX_AREA_SIZE
194 bhs __flush_whole_cache
196 1: tst r2, #VM_EXEC
197 mcrne p15, 0, r0, c7, c5, 1 @ invalidate L1 I line
198 mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line
199 add r0, r0, #CACHELINESIZE
200 cmp r0, r1
201 blo 1b
202 tst r2, #VM_EXEC
203 mcrne p15, 0, ip, c7, c5, 6 @ invalidate BTB
204 mcrne p15, 0, ip, c7, c10, 4 @ data write barrier
205 mcrne p15, 0, ip, c7, c5, 4 @ prefetch flush
206 mov pc, lr
208 /*
209 * coherent_kern_range(start, end)
210 *
211 * Ensure coherency between the I cache and the D cache in the
212 * region described by start. If you have non-snooping
213 * Harvard caches, you need to implement this function.
214 *
215 * - start - virtual start address
216 * - end - virtual end address
217 *
218 * Note: single I-cache line invalidation isn't used here since
219 * it also trashes the mini I-cache used by JTAG debuggers.
220 */
221 ENTRY(xsc3_coherent_kern_range)
222 /* FALLTHROUGH */
223 ENTRY(xsc3_coherent_user_range)
224 bic r0, r0, #CACHELINESIZE - 1
225 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line
226 add r0, r0, #CACHELINESIZE
227 cmp r0, r1
228 blo 1b
229 mov r0, #0
230 mcr p15, 0, r0, c7, c5, 0 @ invalidate L1 I cache and BTB
231 mcr p15, 0, r0, c7, c10, 4 @ data write barrier
232 mcr p15, 0, r0, c7, c5, 4 @ prefetch flush
233 mov pc, lr
235 /*
236 * flush_kern_dcache_area(void *addr, size_t size)
237 *
238 * Ensure no D cache aliasing occurs, either with itself or
239 * the I cache.
240 *
241 * - addr - kernel address
242 * - size - region size
243 */
244 ENTRY(xsc3_flush_kern_dcache_area)
245 add r1, r0, r1
246 1: mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line
247 add r0, r0, #CACHELINESIZE
248 cmp r0, r1
249 blo 1b
250 mov r0, #0
251 mcr p15, 0, r0, c7, c5, 0 @ invalidate L1 I cache and BTB
252 mcr p15, 0, r0, c7, c10, 4 @ data write barrier
253 mcr p15, 0, r0, c7, c5, 4 @ prefetch flush
254 mov pc, lr
256 /*
257 * dma_inv_range(start, end)
258 *
259 * Invalidate (discard) the specified virtual address range.
260 * May not write back any entries. If 'start' or 'end'
261 * are not cache line aligned, those lines must be written
262 * back.
263 *
264 * - start - virtual start address
265 * - end - virtual end address
266 */
267 xsc3_dma_inv_range:
268 tst r0, #CACHELINESIZE - 1
269 bic r0, r0, #CACHELINESIZE - 1
270 mcrne p15, 0, r0, c7, c10, 1 @ clean L1 D line
271 tst r1, #CACHELINESIZE - 1
272 mcrne p15, 0, r1, c7, c10, 1 @ clean L1 D line
273 1: mcr p15, 0, r0, c7, c6, 1 @ invalidate L1 D line
274 add r0, r0, #CACHELINESIZE
275 cmp r0, r1
276 blo 1b
277 mcr p15, 0, r0, c7, c10, 4 @ data write barrier
278 mov pc, lr
280 /*
281 * dma_clean_range(start, end)
282 *
283 * Clean the specified virtual address range.
284 *
285 * - start - virtual start address
286 * - end - virtual end address
287 */
288 xsc3_dma_clean_range:
289 bic r0, r0, #CACHELINESIZE - 1
290 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line
291 add r0, r0, #CACHELINESIZE
292 cmp r0, r1
293 blo 1b
294 mcr p15, 0, r0, c7, c10, 4 @ data write barrier
295 mov pc, lr
297 /*
298 * dma_flush_range(start, end)
299 *
300 * Clean and invalidate the specified virtual address range.
301 *
302 * - start - virtual start address
303 * - end - virtual end address
304 */
305 ENTRY(xsc3_dma_flush_range)
306 bic r0, r0, #CACHELINESIZE - 1
307 1: mcr p15, 0, r0, c7, c14, 1 @ clean/invalidate L1 D line
308 add r0, r0, #CACHELINESIZE
309 cmp r0, r1
310 blo 1b
311 mcr p15, 0, r0, c7, c10, 4 @ data write barrier
312 mov pc, lr
314 /*
315 * dma_map_area(start, size, dir)
316 * - start - kernel virtual start address
317 * - size - size of region
318 * - dir - DMA direction
319 */
320 ENTRY(xsc3_dma_map_area)
321 add r1, r1, r0
322 cmp r2, #DMA_TO_DEVICE
323 beq xsc3_dma_clean_range
324 bcs xsc3_dma_inv_range
325 b xsc3_dma_flush_range
326 ENDPROC(xsc3_dma_map_area)
328 /*
329 * dma_unmap_area(start, size, dir)
330 * - start - kernel virtual start address
331 * - size - size of region
332 * - dir - DMA direction
333 */
334 ENTRY(xsc3_dma_unmap_area)
335 mov pc, lr
336 ENDPROC(xsc3_dma_unmap_area)
338 ENTRY(xsc3_cache_fns)
339 .long xsc3_flush_icache_all
340 .long xsc3_flush_kern_cache_all
341 .long xsc3_flush_user_cache_all
342 .long xsc3_flush_user_cache_range
343 .long xsc3_coherent_kern_range
344 .long xsc3_coherent_user_range
345 .long xsc3_flush_kern_dcache_area
346 .long xsc3_dma_map_area
347 .long xsc3_dma_unmap_area
348 .long xsc3_dma_flush_range
350 ENTRY(cpu_xsc3_dcache_clean_area)
351 1: mcr p15, 0, r0, c7, c10, 1 @ clean L1 D line
352 add r0, r0, #CACHELINESIZE
353 subs r1, r1, #CACHELINESIZE
354 bhi 1b
355 mov pc, lr
357 /* =============================== PageTable ============================== */
359 /*
360 * cpu_xsc3_switch_mm(pgd)
361 *
362 * Set the translation base pointer to be as described by pgd.
363 *
364 * pgd: new page tables
365 */
366 .align 5
367 ENTRY(cpu_xsc3_switch_mm)
368 clean_d_cache r1, r2
369 mcr p15, 0, ip, c7, c5, 0 @ invalidate L1 I cache and BTB
370 mcr p15, 0, ip, c7, c10, 4 @ data write barrier
371 mcr p15, 0, ip, c7, c5, 4 @ prefetch flush
372 orr r0, r0, #0x18 @ cache the page table in L2
373 mcr p15, 0, r0, c2, c0, 0 @ load page table pointer
374 mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs
375 cpwait_ret lr, ip
377 /*
378 * cpu_xsc3_set_pte_ext(ptep, pte, ext)
379 *
380 * Set a PTE and flush it out
381 */
382 cpu_xsc3_mt_table:
383 .long 0x00 @ L_PTE_MT_UNCACHED
384 .long PTE_EXT_TEX(1) @ L_PTE_MT_BUFFERABLE
385 .long PTE_EXT_TEX(5) | PTE_CACHEABLE @ L_PTE_MT_WRITETHROUGH
386 .long PTE_CACHEABLE | PTE_BUFFERABLE @ L_PTE_MT_WRITEBACK
387 .long PTE_EXT_TEX(1) | PTE_BUFFERABLE @ L_PTE_MT_DEV_SHARED
388 .long 0x00 @ unused
389 .long 0x00 @ L_PTE_MT_MINICACHE (not present)
390 .long PTE_EXT_TEX(5) | PTE_CACHEABLE | PTE_BUFFERABLE @ L_PTE_MT_WRITEALLOC (not present?)
391 .long 0x00 @ unused
392 .long PTE_EXT_TEX(1) @ L_PTE_MT_DEV_WC
393 .long 0x00 @ unused
394 .long PTE_CACHEABLE | PTE_BUFFERABLE @ L_PTE_MT_DEV_CACHED
395 .long PTE_EXT_TEX(2) @ L_PTE_MT_DEV_NONSHARED
396 .long 0x00 @ unused
397 .long 0x00 @ unused
398 .long 0x00 @ unused
400 .align 5
401 ENTRY(cpu_xsc3_set_pte_ext)
402 xscale_set_pte_ext_prologue
404 tst r1, #L_PTE_SHARED @ shared?
405 and r1, r1, #L_PTE_MT_MASK
406 adr ip, cpu_xsc3_mt_table
407 ldr ip, [ip, r1]
408 orrne r2, r2, #PTE_EXT_COHERENT @ interlock: mask in coherent bit
409 bic r2, r2, #0x0c @ clear old C,B bits
410 orr r2, r2, ip
412 xscale_set_pte_ext_epilogue
413 mov pc, lr
415 .ltorg
416 .align
418 .globl cpu_xsc3_suspend_size
419 .equ cpu_xsc3_suspend_size, 4 * 8
420 #ifdef CONFIG_PM_SLEEP
421 ENTRY(cpu_xsc3_do_suspend)
422 stmfd sp!, {r4 - r10, lr}
423 mrc p14, 0, r4, c6, c0, 0 @ clock configuration, for turbo mode
424 mrc p15, 0, r5, c15, c1, 0 @ CP access reg
425 mrc p15, 0, r6, c13, c0, 0 @ PID
426 mrc p15, 0, r7, c3, c0, 0 @ domain ID
427 mrc p15, 0, r8, c2, c0, 0 @ translation table base addr
428 mrc p15, 0, r9, c1, c0, 1 @ auxiliary control reg
429 mrc p15, 0, r10, c1, c0, 0 @ control reg
430 bic r4, r4, #2 @ clear frequency change bit
431 stmia r0, {r1, r4 - r10} @ store v:p offset + cp regs
432 ldmia sp!, {r4 - r10, pc}
433 ENDPROC(cpu_xsc3_do_suspend)
435 ENTRY(cpu_xsc3_do_resume)
436 ldmia r0, {r1, r4 - r10} @ load v:p offset + cp regs
437 mov ip, #0
438 mcr p15, 0, ip, c7, c7, 0 @ invalidate I & D caches, BTB
439 mcr p15, 0, ip, c7, c10, 4 @ drain write (&fill) buffer
440 mcr p15, 0, ip, c7, c5, 4 @ flush prefetch buffer
441 mcr p15, 0, ip, c8, c7, 0 @ invalidate I & D TLBs
442 mcr p14, 0, r4, c6, c0, 0 @ clock configuration, turbo mode.
443 mcr p15, 0, r5, c15, c1, 0 @ CP access reg
444 mcr p15, 0, r6, c13, c0, 0 @ PID
445 mcr p15, 0, r7, c3, c0, 0 @ domain ID
446 mcr p15, 0, r8, c2, c0, 0 @ translation table base addr
447 mcr p15, 0, r9, c1, c0, 1 @ auxiliary control reg
449 @ temporarily map resume_turn_on_mmu into the page table,
450 @ otherwise prefetch abort occurs after MMU is turned on
451 mov r0, r10 @ control register
452 mov r2, r8, lsr #14 @ get TTB0 base
453 mov r2, r2, lsl #14
454 ldr r3, =0x542e @ section flags
455 b cpu_resume_mmu
456 ENDPROC(cpu_xsc3_do_resume)
457 #else
458 #define cpu_xsc3_do_suspend 0
459 #define cpu_xsc3_do_resume 0
460 #endif
462 __CPUINIT
464 .type __xsc3_setup, #function
465 __xsc3_setup:
466 mov r0, #PSR_F_BIT|PSR_I_BIT|SVC_MODE
467 msr cpsr_c, r0
468 mcr p15, 0, ip, c7, c7, 0 @ invalidate L1 caches and BTB
469 mcr p15, 0, ip, c7, c10, 4 @ data write barrier
470 mcr p15, 0, ip, c7, c5, 4 @ prefetch flush
471 mcr p15, 0, ip, c8, c7, 0 @ invalidate I and D TLBs
472 orr r4, r4, #0x18 @ cache the page table in L2
473 mcr p15, 0, r4, c2, c0, 0 @ load page table pointer
475 mov r0, #1 << 6 @ cp6 access for early sched_clock
476 mcr p15, 0, r0, c15, c1, 0 @ write CP access register
478 mrc p15, 0, r0, c1, c0, 1 @ get auxiliary control reg
479 and r0, r0, #2 @ preserve bit P bit setting
480 orr r0, r0, #(1 << 10) @ enable L2 for LLR cache
481 mcr p15, 0, r0, c1, c0, 1 @ set auxiliary control reg
483 adr r5, xsc3_crval
484 ldmia r5, {r5, r6}
486 #ifdef CONFIG_CACHE_XSC3L2
487 mrc p15, 1, r0, c0, c0, 1 @ get L2 present information
488 ands r0, r0, #0xf8
489 orrne r6, r6, #(1 << 26) @ enable L2 if present
490 #endif
492 mrc p15, 0, r0, c1, c0, 0 @ get control register
493 bic r0, r0, r5 @ ..V. ..R. .... ..A.
494 orr r0, r0, r6 @ ..VI Z..S .... .C.M (mmu)
495 @ ...I Z..S .... .... (uc)
496 mov pc, lr
498 .size __xsc3_setup, . - __xsc3_setup
500 .type xsc3_crval, #object
501 xsc3_crval:
502 crval clear=0x04002202, mmuset=0x00003905, ucset=0x00001900
504 __INITDATA
506 /*
507 * Purpose : Function pointers used to access above functions - all calls
508 * come through these
509 */
511 .type xsc3_processor_functions, #object
512 ENTRY(xsc3_processor_functions)
513 .word v5t_early_abort
514 .word legacy_pabort
515 .word cpu_xsc3_proc_init
516 .word cpu_xsc3_proc_fin
517 .word cpu_xsc3_reset
518 .word cpu_xsc3_do_idle
519 .word cpu_xsc3_dcache_clean_area
520 .word cpu_xsc3_switch_mm
521 .word cpu_xsc3_set_pte_ext
522 .word cpu_xsc3_suspend_size
523 .word cpu_xsc3_do_suspend
524 .word cpu_xsc3_do_resume
525 .size xsc3_processor_functions, . - xsc3_processor_functions
527 .section ".rodata"
529 .type cpu_arch_name, #object
530 cpu_arch_name:
531 .asciz "armv5te"
532 .size cpu_arch_name, . - cpu_arch_name
534 .type cpu_elf_name, #object
535 cpu_elf_name:
536 .asciz "v5"
537 .size cpu_elf_name, . - cpu_elf_name
539 .type cpu_xsc3_name, #object
540 cpu_xsc3_name:
541 .asciz "XScale-V3 based processor"
542 .size cpu_xsc3_name, . - cpu_xsc3_name
544 .align
546 .section ".proc.info.init", #alloc, #execinstr
548 .type __xsc3_proc_info,#object
549 __xsc3_proc_info:
550 .long 0x69056000
551 .long 0xffffe000
552 .long PMD_TYPE_SECT | \
553 PMD_SECT_BUFFERABLE | \
554 PMD_SECT_CACHEABLE | \
555 PMD_SECT_AP_WRITE | \
556 PMD_SECT_AP_READ
557 .long PMD_TYPE_SECT | \
558 PMD_SECT_AP_WRITE | \
559 PMD_SECT_AP_READ
560 b __xsc3_setup
561 .long cpu_arch_name
562 .long cpu_elf_name
563 .long HWCAP_SWP|HWCAP_HALF|HWCAP_THUMB|HWCAP_FAST_MULT|HWCAP_EDSP
564 .long cpu_xsc3_name
565 .long xsc3_processor_functions
566 .long v4wbi_tlb_fns
567 .long xsc3_mc_user_fns
568 .long xsc3_cache_fns
569 .size __xsc3_proc_info, . - __xsc3_proc_info
571 /* Note: PXA935 changed its implementor ID from Intel to Marvell */
573 .type __xsc3_pxa935_proc_info,#object
574 __xsc3_pxa935_proc_info:
575 .long 0x56056000
576 .long 0xffffe000
577 .long PMD_TYPE_SECT | \
578 PMD_SECT_BUFFERABLE | \
579 PMD_SECT_CACHEABLE | \
580 PMD_SECT_AP_WRITE | \
581 PMD_SECT_AP_READ
582 .long PMD_TYPE_SECT | \
583 PMD_SECT_AP_WRITE | \
584 PMD_SECT_AP_READ
585 b __xsc3_setup
586 .long cpu_arch_name
587 .long cpu_elf_name
588 .long HWCAP_SWP|HWCAP_HALF|HWCAP_THUMB|HWCAP_FAST_MULT|HWCAP_EDSP
589 .long cpu_xsc3_name
590 .long xsc3_processor_functions
591 .long v4wbi_tlb_fns
592 .long xsc3_mc_user_fns
593 .long xsc3_cache_fns
594 .size __xsc3_pxa935_proc_info, . - __xsc3_pxa935_proc_info