#ifndef BCMCLOCK_H
#define BCMCLOCK_H

#include <stdint.h>

#include "global.h"

#define ST_BASE (PERIF_BASE + 0x3000) // System Timer

#define ST_CS  (ST_BASE + 0x0)  // System Timer Control/Status
#define ST_CLO (ST_BASE + 0x4)  // System Timer Counter Lower 32 bits
#define ST_CHI (ST_BASE + 0x8)  // System Timer Counter Higher 32 bits
#define ST_C0  (ST_BASE + 0xC)  // System Timer Compare 0
#define ST_C1  (ST_BASE + 0x10) // System Timer Compare 1
#define ST_C2  (ST_BASE + 0x14) // System Timer Compare 2
#define ST_C3  (ST_BASE + 0x18) // System Timer Compare 3

#define BCMCLK_IRQ_BASIC_PENDING  (ARM_BASE + 0x200)
#define BCMCLK_IRQ_PENDING_1      (ARM_BASE + 0x204)
#define BCMCLK_IRQ_PENDING_2      (ARM_BASE + 0x208)
#define BCMCLK_FIQ_CONTROL        (ARM_BASE + 0x20C)
#define BCMCLK_ENABLE_IRQS_1      (ARM_BASE + 0x210)
#define BCMCLK_ENABLE_IRQS_2      (ARM_BASE + 0x214)
#define BCMCLK_ENABLE_BASIC_IRQS  (ARM_BASE + 0x218)
#define BCMCLK_DISABLE_IRQS_1     (ARM_BASE + 0x21C)
#define BCMCLK_DISABLE_IRQS_2     (ARM_BASE + 0x220)
#define BCMCLK_DISABLE_BASIC_IRQS (ARM_BASE + 0x224)


static inline void enable_timer_irq(void)
{
  *(uint32_t volatile*) BCMCLK_ENABLE_BASIC_IRQS = 1;
  *(uint32_t volatile*) BCMCLK_ENABLE_IRQS_1 = 1 << 2;
}

static inline void disable_timer_irq(void)
{
  *(uint32_t volatile*) BCMCLK_DISABLE_BASIC_IRQS = 1;
  *(uint32_t volatile*) BCMCLK_DISABLE_IRQS_1 = 1 << 2;
}

static inline void set_timer_match_timeout(uint32_t timeout)
{
  uint32_t clock_now = *(uint32_t volatile*) ST_CLO;
  *(uint32_t volatile*) ST_C2 = clock_now + timeout;
  *(uint32_t volatile*) ST_CS = 1 << 2;
}

#endif // BCMCLOCK_H