arch/avr32/softirq.c

Go to the documentation of this file.

#include <compiler.h>
#include <interrupt.h>
#include <softirq.h>
#include <util.h>

#include <app/softirq.h>

struct softirq_desc {
        softirq_handler_t       handler;
        void                    *data;
};

unsigned long softirq_priv_status;

static struct softirq_desc softirq_table[SOFTIRQ_NR_IDS];

void softirq_set_handler(unsigned int id, softirq_handler_t handler, void *data)
{
        struct softirq_desc     *desc;

        build_assert(ARRAY_LEN(softirq_table)
                        <= 8 * sizeof(softirq_priv_status));
        assert(id < ARRAY_LEN(softirq_table));
        assert(handler);

        desc = &softirq_table[id];
        desc->handler = handler;
        desc->data = data;
}

void softirq_priv_do_pending(void)
{
        struct softirq_desc     *desc;
        unsigned int            id;

        assert(!cpu_irq_is_enabled());
        assert(!(sysreg_read(SR) & (SYSREG_SR_IM(0) | SYSREG_SR_IM(1)
                                        | SYSREG_SR_IM(2) | SYSREG_SR_IM(3))));
        assert(softirq_priv_status);

        do {
                id = __ffs(softirq_priv_status);
                assert(id < ARRAY_LEN(softirq_table));
                clear_bit(id, &softirq_priv_status);

                cpu_irq_enable();

                desc = &softirq_table[id];
                assert(desc->handler);
                desc->handler(desc->data);

                cpu_irq_disable();
        } while (softirq_priv_status);

        assert(!cpu_irq_is_enabled());
}

void softirq_enable(void)
{
        assert(cpu_irq_is_enabled());

        cpu_irq_disable();
        if (softirq_priv_status)
                softirq_priv_do_pending();
        avr32_clear_sr_bit(SYSREG_SR_T_BIT);
        cpu_irq_enable();
}

---