abort-ev7.S 1.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354
  1. #include <linux/linkage.h>
  2. #include <asm/assembler.h>
  3. /*
  4. * Function: v7_early_abort
  5. *
  6. * Params : r2 = address of aborted instruction
  7. * : r3 = saved SPSR
  8. *
  9. * Returns : r0 = address of abort
  10. * : r1 = FSR, bit 11 = write
  11. * : r2-r8 = corrupted
  12. * : r9 = preserved
  13. * : sp = pointer to registers
  14. *
  15. * Purpose : obtain information about current aborted instruction.
  16. */
  17. .align 5
  18. ENTRY(v7_early_abort)
  19. /*
  20. * The effect of data aborts on on the exclusive access monitor are
  21. * UNPREDICTABLE. Do a CLREX to clear the state
  22. */
  23. clrex
  24. mrc p15, 0, r1, c5, c0, 0 @ get FSR
  25. mrc p15, 0, r0, c6, c0, 0 @ get FAR
  26. /*
  27. * V6 code adjusts the returned DFSR.
  28. * New designs should not need to patch up faults.
  29. */
  30. #if defined(CONFIG_VERIFY_PERMISSION_FAULT)
  31. /*
  32. * Detect erroneous permission failures and fix
  33. */
  34. ldr r3, =0x40d @ On permission fault
  35. and r3, r1, r3
  36. cmp r3, #0x0d
  37. movne pc, lr
  38. mcr p15, 0, r0, c7, c8, 0 @ Retranslate FAR
  39. isb
  40. mrc p15, 0, r2, c7, c4, 0 @ Read the PAR
  41. and r3, r2, #0x7b @ On translation fault
  42. cmp r3, #0x0b
  43. movne pc, lr
  44. bic r1, r1, #0xf @ Fix up FSR FS[5:0]
  45. and r2, r2, #0x7e
  46. orr r1, r1, r2, LSR #1
  47. #endif
  48. mov pc, lr
  49. ENDPROC(v7_early_abort)