2005-04-16 15:20:36 -07:00
|
|
|
#include <linux/linkage.h>
|
|
|
|
#include <asm/assembler.h>
|
2005-04-29 14:08:33 -07:00
|
|
|
#include "abort-macro.S"
|
2005-04-16 15:20:36 -07:00
|
|
|
/*
|
|
|
|
* Function: v6_early_abort
|
|
|
|
*
|
2011-06-26 08:01:26 -07:00
|
|
|
* Params : r2 = pt_regs
|
|
|
|
* : r4 = aborted context pc
|
2011-06-26 06:35:07 -07:00
|
|
|
* : r5 = aborted context psr
|
2005-04-16 15:20:36 -07:00
|
|
|
*
|
2011-06-26 08:01:26 -07:00
|
|
|
* Returns : r4 - r11, r13 preserved
|
2005-04-16 15:20:36 -07:00
|
|
|
*
|
|
|
|
* Purpose : obtain information about current aborted instruction.
|
2005-04-29 14:08:33 -07:00
|
|
|
* Note: we read user space. This means we might cause a data
|
|
|
|
* abort here if the I-TLB and D-TLB aren't seeing the same
|
|
|
|
* picture. Unfortunately, this does happen. We live with it.
|
2005-04-16 15:20:36 -07:00
|
|
|
*/
|
|
|
|
.align 5
|
|
|
|
ENTRY(v6_early_abort)
|
2011-01-17 08:35:37 -07:00
|
|
|
#ifdef CONFIG_CPU_V6
|
2009-03-02 14:39:36 -07:00
|
|
|
sub r1, sp, #4 @ Get unused stack location
|
|
|
|
strex r0, r1, [r1] @ Clear the exclusive monitor
|
2011-01-17 08:35:37 -07:00
|
|
|
#elif defined(CONFIG_CPU_32v6K)
|
|
|
|
clrex
|
2005-10-02 14:34:35 -07:00
|
|
|
#endif
|
2005-04-16 15:20:36 -07:00
|
|
|
mrc p15, 0, r1, c5, c0, 0 @ get FSR
|
|
|
|
mrc p15, 0, r0, c6, c0, 0 @ get FAR
|
2005-04-29 14:08:33 -07:00
|
|
|
/*
|
2012-04-20 09:20:08 -07:00
|
|
|
* Faulty SWP instruction on 1136 doesn't set bit 11 in DFSR.
|
2005-04-29 14:08:33 -07:00
|
|
|
*/
|
2012-04-20 09:20:08 -07:00
|
|
|
#ifdef CONFIG_ARM_ERRATA_326103
|
|
|
|
ldr ip, =0x4107b36
|
|
|
|
mrc p15, 0, r3, c0, c0, 0 @ get processor id
|
|
|
|
teq ip, r3, lsr #4 @ r0 ARM1136?
|
|
|
|
bne do_DataAbort
|
2011-06-26 06:35:07 -07:00
|
|
|
tst r5, #PSR_J_BIT @ Java?
|
2012-04-20 09:20:08 -07:00
|
|
|
tsteq r5, #PSR_T_BIT @ Thumb?
|
2011-06-26 08:01:26 -07:00
|
|
|
bne do_DataAbort
|
2012-04-20 09:20:08 -07:00
|
|
|
bic r1, r1, #1 << 11 @ clear bit 11 of FSR
|
|
|
|
ldr r3, [r4] @ read aborted ARM instruction
|
2009-05-30 06:00:18 -07:00
|
|
|
#ifdef CONFIG_CPU_ENDIAN_BE8
|
2012-04-20 09:20:08 -07:00
|
|
|
rev r3, r3
|
2009-05-30 06:00:18 -07:00
|
|
|
#endif
|
2011-06-26 06:42:02 -07:00
|
|
|
do_ldrd_abort tmp=ip, insn=r3
|
2005-04-29 14:08:33 -07:00
|
|
|
tst r3, #1 << 20 @ L = 0 -> write
|
|
|
|
orreq r1, r1, #1 << 11 @ yes.
|
2012-04-20 09:20:08 -07:00
|
|
|
#endif
|
2011-06-26 08:01:26 -07:00
|
|
|
b do_DataAbort
|