# EP02 CVE2 trap/interrupt firmware.
# Vector table is at 0x100 (CVE2 forces mtvec.MODE=1, vectored).
# Exception -> 0x100; software IRQ (3) -> 0x10c; timer IRQ (7) -> 0x11c;
# external IRQ (11) -> 0x12c.

    .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:
    call    main
3:
    j       3b

    .section .trap_vector, "ax"
    .balign 4
    .globl trap_vector
trap_vector:
    j       trap_exception          # +0x00 exception
    .space  8                       # +0x04 .. +0x0b
    j       trap_software           # +0x0c IRQ 3
    .space  12                      # +0x10 .. +0x1b
    j       trap_timer              # +0x1c IRQ 7
    .space  12                      # +0x20 .. +0x2b
    j       trap_external           # +0x2c IRQ 11

    .section .text, "ax"
    .option norvc

# Exception handler: record mcause/mepc, accept ecall(11), ebreak(3),
# illegal instruction(2), skip the trapping instruction, return.
trap_exception:
    addi    sp, sp, -16
    sw      t0, 0(sp)
    sw      t1, 4(sp)
    sw      t2, 8(sp)

    csrr    t0, mcause
    la      t1, g_last_mcause
    sw      t0, 0(t1)
    csrr    t0, mepc
    la      t1, g_last_mepc
    sw      t0, 0(t1)

    la      t1, g_exc_count
    lw      t2, 0(t1)
    addi    t2, t2, 1
    sw      t2, 0(t1)

    csrr    t0, mcause
    li      t1, 11
    beq     t0, t1, 1f
    li      t1, 3
    beq     t0, t1, 1f
    li      t1, 2
    beq     t0, t1, 1f
    la      t1, g_fail
    li      t2, 0xE001
    sw      t2, 0(t1)
1:
    csrr    t0, mepc
    addi    t0, t0, 4
    csrw    mepc, t0

    lw      t0, 0(sp)
    lw      t1, 4(sp)
    lw      t2, 8(sp)
    addi    sp, sp, 16
    mret

# Software interrupt: record, clear msip, return.
trap_software:
    addi    sp, sp, -16
    sw      t0, 0(sp)
    sw      t1, 4(sp)
    sw      t2, 8(sp)

    csrr    t0, mcause
    la      t1, g_last_mcause
    sw      t0, 0(t1)
    la      t1, g_sw_count
    lw      t2, 0(t1)
    addi    t2, t2, 1
    sw      t2, 0(t1)

    li      t1, 0x80000003
    beq     t0, t1, 1f
    la      t1, g_fail
    li      t2, 0xE003
    sw      t2, 0(t1)
1:
    li      t2, 0x20000000
    sw      zero, 16(t2)             # clear msip

    lw      t0, 0(sp)
    lw      t1, 4(sp)
    lw      t2, 8(sp)
    addi    sp, sp, 16
    mret

# Timer interrupt: record, schedule next compare, return.
trap_timer:
    addi    sp, sp, -16
    sw      t0, 0(sp)
    sw      t1, 4(sp)
    sw      t2, 8(sp)

    csrr    t0, mcause
    la      t1, g_last_mcause
    sw      t0, 0(t1)
    la      t1, g_timer_count
    lw      t2, 0(t1)
    addi    t2, t2, 1
    sw      t2, 0(t1)

    li      t1, 0x80000007
    beq     t0, t1, 1f
    la      t1, g_fail
    li      t2, 0xE002
    sw      t2, 0(t1)
1:
    li      t2, 0x20000000
    lw      t0, 0(t2)               # mtime low
    li      t1, 50000               # 1 ms at 50 MHz
    add     t0, t0, t1
    sw      t0, 8(t2)               # mtimecmp low
    sw      zero, 12(t2)            # mtimecmp high

    lw      t0, 0(sp)
    lw      t1, 4(sp)
    lw      t2, 8(sp)
    addi    sp, sp, 16
    mret

# External interrupt: record, clear injected pending bit, return.
trap_external:
    addi    sp, sp, -16
    sw      t0, 0(sp)
    sw      t1, 4(sp)
    sw      t2, 8(sp)

    csrr    t0, mcause
    la      t1, g_last_mcause
    sw      t0, 0(t1)
    la      t1, g_ext_count
    lw      t2, 0(t1)
    addi    t2, t2, 1
    sw      t2, 0(t1)

    li      t1, 0x8000000b
    beq     t0, t1, 1f
    la      t1, g_fail
    li      t2, 0xE004
    sw      t2, 0(t1)
1:
    li      t2, 0x20000000
    sw      zero, 20(t2)            # clear external pending

    lw      t0, 0(sp)
    lw      t1, 4(sp)
    lw      t2, 8(sp)
    addi    sp, sp, 16
    mret
