abort-ev7.S 1.1 KB

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