Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) /* SPDX-License-Identifier: GPL-2.0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) #include <linux/linkage.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) #include <asm/assembler.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include "abort-macro.S"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  * Function: v5t_early_abort
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8)  * Params  : r2 = pt_regs
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9)  *	   : r4 = aborted context pc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)  *	   : r5 = aborted context psr
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)  * Returns : r4 - r11, r13 preserved
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)  * Purpose : obtain information about current aborted instruction.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)  * Note: we read user space.  This means we might cause a data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)  * abort here if the I-TLB and D-TLB aren't seeing the same
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)  * picture.  Unfortunately, this does happen.  We live with it.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	.align	5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) ENTRY(v5t_early_abort)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	mrc	p15, 0, r1, c5, c0, 0		@ get FSR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	mrc	p15, 0, r0, c6, c0, 0		@ get FAR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	do_thumb_abort fsr=r1, pc=r4, psr=r5, tmp=r3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	ldreq	r3, [r4]			@ read aborted ARM instruction
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	uaccess_disable ip			@ disable user access
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	bic	r1, r1, #1 << 11		@ clear bits 11 of FSR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	teq_ldrd tmp=ip, insn=r3		@ insn was LDRD?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	beq	do_DataAbort			@ yes
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 	tst	r3, #1 << 20			@ check write
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	orreq	r1, r1, #1 << 11
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	b	do_DataAbort