led.c

Go to the documentation of this file.

#include "led.h"

/* leds functions */
int led_leds_init( void )
{
        avr32_pio_t *led_port = (void *) LEDPORT_ADDR;
        char led_mask = 0xFF;

        led_port->per = led_mask<<LEDPORT_START;
        led_port->oer = led_mask<<LEDPORT_START;
        led_port->idr = led_mask<<LEDPORT_START;

        return LED_SUCCESS;
}

int led_set_leds(char mask)
{
        avr32_pio_t *led_port = (void *) LEDPORT_ADDR;
        led_port->codr = 0xFF<<LEDPORT_START;
        led_port->sodr = mask<<LEDPORT_START;

        return LED_SUCCESS;
}

int led_clear_leds(char mask)
{
        avr32_pio_t *led_port = (void *) LEDPORT_ADDR;
        led_port->codr = mask<<LEDPORT_START;

        return LED_SUCCESS;
}

/* rgb leds functions */
int led_rgb_init( void )
{
        avr32_pio_t *rgb_port = (void *) RGBPORT_ADDR;
        char led_mask = 0x3F;

        rgb_port->per = led_mask<<RGBPORT_START;
        rgb_port->oer = led_mask<<RGBPORT_START;
        rgb_port->idr = led_mask<<RGBPORT_START;

        return LED_SUCCESS;
}

int led_set_rgb(unsigned int position, unsigned char colour)
{
        avr32_pio_t *rgb_port = (void *) RGBPORT_ADDR;
        char rgb_mask = 0x3F;

        if( (position!=LEFT) | (position!=RIGHT) )
                return LED_INVALID_ARGUMENT;

        rgb_port->codr = rgb_mask<<(position+RGBPORT_START);
        rgb_port->sodr = colour<<(position+RGBPORT_START);

        return LED_SUCCESS;
}

int led_clear_rgb( unsigned int position)
{
        avr32_pio_t *rgb_port = (void *) RGBPORT_ADDR;
        char rgb_mask = 0x15;

        if( (position!=LEFT) | (position!=RIGHT) )
                return LED_INVALID_ARGUMENT;

        rgb_port->codr = rgb_mask<<(position+RGBPORT_START);

        return LED_SUCCESS;
}

---