advanced_dip_switch_lights.c

Go to the documentation of this file.

#include "../part.h"
#include "pio_defines.h"

/* colors */
#define black 0x00
#define red 0x01
#define green 0x04
#define yellow 0x05
#define blue 0x10
#define purple 0x11
#define light_blue 0x14
#define white 0x15
char color_array[8]={black,purple,blue,light_blue,green,yellow,red,white};

#define USE_RGB_LEDS 1

#define INPUT_BITMASK   0x0000ff00
#define OUTPUT_BITMASK  0x000000ff
#define BITMASK         0x000000ff

unsigned int log_2(unsigned int x);
unsigned int ones32(unsigned int x);

int main( void )
{
  avr32_pio_t *piob = (void *) AVR32_PIOB_ADDRESS;

  char input, output;

  /* SET PIO */
  piob->pdr = 0x00000000;
  piob->oer = OUTPUT_BITMASK;
  piob->odr = INPUT_BITMASK;
  piob->ifer = INPUT_BITMASK;
  piob->codr = 0xFFFFffff;

  while(1){
    input = (~(piob->pdsr >> 8) & BITMASK);
    output = (piob->pdsr) & BITMASK;
    if( input != output){
      piob->codr = OUTPUT_BITMASK;
      if(USE_RGB_LEDS)
        piob->sodr = color_array[ log_2(input) ] ;
      else
          piob->sodr = input;
    } //if

  }//while
}//main

unsigned int log_2(register unsigned int x)
{
        x |= (x >> 1);
        x |= (x >> 2);
        x |= (x >> 4);
        x |= (x >> 8);
        x |= (x >> 16);

        return(ones32(x >> 1));
}

unsigned int ones32(register unsigned int x)
{

        x -= ((x >> 1) & 0x55555555);
        x = (((x >> 2) & 0x33333333) + (x & 0x33333333));
        x = (((x >> 4) + x) & 0x0f0f0f0f);
        x += (x >> 8);
        x += (x >> 16);

        return(x & 0x0000003f);
}

---