sysirq_at91.c

Go to the documentation of this file.

#include "sysirq_at91.h"
#include <io/arm.h>
#include <cpu/irq.h>
#include <cpu/types.h>
#include <cfg/module.h>
#include <cfg/macros.h>

INLINE void pit_setEnable(bool enable)
{
    if (enable)
        PIT_MR |= BV(PITIEN);
    else
        PIT_MR &= ~BV(PITIEN);
}

static SysIrq sysirq_tab[] =
{
    /* PIT, Periodic Interval Timer (System timer)*/
    {
        .enabled = false,
        .setEnable = pit_setEnable,
        .handler = NULL,
    },
    /* TODO: add other system sources here */
};

STATIC_ASSERT(countof(sysirq_tab) == SYSIRQ_CNT);

static void sysirq_dispatcher(void) __attribute__ ((interrupt));
static void sysirq_dispatcher(void)
{
    for (unsigned i = 0; i < countof(sysirq_tab); i++)
    {
        if (sysirq_tab[i].enabled
         && sysirq_tab[i].handler)
            sysirq_tab[i].handler();
    }

    /* Inform hw that we have served the IRQ */
    AIC_EOICR = 0;
}

#define SYSIRQ_PRIORITY 0 


MOD_DEFINE(sysirq);

void sysirq_init(void)
{
    cpu_flags_t flags;
    IRQ_SAVE_DISABLE(flags);

    /* Disable all system interrupts */
    for (unsigned i = 0; i < countof(sysirq_tab); i++)
        sysirq_tab[i].setEnable(false);

    /* Set the vector. */
    AIC_SVR(SYSC_ID) = sysirq_dispatcher;
    /* Initialize to edge triggered with defined priority. */
    AIC_SMR(SYSC_ID) = AIC_SRCTYPE_INT_EDGE_TRIGGERED | SYSIRQ_PRIORITY;
    /* Clear pending interrupt */
    AIC_ICCR = BV(SYSC_ID);
    /* Enable the system IRQ */
    AIC_IECR = BV(SYSC_ID);

    IRQ_RESTORE(flags);
    MOD_INIT(sysirq);
}


void sysirq_setHandler(sysirq_t irq, sysirq_handler_t handler)
{
    ASSERT(irq < SYSIRQ_CNT);
    sysirq_tab[irq].handler = handler;
}

void sysirq_setEnable(sysirq_t irq, bool enable)
{
    ASSERT(irq < SYSIRQ_CNT);

    sysirq_tab[irq].setEnable(enable);
    sysirq_tab[irq].enabled = enable;
}

bool sysirq_enabled(sysirq_t irq)
{
    ASSERT(irq < SYSIRQ_CNT);

    return sysirq_tab[irq].enabled;
}