# EP03 CVE2 board control core firmware.
# CVE2 forces mtvec.MODE=1; exception vector is at 0x100.

    .option norvc

    .section .text.start, "ax"
    .globl _start
_start:
    la      sp, _stack_top
    la      t0, _bss_start
    la      t1, _bss_end
1:
    bgeu    t0, t1, 2f
    sw      zero, 0(t0)
    addi    t0, t0, 4
    j       1b
2:
    la      t0, trap_vector
    csrw    mtvec, t0
    call    main
3:
    j       3b

    .section .trap_vector, "ax"
    .balign 4
    .globl trap_vector
trap_vector:
    j       trap_handler
    .space  252

    .section .text, "ax"
    .option norvc

# Unexpected trap: record mcause/mepc, skip the instruction, return.
trap_handler:
    addi    sp, sp, -8
    sw      t0, 0(sp)
    sw      t1, 4(sp)
    csrr    t0, mcause
    la      t1, g_trap_cause
    sw      t0, 0(t1)
    csrr    t0, mepc
    la      t1, g_trap_epc
    sw      t0, 0(t1)
    la      t1, g_trap_count
    lw      t0, 0(t1)
    addi    t0, t0, 1
    sw      t0, 0(t1)
    csrr    t0, mepc
    addi    t0, t0, 4
    csrw    mepc, t0
    lw      t0, 0(sp)
    lw      t1, 4(sp)
    addi    sp, sp, 8
    mret
