2007-05-08 21:27:46 +00:00
|
|
|
#include <linux/linkage.h>
|
|
|
|
#include <asm/assembler.h>
|
|
|
|
/*
|
|
|
|
* Function: v7_early_abort
|
|
|
|
*
|
2011-06-26 13:35:07 +00:00
|
|
|
* Params : r4 = aborted context pc
|
|
|
|
* : r5 = aborted context psr
|
2007-05-08 21:27:46 +00:00
|
|
|
*
|
|
|
|
* Returns : r0 = address of abort
|
|
|
|
* : r1 = FSR, bit 11 = write
|
|
|
|
* : r2-r8 = corrupted
|
|
|
|
* : r9 = preserved
|
|
|
|
* : sp = pointer to registers
|
|
|
|
*
|
|
|
|
* Purpose : obtain information about current aborted instruction.
|
|
|
|
*/
|
|
|
|
.align 5
|
|
|
|
ENTRY(v7_early_abort)
|
|
|
|
/*
|
|
|
|
* The effect of data aborts on on the exclusive access monitor are
|
|
|
|
* UNPREDICTABLE. Do a CLREX to clear the state
|
|
|
|
*/
|
|
|
|
clrex
|
|
|
|
|
|
|
|
mrc p15, 0, r1, c5, c0, 0 @ get FSR
|
|
|
|
mrc p15, 0, r0, c6, c0, 0 @ get FAR
|
|
|
|
|
|
|
|
/*
|
|
|
|
* V6 code adjusts the returned DFSR.
|
|
|
|
* New designs should not need to patch up faults.
|
|
|
|
*/
|
2009-08-11 21:58:49 +00:00
|
|
|
|
|
|
|
#if defined(CONFIG_VERIFY_PERMISSION_FAULT)
|
|
|
|
/*
|
|
|
|
* Detect erroneous permission failures and fix
|
|
|
|
*/
|
|
|
|
ldr r3, =0x40d @ On permission fault
|
|
|
|
and r3, r1, r3
|
|
|
|
cmp r3, #0x0d
|
|
|
|
movne pc, lr
|
|
|
|
|
|
|
|
mcr p15, 0, r0, c7, c8, 0 @ Retranslate FAR
|
|
|
|
isb
|
2011-06-26 13:42:02 +00:00
|
|
|
mrc p15, 0, ip, c7, c4, 0 @ Read the PAR
|
|
|
|
and r3, ip, #0x7b @ On translation fault
|
2009-08-11 21:58:49 +00:00
|
|
|
cmp r3, #0x0b
|
|
|
|
movne pc, lr
|
|
|
|
bic r1, r1, #0xf @ Fix up FSR FS[5:0]
|
2011-06-26 13:42:02 +00:00
|
|
|
and ip, ip, #0x7e
|
|
|
|
orr r1, r1, ip, LSR #1
|
2009-08-11 21:58:49 +00:00
|
|
|
#endif
|
|
|
|
|
2007-05-08 21:27:46 +00:00
|
|
|
mov pc, lr
|
2008-08-28 10:22:32 +00:00
|
|
|
ENDPROC(v7_early_abort)
|