gpioa_at91.c

Go to the documentation of this file.

#include <arch/arm.h>

#include <stdlib.h>
#include <string.h>

#include <dev/gpio.h>

/* Reuse this code for single port devices. */
#if defined(PIO_ISR)
#define PIOA_ISR    PIO_ISR
#define PIOA_IMR    PIO_IMR
#define PIOA_IER    PIO_IER
#define PIOA_IDR    PIO_IDR
#endif

#if defined(PIOA_ISR)

static void PioIsrA(void *arg)
{
    GPIO_VECTOR *vct = (GPIO_VECTOR *)arg;
    unsigned int isr = inr(PIOA_ISR);

    while (isr) {
        if ((isr & 1) != 0 && vct->iov_handler) {
            (vct->iov_handler) (vct->iov_arg);
        }
        isr >>= 1;
        vct++;
    }
}

static int PioCtlA(int cmd, void *param, int bit)
{
    int rc = 0;
    unsigned int *ival = (unsigned int *) param;
    uint32_t enabled = inr(PIOA_IMR) & _BV(bit);

    /* Disable interrupt. */
    if (enabled) {
        outr(PIOA_IDR, _BV(bit));
    }
    switch (cmd) {
    case NUT_IRQCTL_STATUS:
        if (enabled) {
            *ival |= 1;
        } else {
            *ival &= ~1;
        }
        break;
    case NUT_IRQCTL_ENABLE:
        enabled = 1;
        break;
    case NUT_IRQCTL_DISABLE:
        enabled = 0;
        break;
    default:
        rc = -1;
        break;
    }

    /* Enable interrupt. */
    if (enabled) {
        outr(PIOA_IER, _BV(bit));
    }
    return rc;
}

#if defined(PIO_ISR)
GPIO_SIGNAL sig_GPIO = {
    &sig_PIO,   /* ios_sig */
    PioIsrA,    /* ios_handler */
    PioCtlA,    /* ios_ctl */
    NULL        /* ios_vector */
};
#else
GPIO_SIGNAL sig_GPIO1 = {
    &sig_PIOA,  /* ios_sig */
    PioIsrA,    /* ios_handler */
    PioCtlA,    /* ios_ctl */
    NULL        /* ios_vector */
};
#endif /* PIO_ISR */

#endif