|  | /* | 
|  | *  linux/arch/arm/mm/proc-arm6,7.S | 
|  | * | 
|  | *  Copyright (C) 1997-2000 Russell King | 
|  | *  hacked for non-paged-MM by Hyok S. Choi, 2003. | 
|  | * | 
|  | * This program is free software; you can redistribute it and/or modify | 
|  | * it under the terms of the GNU General Public License version 2 as | 
|  | * published by the Free Software Foundation. | 
|  | * | 
|  | *  These are the low level assembler for performing cache and TLB | 
|  | *  functions on the ARM610 & ARM710. | 
|  | */ | 
|  | #include <linux/linkage.h> | 
|  | #include <linux/init.h> | 
|  | #include <asm/assembler.h> | 
|  | #include <asm/asm-offsets.h> | 
|  | #include <asm/hwcap.h> | 
|  | #include <asm/pgtable-hwdef.h> | 
|  | #include <asm/pgtable.h> | 
|  | #include <asm/ptrace.h> | 
|  |  | 
|  | #include "proc-macros.S" | 
|  |  | 
|  | ENTRY(cpu_arm6_dcache_clean_area) | 
|  | ENTRY(cpu_arm7_dcache_clean_area) | 
|  | mov	pc, lr | 
|  |  | 
|  | /* | 
|  | * Function: arm6_7_data_abort () | 
|  | * | 
|  | * Params  : r2 = pt_regs | 
|  | *	   : r4 = aborted context pc | 
|  | *	   : r5 = aborted context psr | 
|  | * | 
|  | * Purpose : obtain information about current aborted instruction | 
|  | * | 
|  | * Returns : r4-r5, r10-r11, r13 preserved | 
|  | */ | 
|  |  | 
|  | ENTRY(cpu_arm7_data_abort) | 
|  | mrc	p15, 0, r1, c5, c0, 0		@ get FSR | 
|  | mrc	p15, 0, r0, c6, c0, 0		@ get FAR | 
|  | ldr	r8, [r4]			@ read arm instruction | 
|  | tst	r8, #1 << 20			@ L = 0 -> write? | 
|  | orreq	r1, r1, #1 << 11		@ yes. | 
|  | and	r7, r8, #15 << 24 | 
|  | add	pc, pc, r7, lsr #22		@ Now branch to the relevant processing routine | 
|  | nop | 
|  |  | 
|  | /* 0 */	b	.data_unknown | 
|  | /* 1 */	b	do_DataAbort			@ swp | 
|  | /* 2 */	b	.data_unknown | 
|  | /* 3 */	b	.data_unknown | 
|  | /* 4 */	b	.data_arm_lateldrpostconst	@ ldr	rd, [rn], #m | 
|  | /* 5 */	b	.data_arm_lateldrpreconst	@ ldr	rd, [rn, #m] | 
|  | /* 6 */	b	.data_arm_lateldrpostreg	@ ldr	rd, [rn], rm | 
|  | /* 7 */	b	.data_arm_lateldrprereg		@ ldr	rd, [rn, rm] | 
|  | /* 8 */	b	.data_arm_ldmstm		@ ldm*a	rn, <rlist> | 
|  | /* 9 */	b	.data_arm_ldmstm		@ ldm*b	rn, <rlist> | 
|  | /* a */	b	.data_unknown | 
|  | /* b */	b	.data_unknown | 
|  | /* c */	b	do_DataAbort			@ ldc	rd, [rn], #m	@ Same as ldr	rd, [rn], #m | 
|  | /* d */	b	do_DataAbort			@ ldc	rd, [rn, #m] | 
|  | /* e */	b	.data_unknown | 
|  | /* f */ | 
|  | .data_unknown:	@ Part of jumptable | 
|  | mov	r0, r4 | 
|  | mov	r1, r8 | 
|  | b	baddataabort | 
|  |  | 
|  | ENTRY(cpu_arm6_data_abort) | 
|  | mrc	p15, 0, r1, c5, c0, 0		@ get FSR | 
|  | mrc	p15, 0, r0, c6, c0, 0		@ get FAR | 
|  | ldr	r8, [r4]			@ read arm instruction | 
|  | tst	r8, #1 << 20			@ L = 0 -> write? | 
|  | orreq	r1, r1, #1 << 11		@ yes. | 
|  | and	r7, r8, #14 << 24 | 
|  | teq	r7, #8 << 24			@ was it ldm/stm | 
|  | bne	do_DataAbort | 
|  |  | 
|  | .data_arm_ldmstm: | 
|  | tst	r8, #1 << 21			@ check writeback bit | 
|  | beq	do_DataAbort			@ no writeback -> no fixup | 
|  | mov	r7, #0x11 | 
|  | orr	r7, r7, #0x1100 | 
|  | and	r6, r8, r7 | 
|  | and	r9, r8, r7, lsl #1 | 
|  | add	r6, r6, r9, lsr #1 | 
|  | and	r9, r8, r7, lsl #2 | 
|  | add	r6, r6, r9, lsr #2 | 
|  | and	r9, r8, r7, lsl #3 | 
|  | add	r6, r6, r9, lsr #3 | 
|  | add	r6, r6, r6, lsr #8 | 
|  | add	r6, r6, r6, lsr #4 | 
|  | and	r6, r6, #15			@ r6 = no. of registers to transfer. | 
|  | and	r9, r8, #15 << 16		@ Extract 'n' from instruction | 
|  | ldr	r7, [r2, r9, lsr #14]		@ Get register 'Rn' | 
|  | tst	r8, #1 << 23			@ Check U bit | 
|  | subne	r7, r7, r6, lsl #2		@ Undo increment | 
|  | addeq	r7, r7, r6, lsl #2		@ Undo decrement | 
|  | str	r7, [r2, r9, lsr #14]		@ Put register 'Rn' | 
|  | b	do_DataAbort | 
|  |  | 
|  | .data_arm_apply_r6_and_rn: | 
|  | and	r9, r8, #15 << 16		@ Extract 'n' from instruction | 
|  | ldr	r7, [r2, r9, lsr #14]		@ Get register 'Rn' | 
|  | tst	r8, #1 << 23			@ Check U bit | 
|  | subne	r7, r7, r6			@ Undo incrmenet | 
|  | addeq	r7, r7, r6			@ Undo decrement | 
|  | str	r7, [r2, r9, lsr #14]		@ Put register 'Rn' | 
|  | b	do_DataAbort | 
|  |  | 
|  | .data_arm_lateldrpreconst: | 
|  | tst	r8, #1 << 21			@ check writeback bit | 
|  | beq	do_DataAbort			@ no writeback -> no fixup | 
|  | .data_arm_lateldrpostconst: | 
|  | movs	r6, r8, lsl #20			@ Get offset | 
|  | beq	do_DataAbort			@ zero -> no fixup | 
|  | and	r9, r8, #15 << 16		@ Extract 'n' from instruction | 
|  | ldr	r7, [r2, r9, lsr #14]		@ Get register 'Rn' | 
|  | tst	r8, #1 << 23			@ Check U bit | 
|  | subne	r7, r7, r6, lsr #20		@ Undo increment | 
|  | addeq	r7, r7, r6, lsr #20		@ Undo decrement | 
|  | str	r7, [r2, r9, lsr #14]		@ Put register 'Rn' | 
|  | b	do_DataAbort | 
|  |  | 
|  | .data_arm_lateldrprereg: | 
|  | tst	r8, #1 << 21			@ check writeback bit | 
|  | beq	do_DataAbort			@ no writeback -> no fixup | 
|  | .data_arm_lateldrpostreg: | 
|  | and	r7, r8, #15			@ Extract 'm' from instruction | 
|  | ldr	r6, [r2, r7, lsl #2]		@ Get register 'Rm' | 
|  | mov	r9, r8, lsr #7			@ get shift count | 
|  | ands	r9, r9, #31 | 
|  | and	r7, r8, #0x70			@ get shift type | 
|  | orreq	r7, r7, #8			@ shift count = 0 | 
|  | add	pc, pc, r7 | 
|  | nop | 
|  |  | 
|  | mov	r6, r6, lsl r9			@ 0: LSL #!0 | 
|  | b	.data_arm_apply_r6_and_rn | 
|  | b	.data_arm_apply_r6_and_rn	@ 1: LSL #0 | 
|  | nop | 
|  | b	.data_unknown			@ 2: MUL? | 
|  | nop | 
|  | b	.data_unknown			@ 3: MUL? | 
|  | nop | 
|  | mov	r6, r6, lsr r9			@ 4: LSR #!0 | 
|  | b	.data_arm_apply_r6_and_rn | 
|  | mov	r6, r6, lsr #32			@ 5: LSR #32 | 
|  | b	.data_arm_apply_r6_and_rn | 
|  | b	.data_unknown			@ 6: MUL? | 
|  | nop | 
|  | b	.data_unknown			@ 7: MUL? | 
|  | nop | 
|  | mov	r6, r6, asr r9			@ 8: ASR #!0 | 
|  | b	.data_arm_apply_r6_and_rn | 
|  | mov	r6, r6, asr #32			@ 9: ASR #32 | 
|  | b	.data_arm_apply_r6_and_rn | 
|  | b	.data_unknown			@ A: MUL? | 
|  | nop | 
|  | b	.data_unknown			@ B: MUL? | 
|  | nop | 
|  | mov	r6, r6, ror r9			@ C: ROR #!0 | 
|  | b	.data_arm_apply_r6_and_rn | 
|  | mov	r6, r6, rrx			@ D: RRX | 
|  | b	.data_arm_apply_r6_and_rn | 
|  | b	.data_unknown			@ E: MUL? | 
|  | nop | 
|  | b	.data_unknown			@ F: MUL? | 
|  |  | 
|  | /* | 
|  | * Function: arm6_7_proc_init (void) | 
|  | *	   : arm6_7_proc_fin (void) | 
|  | * | 
|  | * Notes   : This processor does not require these | 
|  | */ | 
|  | ENTRY(cpu_arm6_proc_init) | 
|  | ENTRY(cpu_arm7_proc_init) | 
|  | mov	pc, lr | 
|  |  | 
|  | ENTRY(cpu_arm6_proc_fin) | 
|  | ENTRY(cpu_arm7_proc_fin) | 
|  | mov	r0, #0x31			@ ....S..DP...M | 
|  | mcr	p15, 0, r0, c1, c0, 0		@ disable caches | 
|  | mov	pc, lr | 
|  |  | 
|  | ENTRY(cpu_arm6_do_idle) | 
|  | ENTRY(cpu_arm7_do_idle) | 
|  | mov	pc, lr | 
|  |  | 
|  | /* | 
|  | * Function: arm6_7_switch_mm(unsigned long pgd_phys) | 
|  | * Params  : pgd_phys	Physical address of page table | 
|  | * Purpose : Perform a task switch, saving the old processes state, and restoring | 
|  | *	     the new. | 
|  | */ | 
|  | ENTRY(cpu_arm6_switch_mm) | 
|  | ENTRY(cpu_arm7_switch_mm) | 
|  | #ifdef CONFIG_MMU | 
|  | mov	r1, #0 | 
|  | mcr	p15, 0, r1, c7, c0, 0		@ flush cache | 
|  | mcr	p15, 0, r0, c2, c0, 0		@ update page table ptr | 
|  | mcr	p15, 0, r1, c5, c0, 0		@ flush TLBs | 
|  | #endif | 
|  | mov	pc, lr | 
|  |  | 
|  | /* | 
|  | * Function: arm6_7_set_pte_ext(pte_t *ptep, pte_t pte, unsigned int ext) | 
|  | * Params  : r0 = Address to set | 
|  | *	   : r1 = value to set | 
|  | * Purpose : Set a PTE and flush it out of any WB cache | 
|  | */ | 
|  | .align	5 | 
|  | ENTRY(cpu_arm6_set_pte_ext) | 
|  | ENTRY(cpu_arm7_set_pte_ext) | 
|  | #ifdef CONFIG_MMU | 
|  | armv3_set_pte_ext wc_disable=0 | 
|  | #endif /* CONFIG_MMU */ | 
|  | mov	pc, lr | 
|  |  | 
|  | /* | 
|  | * Function: _arm6_7_reset | 
|  | * Params  : r0 = address to jump to | 
|  | * Notes   : This sets up everything for a reset | 
|  | */ | 
|  | .pushsection	.idmap.text, "ax" | 
|  | ENTRY(cpu_arm6_reset) | 
|  | ENTRY(cpu_arm7_reset) | 
|  | mov	r1, #0 | 
|  | mcr	p15, 0, r1, c7, c0, 0		@ flush cache | 
|  | #ifdef CONFIG_MMU | 
|  | mcr	p15, 0, r1, c5, c0, 0		@ flush TLB | 
|  | #endif | 
|  | mov	r1, #0x30 | 
|  | mcr	p15, 0, r1, c1, c0, 0		@ turn off MMU etc | 
|  | mov	pc, r0 | 
|  | ENDPROC(cpu_arm6_reset) | 
|  | ENDPROC(cpu_arm7_reset) | 
|  | .popsection | 
|  |  | 
|  | __CPUINIT | 
|  |  | 
|  | .type	__arm6_setup, #function | 
|  | __arm6_setup:	mov	r0, #0 | 
|  | mcr	p15, 0, r0, c7, c0		@ flush caches on v3 | 
|  | #ifdef CONFIG_MMU | 
|  | mcr	p15, 0, r0, c5, c0		@ flush TLBs on v3 | 
|  | mov	r0, #0x3d			@ . ..RS BLDP WCAM | 
|  | orr	r0, r0, #0x100			@ . ..01 0011 1101 | 
|  | #else | 
|  | mov	r0, #0x3c			@ . ..RS BLDP WCA. | 
|  | #endif | 
|  | mov	pc, lr | 
|  | .size	__arm6_setup, . - __arm6_setup | 
|  |  | 
|  | .type	__arm7_setup, #function | 
|  | __arm7_setup:	mov	r0, #0 | 
|  | mcr	p15, 0, r0, c7, c0		@ flush caches on v3 | 
|  | #ifdef CONFIG_MMU | 
|  | mcr	p15, 0, r0, c5, c0		@ flush TLBs on v3 | 
|  | mcr	p15, 0, r0, c3, c0		@ load domain access register | 
|  | mov	r0, #0x7d			@ . ..RS BLDP WCAM | 
|  | orr	r0, r0, #0x100			@ . ..01 0111 1101 | 
|  | #else | 
|  | mov	r0, #0x7c			@ . ..RS BLDP WCA. | 
|  | #endif | 
|  | mov	pc, lr | 
|  | .size	__arm7_setup, . - __arm7_setup | 
|  |  | 
|  | __INITDATA | 
|  |  | 
|  | @ define struct processor (see <asm/proc-fns.h> and proc-macros.S) | 
|  | define_processor_functions arm6, dabort=cpu_arm6_data_abort, pabort=legacy_pabort | 
|  | define_processor_functions arm7, dabort=cpu_arm7_data_abort, pabort=legacy_pabort | 
|  |  | 
|  | .section ".rodata" | 
|  |  | 
|  | string	cpu_arch_name, "armv3" | 
|  | string	cpu_elf_name, "v3" | 
|  | string	cpu_arm6_name, "ARM6" | 
|  | string	cpu_arm610_name, "ARM610" | 
|  | string	cpu_arm7_name, "ARM7" | 
|  | string	cpu_arm710_name, "ARM710" | 
|  |  | 
|  | .align | 
|  |  | 
|  | .section ".proc.info.init", #alloc, #execinstr | 
|  |  | 
|  | .macro arm67_proc_info name:req, cpu_val:req, cpu_mask:req, cpu_name:req, \ | 
|  | cpu_mm_mmu_flags:req, cpu_flush:req, cpu_proc_funcs:req | 
|  | .type	__\name\()_proc_info, #object | 
|  | __\name\()_proc_info: | 
|  | .long	\cpu_val | 
|  | .long	\cpu_mask | 
|  | .long	\cpu_mm_mmu_flags | 
|  | .long   PMD_TYPE_SECT | \ | 
|  | PMD_BIT4 | \ | 
|  | PMD_SECT_AP_WRITE | \ | 
|  | PMD_SECT_AP_READ | 
|  | b	\cpu_flush | 
|  | .long	cpu_arch_name | 
|  | .long	cpu_elf_name | 
|  | .long	HWCAP_SWP | HWCAP_26BIT | 
|  | .long	\cpu_name | 
|  | .long	\cpu_proc_funcs | 
|  | .long	v3_tlb_fns | 
|  | .long	v3_user_fns | 
|  | .long	v3_cache_fns | 
|  | .size	__\name\()_proc_info, . - __\name\()_proc_info | 
|  | .endm | 
|  |  | 
|  | arm67_proc_info	arm6,	0x41560600, 0xfffffff0, cpu_arm6_name, \ | 
|  | 0x00000c1e, __arm6_setup, arm6_processor_functions | 
|  | arm67_proc_info	arm610,	0x41560610, 0xfffffff0, cpu_arm610_name, \ | 
|  | 0x00000c1e, __arm6_setup, arm6_processor_functions | 
|  | arm67_proc_info	arm7,	0x41007000, 0xffffff00, cpu_arm7_name, \ | 
|  | 0x00000c1e, __arm7_setup, arm7_processor_functions | 
|  | arm67_proc_info	arm710,	0x41007100, 0xfff8ff00, cpu_arm710_name, \ | 
|  | PMD_TYPE_SECT | \ | 
|  | PMD_SECT_BUFFERABLE | \ | 
|  | PMD_SECT_CACHEABLE | \ | 
|  | PMD_BIT4 | \ | 
|  | PMD_SECT_AP_WRITE | \ | 
|  | PMD_SECT_AP_READ, \ | 
|  | __arm7_setup, arm7_processor_functions |