#include <types.h>
#include <arm.h>

#include "arm/gic.h"
#include "arm/timer.h"

#define TIMER_INTERRUPT	(0x1E)

#define REG_TIMER(c, n)	REG_ARM_PMR(0x700 + ((c) * 0x100) + (n), u32)
#define TIMER_THIS_CPU	(-1)

#define REG_TIMER_LOAD(c)	*REG_TIMER((c), 0x00)
#define REG_TIMER_COUNT(c)	*REG_TIMER((c), 0x04)
#define REG_TIMER_CNT(c)	*REG_TIMER((c), 0x08)
#define REG_TIMER_IRQ(c)	*REG_TIMER((c), 0x0C)

#define TIMER_CNT_SCALE(n)	((n) << 8)
#define TIMER_CNT_INT_EN	BIT(2)
#define TIMER_CNT_RELOAD	BIT(1)
#define TIMER_CNT_ENABLE	BIT(0)

void TIMER_WaitTicks(u32 ticks)
{
	REG_TIMER_IRQ(TIMER_THIS_CPU) = 1;
	REG_TIMER_CNT(TIMER_THIS_CPU) = 0;
	REG_TIMER_LOAD(TIMER_THIS_CPU) = ticks;
	REG_TIMER_CNT(TIMER_THIS_CPU) = TIMER_CNT_ENABLE;
	while(REG_TIMER_COUNT(TIMER_THIS_CPU));
}