Subversion Repositories igor

#include <avr/io.h>

#include <stdint.h>

#include <stdlib.h>

#include <device.h>

/* Example device for adding device-specific hooks. */

#define LED_INIT 0xFE

#define LED_UNINIT 0x0F

#define LED_ERROR 0xF0

static igordev_read_fn_t led_read;

static igordev_init_fn_t led_init;

static igordev_write_fn_t led_write;

static igordev_deinit_fn_t led_deinit;

struct igordev igordev_ledstk500 = {

        .init = led_init,

        .deinit = led_deinit,

        .read = led_read,

        .write = led_write,

        .write_status = 0,

        .read_status = 0,

        .priv = NULL

};

/* Example initialization routine. */

void

led_init()

{

        /* Initialize buffers. Could probably be device-independent */

        igordev_ledstk500.read_status = igordev_ledstk500.write_status = IDEV_STATUS_OK;

        DDRC = 0xFF;

        /* Initialize skelton device-specific stuff. */

        PORTC = LED_INIT;

}

/* Example read routine. */

uint8_t

led_read(uint8_t *data, uint8_t num)

{

        if (num == 0)

                return (0);

        /* Read only the status of the device if num > 0 */

        /* Read data into device buffers and set pointer. */

        *data = PORTC;

        return (1);

}

/* Example write routine. */

uint8_t

led_write(uint8_t *data, uint8_t num)

{

        if (num == 0)

                return (0);

        PORTC = *data;

        return (0);

}

/* Deinit. */

void

led_deinit(void)

{

        PORTC = LED_UNINIT;

}