#include <interrupt.h>
#include <utils.h>
#include <logger.h>
#include <errcode.h>

void init_interrupt(void)
{
  uint64_t cntfrq_el0;
  R_SYSREG(cntfrq_el0, cntfrq_el0);
  W_SYSREG(cntp_tval_el0, cntfrq_el0);

  *CORE0_TIMER_IRQ_CTRL = 0x2;
}

static inline
void _uart_irq_handler(void)
{
  DEBUG_EXCEP("uart irq");
}

static inline
void _timer_irq_handler(void)
{
  LOG("timer irq");

  uint64_t cntpct_el0;
  R_SYSREG(cntpct_el0, cntpct_el0);
  DEBUG_EXCEP(cntpct_el0);

  uint64_t cntfrq_el0;
  R_SYSREG(cntfrq_el0, cntfrq_el0);
  W_SYSREG(cntp_tval_el0, cntfrq_el0);
}

void irq_handler(void)
{
  LOG("irq caught");
  uint64_t irq_source = *CORE0_IRQ_SOURCE;
  DEBUG_EXCEP(irq_source);

  *CORE0_TIMER_IRQ_CTRL = 0x0;
  if (irq_source & GPU_INT)
    _uart_irq_handler();
  if (irq_source & CNTPNSIRQ_INT)
    _timer_irq_handler();

  *CORE0_TIMER_IRQ_CTRL = 0x2;
}

void enable_interrupt(void)
{
  asm volatile("msr DAIFClr, 0xf");
}

void disable_interrupt(void)
{
  asm volatile("msr DAIFSet, 0xf");
}