| Greg Kroah-Hartman | b244131 | 2017-11-01 15:07:57 +0100 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0 */ |
| Catalin Marinas | bbe8888 | 2007-05-08 22:27:46 +0100 | [diff] [blame] | 2 | #include <linux/linkage.h> |
| 3 | #include <asm/assembler.h> |
| 4 | /* |
| 5 | * Function: v7_early_abort |
| 6 | * |
| Russell King | da74047 | 2011-06-26 16:01:26 +0100 | [diff] [blame] | 7 | * Params : r2 = pt_regs |
| 8 | * : r4 = aborted context pc |
| Russell King | 3e287be | 2011-06-26 14:35:07 +0100 | [diff] [blame] | 9 | * : r5 = aborted context psr |
| Catalin Marinas | bbe8888 | 2007-05-08 22:27:46 +0100 | [diff] [blame] | 10 | * |
| Russell King | da74047 | 2011-06-26 16:01:26 +0100 | [diff] [blame] | 11 | * Returns : r4 - r11, r13 preserved |
| Catalin Marinas | bbe8888 | 2007-05-08 22:27:46 +0100 | [diff] [blame] | 12 | * |
| 13 | * Purpose : obtain information about current aborted instruction. |
| 14 | */ |
| 15 | .align 5 |
| 16 | ENTRY(v7_early_abort) |
| Catalin Marinas | bbe8888 | 2007-05-08 22:27:46 +0100 | [diff] [blame] | 17 | mrc p15, 0, r1, c5, c0, 0 @ get FSR |
| 18 | mrc p15, 0, r0, c6, c0, 0 @ get FAR |
| Russell King | 2190fed | 2015-08-20 10:32:02 +0100 | [diff] [blame] | 19 | uaccess_disable ip @ disable userspace access |
| Catalin Marinas | bbe8888 | 2007-05-08 22:27:46 +0100 | [diff] [blame] | 20 | |
| 21 | /* |
| 22 | * V6 code adjusts the returned DFSR. |
| 23 | * New designs should not need to patch up faults. |
| 24 | */ |
| Dave Estes | e220ba6 | 2009-08-11 17:58:49 -0400 | [diff] [blame] | 25 | |
| 26 | #if defined(CONFIG_VERIFY_PERMISSION_FAULT) |
| 27 | /* |
| 28 | * Detect erroneous permission failures and fix |
| 29 | */ |
| 30 | ldr r3, =0x40d @ On permission fault |
| 31 | and r3, r1, r3 |
| 32 | cmp r3, #0x0d |
| Russell King | da74047 | 2011-06-26 16:01:26 +0100 | [diff] [blame] | 33 | bne do_DataAbort |
| Dave Estes | e220ba6 | 2009-08-11 17:58:49 -0400 | [diff] [blame] | 34 | |
| 35 | mcr p15, 0, r0, c7, c8, 0 @ Retranslate FAR |
| 36 | isb |
| Russell King | 0d147db | 2011-06-26 14:42:02 +0100 | [diff] [blame] | 37 | mrc p15, 0, ip, c7, c4, 0 @ Read the PAR |
| 38 | and r3, ip, #0x7b @ On translation fault |
| Dave Estes | e220ba6 | 2009-08-11 17:58:49 -0400 | [diff] [blame] | 39 | cmp r3, #0x0b |
| Russell King | da74047 | 2011-06-26 16:01:26 +0100 | [diff] [blame] | 40 | bne do_DataAbort |
| Dave Estes | e220ba6 | 2009-08-11 17:58:49 -0400 | [diff] [blame] | 41 | bic r1, r1, #0xf @ Fix up FSR FS[5:0] |
| Russell King | 0d147db | 2011-06-26 14:42:02 +0100 | [diff] [blame] | 42 | and ip, ip, #0x7e |
| 43 | orr r1, r1, ip, LSR #1 |
| Dave Estes | e220ba6 | 2009-08-11 17:58:49 -0400 | [diff] [blame] | 44 | #endif |
| 45 | |
| Russell King | da74047 | 2011-06-26 16:01:26 +0100 | [diff] [blame] | 46 | b do_DataAbort |
| Catalin Marinas | 93ed397 | 2008-08-28 11:22:32 +0100 | [diff] [blame] | 47 | ENDPROC(v7_early_abort) |