| /* SPDX-License-Identifier: GPL-2.0 */ | 
 | /* | 
 |  * We need constants.h for: | 
 |  *  VMA_VM_MM | 
 |  *  VMA_VM_FLAGS | 
 |  *  VM_EXEC | 
 |  */ | 
 | #include <asm/asm-offsets.h> | 
 | #include <asm/thread_info.h> | 
 |  | 
 | #ifdef CONFIG_CPU_V7M | 
 | #include <asm/v7m.h> | 
 | #endif | 
 |  | 
 | /* | 
 |  * vma_vm_mm - get mm pointer from vma pointer (vma->vm_mm) | 
 |  */ | 
 | 	.macro	vma_vm_mm, rd, rn | 
 | 	ldr	\rd, [\rn, #VMA_VM_MM] | 
 | 	.endm | 
 |  | 
 | /* | 
 |  * vma_vm_flags - get vma->vm_flags | 
 |  */ | 
 | 	.macro	vma_vm_flags, rd, rn | 
 | 	ldr	\rd, [\rn, #VMA_VM_FLAGS] | 
 | 	.endm | 
 |  | 
 | /* | 
 |  * act_mm - get current->active_mm | 
 |  */ | 
 | 	.macro	act_mm, rd | 
 | 	bic	\rd, sp, #8128 | 
 | 	bic	\rd, \rd, #63 | 
 | 	ldr	\rd, [\rd, #TI_TASK] | 
 | 	.if (TSK_ACTIVE_MM > IMM12_MASK) | 
 | 	add	\rd, \rd, #TSK_ACTIVE_MM & ~IMM12_MASK | 
 | 	.endif | 
 | 	ldr	\rd, [\rd, #TSK_ACTIVE_MM & IMM12_MASK] | 
 | 	.endm | 
 |  | 
 | /* | 
 |  * mmid - get context id from mm pointer (mm->context.id) | 
 |  * note, this field is 64bit, so in big-endian the two words are swapped too. | 
 |  */ | 
 | 	.macro	mmid, rd, rn | 
 | #ifdef __ARMEB__ | 
 | 	ldr	\rd, [\rn, #MM_CONTEXT_ID + 4 ] | 
 | #else | 
 | 	ldr	\rd, [\rn, #MM_CONTEXT_ID] | 
 | #endif | 
 | 	.endm | 
 |  | 
 | /* | 
 |  * mask_asid - mask the ASID from the context ID | 
 |  */ | 
 | 	.macro	asid, rd, rn | 
 | 	and	\rd, \rn, #255 | 
 | 	.endm | 
 |  | 
 | 	.macro	crval, clear, mmuset, ucset | 
 | #ifdef CONFIG_MMU | 
 | 	.word	\clear | 
 | 	.word	\mmuset | 
 | #else | 
 | 	.word	\clear | 
 | 	.word	\ucset | 
 | #endif | 
 | 	.endm | 
 |  | 
 | /* | 
 |  * dcache_line_size - get the minimum D-cache line size from the CTR register | 
 |  * on ARMv7. | 
 |  */ | 
 | 	.macro	dcache_line_size, reg, tmp | 
 | #ifdef CONFIG_CPU_V7M | 
 | 	movw	\tmp, #:lower16:BASEADDR_V7M_SCB + V7M_SCB_CTR | 
 | 	movt	\tmp, #:upper16:BASEADDR_V7M_SCB + V7M_SCB_CTR | 
 | 	ldr     \tmp, [\tmp] | 
 | #else | 
 | 	mrc	p15, 0, \tmp, c0, c0, 1		@ read ctr | 
 | #endif | 
 | 	lsr	\tmp, \tmp, #16 | 
 | 	and	\tmp, \tmp, #0xf		@ cache line size encoding | 
 | 	mov	\reg, #4			@ bytes per word | 
 | 	mov	\reg, \reg, lsl \tmp		@ actual cache line size | 
 | 	.endm | 
 |  | 
 | /* | 
 |  * icache_line_size - get the minimum I-cache line size from the CTR register | 
 |  * on ARMv7. | 
 |  */ | 
 | 	.macro	icache_line_size, reg, tmp | 
 | #ifdef CONFIG_CPU_V7M | 
 | 	movw	\tmp, #:lower16:BASEADDR_V7M_SCB + V7M_SCB_CTR | 
 | 	movt	\tmp, #:upper16:BASEADDR_V7M_SCB + V7M_SCB_CTR | 
 | 	ldr     \tmp, [\tmp] | 
 | #else | 
 | 	mrc	p15, 0, \tmp, c0, c0, 1		@ read ctr | 
 | #endif | 
 | 	and	\tmp, \tmp, #0xf		@ cache line size encoding | 
 | 	mov	\reg, #4			@ bytes per word | 
 | 	mov	\reg, \reg, lsl \tmp		@ actual cache line size | 
 | 	.endm | 
 |  | 
 | /* | 
 |  * Sanity check the PTE configuration for the code below - which makes | 
 |  * certain assumptions about how these bits are laid out. | 
 |  */ | 
 | #ifdef CONFIG_MMU | 
 | #if L_PTE_SHARED != PTE_EXT_SHARED | 
 | #error PTE shared bit mismatch | 
 | #endif | 
 | #if !defined (CONFIG_ARM_LPAE) && \ | 
 | 	(L_PTE_XN+L_PTE_USER+L_PTE_RDONLY+L_PTE_DIRTY+L_PTE_YOUNG+\ | 
 | 	 L_PTE_PRESENT) > L_PTE_SHARED | 
 | #error Invalid Linux PTE bit settings | 
 | #endif | 
 | #endif	/* CONFIG_MMU */ | 
 |  | 
 | /* | 
 |  * The ARMv6 and ARMv7 set_pte_ext translation function. | 
 |  * | 
 |  * Permission translation: | 
 |  *  YUWD  APX AP1 AP0	SVC	User | 
 |  *  0xxx   0   0   0	no acc	no acc | 
 |  *  100x   1   0   1	r/o	no acc | 
 |  *  10x0   1   0   1	r/o	no acc | 
 |  *  1011   0   0   1	r/w	no acc | 
 |  *  110x   1   1   1	r/o	r/o | 
 |  *  11x0   1   1   1	r/o	r/o | 
 |  *  1111   0   1   1	r/w	r/w | 
 |  */ | 
 | 	.macro	armv6_mt_table pfx | 
 | \pfx\()_mt_table: | 
 | 	.long	0x00						@ L_PTE_MT_UNCACHED | 
 | 	.long	PTE_EXT_TEX(1)					@ L_PTE_MT_BUFFERABLE | 
 | 	.long	PTE_CACHEABLE					@ L_PTE_MT_WRITETHROUGH | 
 | 	.long	PTE_CACHEABLE | PTE_BUFFERABLE			@ L_PTE_MT_WRITEBACK | 
 | 	.long	PTE_BUFFERABLE					@ L_PTE_MT_DEV_SHARED | 
 | 	.long	0x00						@ unused | 
 | 	.long	0x00						@ L_PTE_MT_MINICACHE (not present) | 
 | 	.long	PTE_EXT_TEX(1) | PTE_CACHEABLE | PTE_BUFFERABLE	@ L_PTE_MT_WRITEALLOC | 
 | 	.long	0x00						@ unused | 
 | 	.long	PTE_EXT_TEX(1)					@ L_PTE_MT_DEV_WC | 
 | 	.long	0x00						@ unused | 
 | 	.long	PTE_CACHEABLE | PTE_BUFFERABLE			@ L_PTE_MT_DEV_CACHED | 
 | 	.long	PTE_EXT_TEX(2)					@ L_PTE_MT_DEV_NONSHARED | 
 | 	.long	0x00						@ unused | 
 | 	.long	0x00						@ unused | 
 | 	.long	PTE_CACHEABLE | PTE_BUFFERABLE | PTE_EXT_APX	@ L_PTE_MT_VECTORS | 
 | 	.endm | 
 |  | 
 | 	.macro	armv6_set_pte_ext pfx | 
 | 	str	r1, [r0], #2048			@ linux version | 
 |  | 
 | 	bic	r3, r1, #0x000003fc | 
 | 	bic	r3, r3, #PTE_TYPE_MASK | 
 | 	orr	r3, r3, r2 | 
 | 	orr	r3, r3, #PTE_EXT_AP0 | 2 | 
 |  | 
 | 	adr	ip, \pfx\()_mt_table | 
 | 	and	r2, r1, #L_PTE_MT_MASK | 
 | 	ldr	r2, [ip, r2] | 
 |  | 
 | 	eor	r1, r1, #L_PTE_DIRTY | 
 | 	tst	r1, #L_PTE_DIRTY|L_PTE_RDONLY | 
 | 	orrne	r3, r3, #PTE_EXT_APX | 
 |  | 
 | 	tst	r1, #L_PTE_USER | 
 | 	orrne	r3, r3, #PTE_EXT_AP1 | 
 | 	tstne	r3, #PTE_EXT_APX | 
 |  | 
 | 	@ user read-only -> kernel read-only | 
 | 	bicne	r3, r3, #PTE_EXT_AP0 | 
 |  | 
 | 	tst	r1, #L_PTE_XN | 
 | 	orrne	r3, r3, #PTE_EXT_XN | 
 |  | 
 | 	eor	r3, r3, r2 | 
 |  | 
 | 	tst	r1, #L_PTE_YOUNG | 
 | 	tstne	r1, #L_PTE_PRESENT | 
 | 	moveq	r3, #0 | 
 | 	tstne	r1, #L_PTE_NONE | 
 | 	movne	r3, #0 | 
 |  | 
 | 	str	r3, [r0] | 
 | 	mcr	p15, 0, r0, c7, c10, 1		@ flush_pte | 
 | 	.endm | 
 |  | 
 |  | 
 | /* | 
 |  * The ARMv3, ARMv4 and ARMv5 set_pte_ext translation function, | 
 |  * covering most CPUs except Xscale and Xscale 3. | 
 |  * | 
 |  * Permission translation: | 
 |  *  YUWD   AP	SVC	User | 
 |  *  0xxx  0x00	no acc	no acc | 
 |  *  100x  0x00	r/o	no acc | 
 |  *  10x0  0x00	r/o	no acc | 
 |  *  1011  0x55	r/w	no acc | 
 |  *  110x  0xaa	r/w	r/o | 
 |  *  11x0  0xaa	r/w	r/o | 
 |  *  1111  0xff	r/w	r/w | 
 |  */ | 
 | 	.macro	armv3_set_pte_ext wc_disable=1 | 
 | 	str	r1, [r0], #2048			@ linux version | 
 |  | 
 | 	eor	r3, r1, #L_PTE_PRESENT | L_PTE_YOUNG | L_PTE_DIRTY | 
 |  | 
 | 	bic	r2, r1, #PTE_SMALL_AP_MASK	@ keep C, B bits | 
 | 	bic	r2, r2, #PTE_TYPE_MASK | 
 | 	orr	r2, r2, #PTE_TYPE_SMALL | 
 |  | 
 | 	tst	r3, #L_PTE_USER			@ user? | 
 | 	orrne	r2, r2, #PTE_SMALL_AP_URO_SRW | 
 |  | 
 | 	tst	r3, #L_PTE_RDONLY | L_PTE_DIRTY	@ write and dirty? | 
 | 	orreq	r2, r2, #PTE_SMALL_AP_UNO_SRW | 
 |  | 
 | 	tst	r3, #L_PTE_PRESENT | L_PTE_YOUNG	@ present and young? | 
 | 	movne	r2, #0 | 
 |  | 
 | 	.if	\wc_disable | 
 | #ifdef CONFIG_CPU_DCACHE_WRITETHROUGH | 
 | 	tst	r2, #PTE_CACHEABLE | 
 | 	bicne	r2, r2, #PTE_BUFFERABLE | 
 | #endif | 
 | 	.endif | 
 | 	str	r2, [r0]		@ hardware version | 
 | 	.endm | 
 |  | 
 |  | 
 | /* | 
 |  * Xscale set_pte_ext translation, split into two halves to cope | 
 |  * with work-arounds.  r3 must be preserved by code between these | 
 |  * two macros. | 
 |  * | 
 |  * Permission translation: | 
 |  *  YUWD  AP	SVC	User | 
 |  *  0xxx  00	no acc	no acc | 
 |  *  100x  00	r/o	no acc | 
 |  *  10x0  00	r/o	no acc | 
 |  *  1011  01	r/w	no acc | 
 |  *  110x  10	r/w	r/o | 
 |  *  11x0  10	r/w	r/o | 
 |  *  1111  11	r/w	r/w | 
 |  */ | 
 | 	.macro	xscale_set_pte_ext_prologue | 
 | 	str	r1, [r0]			@ linux version | 
 |  | 
 | 	eor	r3, r1, #L_PTE_PRESENT | L_PTE_YOUNG | L_PTE_DIRTY | 
 |  | 
 | 	bic	r2, r1, #PTE_SMALL_AP_MASK	@ keep C, B bits | 
 | 	orr	r2, r2, #PTE_TYPE_EXT		@ extended page | 
 |  | 
 | 	tst	r3, #L_PTE_USER			@ user? | 
 | 	orrne	r2, r2, #PTE_EXT_AP_URO_SRW	@ yes -> user r/o, system r/w | 
 |  | 
 | 	tst	r3, #L_PTE_RDONLY | L_PTE_DIRTY	@ write and dirty? | 
 | 	orreq	r2, r2, #PTE_EXT_AP_UNO_SRW	@ yes -> user n/a, system r/w | 
 | 						@ combined with user -> user r/w | 
 | 	.endm | 
 |  | 
 | 	.macro	xscale_set_pte_ext_epilogue | 
 | 	tst	r3, #L_PTE_PRESENT | L_PTE_YOUNG	@ present and young? | 
 | 	movne	r2, #0				@ no -> fault | 
 |  | 
 | 	str	r2, [r0, #2048]!		@ hardware version | 
 | 	mov	ip, #0 | 
 | 	mcr	p15, 0, r0, c7, c10, 1		@ clean L1 D line | 
 | 	mcr	p15, 0, ip, c7, c10, 4		@ data write barrier | 
 | 	.endm | 
 |  | 
 | .macro define_processor_functions name:req, dabort:req, pabort:req, nommu=0, suspend=0, bugs=0 | 
 | /* | 
 |  * If we are building for big.Little with branch predictor hardening, | 
 |  * we need the processor function tables to remain available after boot. | 
 |  */ | 
 | #if defined(CONFIG_BIG_LITTLE) && defined(CONFIG_HARDEN_BRANCH_PREDICTOR) | 
 | 	.section ".rodata" | 
 | #endif | 
 | 	.type	\name\()_processor_functions, #object | 
 | 	.align 2 | 
 | ENTRY(\name\()_processor_functions) | 
 | 	.word	\dabort | 
 | 	.word	\pabort | 
 | 	.word	cpu_\name\()_proc_init | 
 | 	.word	\bugs | 
 | 	.word	cpu_\name\()_proc_fin | 
 | 	.word	cpu_\name\()_reset | 
 | 	.word	cpu_\name\()_do_idle | 
 | 	.word	cpu_\name\()_dcache_clean_area | 
 | 	.word	cpu_\name\()_switch_mm | 
 |  | 
 | 	.if \nommu | 
 | 	.word	0 | 
 | 	.else | 
 | 	.word	cpu_\name\()_set_pte_ext | 
 | 	.endif | 
 |  | 
 | 	.if \suspend | 
 | 	.word	cpu_\name\()_suspend_size | 
 | #ifdef CONFIG_ARM_CPU_SUSPEND | 
 | 	.word	cpu_\name\()_do_suspend | 
 | 	.word	cpu_\name\()_do_resume | 
 | #else | 
 | 	.word	0 | 
 | 	.word	0 | 
 | #endif | 
 | 	.else | 
 | 	.word	0 | 
 | 	.word	0 | 
 | 	.word	0 | 
 | 	.endif | 
 |  | 
 | 	.size	\name\()_processor_functions, . - \name\()_processor_functions | 
 | #if defined(CONFIG_BIG_LITTLE) && defined(CONFIG_HARDEN_BRANCH_PREDICTOR) | 
 | 	.previous | 
 | #endif | 
 | .endm | 
 |  | 
 | .macro define_cache_functions name:req | 
 | 	.align 2 | 
 | 	.type	\name\()_cache_fns, #object | 
 | ENTRY(\name\()_cache_fns) | 
 | 	.long	\name\()_flush_icache_all | 
 | 	.long	\name\()_flush_kern_cache_all | 
 | 	.long   \name\()_flush_kern_cache_louis | 
 | 	.long	\name\()_flush_user_cache_all | 
 | 	.long	\name\()_flush_user_cache_range | 
 | 	.long	\name\()_coherent_kern_range | 
 | 	.long	\name\()_coherent_user_range | 
 | 	.long	\name\()_flush_kern_dcache_area | 
 | 	.long	\name\()_dma_map_area | 
 | 	.long	\name\()_dma_unmap_area | 
 | 	.long	\name\()_dma_flush_range | 
 | 	.size	\name\()_cache_fns, . - \name\()_cache_fns | 
 | .endm | 
 |  | 
 | .macro define_tlb_functions name:req, flags_up:req, flags_smp | 
 | 	.type	\name\()_tlb_fns, #object | 
 | ENTRY(\name\()_tlb_fns) | 
 | 	.long	\name\()_flush_user_tlb_range | 
 | 	.long	\name\()_flush_kern_tlb_range | 
 | 	.ifnb \flags_smp | 
 | 		ALT_SMP(.long	\flags_smp ) | 
 | 		ALT_UP(.long	\flags_up ) | 
 | 	.else | 
 | 		.long	\flags_up | 
 | 	.endif | 
 | 	.size	\name\()_tlb_fns, . - \name\()_tlb_fns | 
 | .endm | 
 |  | 
 | .macro globl_equ x, y | 
 | 	.globl	\x | 
 | 	.equ	\x, \y | 
 | .endm | 
 |  | 
 | .macro	initfn, func, base | 
 | 	.long	\func - \base | 
 | .endm | 
 |  | 
 | 	/* | 
 | 	 * Macro to calculate the log2 size for the protection region | 
 | 	 * registers. This calculates rd = log2(size) - 1.  tmp must | 
 | 	 * not be the same register as rd. | 
 | 	 */ | 
 | .macro	pr_sz, rd, size, tmp | 
 | 	mov	\tmp, \size, lsr #12 | 
 | 	mov	\rd, #11 | 
 | 1:	movs	\tmp, \tmp, lsr #1 | 
 | 	addne	\rd, \rd, #1 | 
 | 	bne	1b | 
 | .endm | 
 |  | 
 | 	/* | 
 | 	 * Macro to generate a protection region register value | 
 | 	 * given a pre-masked address, size, and enable bit. | 
 | 	 * Corrupts size. | 
 | 	 */ | 
 | .macro	pr_val, dest, addr, size, enable | 
 | 	pr_sz	\dest, \size, \size		@ calculate log2(size) - 1 | 
 | 	orr	\dest, \addr, \dest, lsl #1	@ mask in the region size | 
 | 	orr	\dest, \dest, \enable | 
 | .endm |