/*
 * Copyright 2022 Haiku, Inc. All rights reserved.
 * Distributed under the terms of the MIT License.
 */


#include "arch_timer_generic.h"


#define TIMER_IRQ 30


static uint32_t
get_counter_freq(void)
{
    uint32_t freq;
    asm volatile ("MRC p15, 0, %0, c14, c0, 0": "=r" (freq));
    return freq;
}


static uint64_t
get_counter(void)
{
    uint32_t counter_low;
    uint32_t counter_high;

    asm volatile ("ISB\n"
        "MRRC p15, 0, %0, %1, c14"
        : "=r" (counter_low), "=r" (counter_high));
    return ((uint64_t)counter_high << 32) | counter_low;
}


void
ARMGenericTimer::SetTimeout(bigtime_t timeout)
{
	uint32_t timeout_ticks = timeout * fTimerFrequencyMHz;
	asm volatile ("ISB\n"
		"MCR p15, 0, %0, c14, c2, 0"
		: : "r"(timeout_ticks));

	uint32_t timer_ctl = 1;
	asm volatile ("MCR p15, 0, %0, c14, c2, 1"
		: : "r"(timer_ctl));
}


void
ARMGenericTimer::Clear()
{
	uint32_t timer_ctl = 2;
	asm volatile ("MCR p15, 0, %0, c14, c2, 1"
		: : "r"(timer_ctl));
}


bigtime_t
ARMGenericTimer::Time()
{
	return get_counter() / fTimerFrequencyMHz;
}


int32
ARMGenericTimer::_InterruptWrapper(void *data)
{
	return ((ARMGenericTimer*)data)->HandleInterrupt();
}


int32
ARMGenericTimer::HandleInterrupt()
{
	return timer_interrupt();
}


ARMGenericTimer::ARMGenericTimer()
: HardwareTimer()
{
	Clear();

	install_io_interrupt_handler(TIMER_IRQ,
		&ARMGenericTimer::_InterruptWrapper, this, 0);

	fTimerFrequency = get_counter_freq();
	fTimerFrequencyMHz = fTimerFrequency / 1000000;
}


bool
ARMGenericTimer::IsAvailable()
{
	uint32_t pfr1;
	asm volatile("MRC p15, 0, %0, c0, c1, 1": "=r" (pfr1));
	return (pfr1 & 0x000F0000) == 0x00010000;
}