Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

#include 

#include 

/*

 * Function: v4_early_abort

 *

 * Params  : r2 = address of aborted instruction

 *         : r3 = saved SPSR

 *

 * 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.

 * 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.

 */

        .align  5

ENTRY(v4_early_abort)

        mrc     p15, 0, r1, c5, c0, 0           @ get FSR

        mrc     p15, 0, r0, c6, c0, 0           @ get FAR

        ldr     r3, [r2]                        @ read aborted ARM instruction

        bic     r1, r1, #1 << 11 | 1 << 10      @ clear bits 11 and 10 of FSR

        tst     r3, #1 << 20			@ L = 1 -> write?

        orreq   r1, r1, #1 << 11                @ yes.

        mov     pc, lr