diff options
author | Drew Barbier <dbarbi1@gmail.com> | 2018-07-11 21:34:21 -0700 |
---|---|---|
committer | GitHub <noreply@github.com> | 2018-07-11 21:34:21 -0700 |
commit | 67a27655c3b7d3955703850ca0ac6d4c8b6b38ca (patch) | |
tree | ba4b67cf6acd69ffb52c4d2177564d00aad02b1f /bsp/env/coreip-e2-arty/init.c | |
parent | b091d1cabe70c84825a7f304d725010d2cf163d9 (diff) | |
parent | 7bf718778b9710238d791cefc67ac9c8720985e2 (diff) |
Merge pull request #96 from sifive/clic-vectored
Clic vectored
Diffstat (limited to 'bsp/env/coreip-e2-arty/init.c')
-rw-r--r-- | bsp/env/coreip-e2-arty/init.c | 98 |
1 files changed, 98 insertions, 0 deletions
diff --git a/bsp/env/coreip-e2-arty/init.c b/bsp/env/coreip-e2-arty/init.c new file mode 100644 index 0000000..3a4c77c --- /dev/null +++ b/bsp/env/coreip-e2-arty/init.c @@ -0,0 +1,98 @@ +//See LICENSE for license details. +#include <stdint.h> +#include <stdio.h> +#include <unistd.h> + +#include "platform.h" +#include "encoding.h" + +#define CPU_FREQ 32000000 +#define XSTR(x) #x +#define STR(x) XSTR(x) + +extern int main(int argc, char** argv); + +unsigned long get_cpu_freq() +{ + return CPU_FREQ; +} + +unsigned long get_timer_freq() +{ + return get_cpu_freq(); +} + +uint64_t get_timer_value() +{ +#if __riscv_xlen == 32 + while (1) { + uint32_t hi = read_csr(mcycleh); + uint32_t lo = read_csr(mcycle); + if (hi == read_csr(mcycleh)) + return ((uint64_t)hi << 32) | lo; + } +#else + return read_csr(mcycle); +#endif +} + +static void uart_init(size_t baud_rate) +{ + UART0_REG(UART_REG_DIV) = (get_cpu_freq() ) / baud_rate - 1; + UART0_REG(UART_REG_TXCTRL) |= UART_TXEN; +} + + +typedef void (*interrupt_function_ptr_t) (void); +interrupt_function_ptr_t localISR[CLIC_NUM_INTERRUPTS] __attribute__((aligned(64))); + + +void trap_entry(void) __attribute__((interrupt, aligned(64))); +void trap_entry(void) +{ + unsigned long mcause = read_csr(mcause); + unsigned long mepc = read_csr(mepc); + if (mcause & MCAUSE_INT) { + localISR[mcause & MCAUSE_CAUSE] (); + } else { + while(1); + } +} + +#ifdef CLIC_DIRECT +#else +void default_handler(void)__attribute__((interrupt));; +#endif +void default_handler(void) +{ + puts("default handler\n"); + while(1); +} + +void _init() +{ +#ifndef NO_INIT + uart_init(115200); + + puts("core freq at " STR(CPU_FREQ) " Hz\n"); + +//initialize vector table + int i=0; + while(i<CLIC_NUM_INTERRUPTS) { + localISR[i++] = default_handler; + } + + write_csr(mtvt, localISR); + +#ifdef CLIC_DIRECT + write_csr(mtvec, ((unsigned long)&trap_entry | MTVEC_CLIC)); +#else + write_csr(mtvec, ((unsigned long)&trap_entry | MTVEC_CLIC_VECT)); +#endif + +#endif +} + +void _fini() +{ +} |