43 lines
1.1 KiB
ArmAsm
43 lines
1.1 KiB
ArmAsm
|
/*
|
||
|
|
* The ARM LDRD and Thumb LDRSB instructions use bit 20/11 (ARM/Thumb)
|
||
|
|
* differently than every other instruction, so it is set to 0 (write)
|
||
|
|
* even though the instructions are read instructions. This means that
|
||
|
|
* during an abort the instructions will be treated as a write and the
|
||
|
|
* handler will raise a signal from unwriteable locations if they
|
||
|
|
* fault. We have to specifically check for these instructions
|
||
|
|
* from the abort handlers to treat them properly.
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
|
||
|
|
.macro do_thumb_abort
|
||
|
|
tst r3, #PSR_T_BIT
|
||
|
|
beq not_thumb
|
||
|
|
ldrh r3, [r2] @ Read aborted Thumb instruction
|
||
|
|
and r3, r3, # 0xfe00 @ Mask opcode field
|
||
|
|
cmp r3, # 0x5600 @ Is it ldrsb?
|
||
|
|
orreq r3, r3, #1 << 11 @ Set L-bit if yes
|
||
|
|
tst r3, #1 << 11 @ L = 0 -> write
|
||
|
|
orreq r1, r1, #1 << 11 @ yes.
|
||
|
|
mov pc, lr
|
||
|
|
not_thumb:
|
||
|
|
.endm
|
||
|
|
|
||
|
|
/*
|
||
|
|
* We check for the following insturction encoding for LDRD.
|
||
|
|
*
|
||
|
|
* [27:25] == 0
|
||
|
|
* [7:4] == 1101
|
||
|
|
* [20] == 0
|
||
|
|
*/
|
||
|
|
.macro do_ldrd_abort
|
||
|
|
tst r3, #0x0e000000 @ [27:25] == 0
|
||
|
|
bne not_ldrd
|
||
|
|
and r2, r3, #0x000000f0 @ [7:4] == 1101
|
||
|
|
cmp r2, #0x000000d0
|
||
|
|
bne not_ldrd
|
||
|
|
tst r3, #1 << 20 @ [20] == 0
|
||
|
|
moveq pc, lr
|
||
|
|
not_ldrd:
|
||
|
|
.endm
|
||
|
|
|