generic_timer/generic_timer.c

Go to the documentation of this file.

#include <generic_timer.h>
#include <hvmm_trace.h>
#include "generic_timer_regs.h"

#include <config/cfg_platform.h>

static void _generic_timer_hyp_irq_handler(int irq, void *regs, void *pdata);

static uint32_t _timer_irqs[GENERIC_TIMER_NUM_TYPES];
static uint32_t _tvals[GENERIC_TIMER_NUM_TYPES];
static generic_timer_callback_t _callback[GENERIC_TIMER_NUM_TYPES];

hvmm_status_t generic_timer_init()
{
    _timer_irqs[GENERIC_TIMER_HYP] = 26;
    _timer_irqs[GENERIC_TIMER_NSP] = 27;
    _timer_irqs[GENERIC_TIMER_VIR] = 30;

    return HVMM_STATUS_SUCCESS;
}


hvmm_status_t generic_timer_set_tval(generic_timer_type_t type, uint32_t tval)
{
    hvmm_status_t result = HVMM_STATUS_UNSUPPORTED_FEATURE;

    if ( type == GENERIC_TIMER_HYP) {
        _tvals[type] = tval;
        generic_timer_reg_write(GENERIC_TIMER_REG_HYP_TVAL, tval);
        result = HVMM_STATUS_SUCCESS;
    } else {
    }

    return result;
}

hvmm_status_t generic_timer_enable_int(generic_timer_type_t type )
{
    uint32_t ctrl;
    hvmm_status_t result = HVMM_STATUS_UNSUPPORTED_FEATURE;

    if ( type == GENERIC_TIMER_HYP ) {
        ctrl = generic_timer_reg_read(GENERIC_TIMER_REG_HYP_CTRL);
        ctrl |= GENERIC_TIMER_CTRL_ENABLE;      
        ctrl &= ~GENERIC_TIMER_CTRL_IMASK;
    
        generic_timer_reg_write(GENERIC_TIMER_REG_HYP_CTRL, ctrl);
        result = HVMM_STATUS_SUCCESS;
    }

    return result;
}

hvmm_status_t generic_timer_disable_int(generic_timer_type_t type)
{
    uint32_t ctrl;
    hvmm_status_t result = HVMM_STATUS_UNSUPPORTED_FEATURE;

    if ( type == GENERIC_TIMER_HYP ) {
        ctrl = generic_timer_reg_read(GENERIC_TIMER_REG_HYP_CTRL);
        ctrl &= ~GENERIC_TIMER_CTRL_ENABLE;
        ctrl |= GENERIC_TIMER_CTRL_IMASK;

        generic_timer_reg_write(GENERIC_TIMER_REG_HYP_CTRL, ctrl);
        result = HVMM_STATUS_SUCCESS;
    }

    return result;
}

static void _generic_timer_hyp_irq_handler(int irq, void *regs, void *pdata)
{
    _callback[GENERIC_TIMER_HYP](regs);
}

hvmm_status_t generic_timer_enable_irq(generic_timer_type_t type)
{
    hvmm_status_t result = HVMM_STATUS_UNSUPPORTED_FEATURE;

    if ( type == GENERIC_TIMER_HYP ) {
        uint32_t irq = _timer_irqs[type];

        gic_test_set_irq_handler(irq, &_generic_timer_hyp_irq_handler, 0);

        gic_test_configure_irq(irq,
            GIC_INT_POLARITY_LEVEL, 
            gic_cpumask_current(),
            GIC_INT_PRIORITY_DEFAULT );

        result = HVMM_STATUS_SUCCESS;
    }
    return result;
}

hvmm_status_t generic_timer_set_callback(generic_timer_type_t type, generic_timer_callback_t callback)
{
    HVMM_TRACE_ENTER();

    _callback[type] = callback;

    HVMM_TRACE_EXIT();
    return HVMM_STATUS_SUCCESS;
}