@ -51,49 +51,49 @@ void coloured_LED_init(void)
at91_set_pio_value ( CONFIG_BLUE_LED , 1 ) ;
at91_set_pio_value ( CONFIG_BLUE_LED , 1 ) ;
}
}
void red_LED _off ( void )
void red_led _off ( void )
{
{
at91_set_pio_value ( CONFIG_RED_LED , 1 ) ;
at91_set_pio_value ( CONFIG_RED_LED , 1 ) ;
saved_state [ STATUS_LED_RED ] = STATUS_LED_OFF ;
saved_state [ STATUS_LED_RED ] = STATUS_LED_OFF ;
}
}
void green_LED _off ( void )
void green_led _off ( void )
{
{
at91_set_pio_value ( CONFIG_GREEN_LED , 1 ) ;
at91_set_pio_value ( CONFIG_GREEN_LED , 1 ) ;
saved_state [ STATUS_LED_GREEN ] = STATUS_LED_OFF ;
saved_state [ STATUS_LED_GREEN ] = STATUS_LED_OFF ;
}
}
void yellow_LED _off ( void )
void yellow_led _off ( void )
{
{
at91_set_pio_value ( CONFIG_YELLOW_LED , 1 ) ;
at91_set_pio_value ( CONFIG_YELLOW_LED , 1 ) ;
saved_state [ STATUS_LED_YELLOW ] = STATUS_LED_OFF ;
saved_state [ STATUS_LED_YELLOW ] = STATUS_LED_OFF ;
}
}
void blue_LED _off ( void )
void blue_led _off ( void )
{
{
at91_set_pio_value ( CONFIG_BLUE_LED , 1 ) ;
at91_set_pio_value ( CONFIG_BLUE_LED , 1 ) ;
saved_state [ STATUS_LED_BLUE ] = STATUS_LED_OFF ;
saved_state [ STATUS_LED_BLUE ] = STATUS_LED_OFF ;
}
}
void red_LED _on ( void )
void red_led _on ( void )
{
{
at91_set_pio_value ( CONFIG_RED_LED , 0 ) ;
at91_set_pio_value ( CONFIG_RED_LED , 0 ) ;
saved_state [ STATUS_LED_RED ] = STATUS_LED_ON ;
saved_state [ STATUS_LED_RED ] = STATUS_LED_ON ;
}
}
void green_LED _on ( void )
void green_led _on ( void )
{
{
at91_set_pio_value ( CONFIG_GREEN_LED , 0 ) ;
at91_set_pio_value ( CONFIG_GREEN_LED , 0 ) ;
saved_state [ STATUS_LED_GREEN ] = STATUS_LED_ON ;
saved_state [ STATUS_LED_GREEN ] = STATUS_LED_ON ;
}
}
void yellow_LED _on ( void )
void yellow_led _on ( void )
{
{
at91_set_pio_value ( CONFIG_YELLOW_LED , 0 ) ;
at91_set_pio_value ( CONFIG_YELLOW_LED , 0 ) ;
saved_state [ STATUS_LED_YELLOW ] = STATUS_LED_ON ;
saved_state [ STATUS_LED_YELLOW ] = STATUS_LED_ON ;
}
}
void blue_LED _on ( void )
void blue_led _on ( void )
{
{
at91_set_pio_value ( CONFIG_BLUE_LED , 0 ) ;
at91_set_pio_value ( CONFIG_BLUE_LED , 0 ) ;
saved_state [ STATUS_LED_BLUE ] = STATUS_LED_ON ;
saved_state [ STATUS_LED_BLUE ] = STATUS_LED_ON ;
@ -108,24 +108,24 @@ void __led_toggle(led_id_t mask)
{
{
if ( STATUS_LED_BLUE = = mask ) {
if ( STATUS_LED_BLUE = = mask ) {
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_BLUE ] )
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_BLUE ] )
blue_LED _off ( ) ;
blue_led _off ( ) ;
else
else
blue_LED _on ( ) ;
blue_led _on ( ) ;
} else if ( STATUS_LED_RED = = mask ) {
} else if ( STATUS_LED_RED = = mask ) {
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_RED ] )
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_RED ] )
red_LED _off ( ) ;
red_led _off ( ) ;
else
else
red_LED _on ( ) ;
red_led _on ( ) ;
} else if ( STATUS_LED_GREEN = = mask ) {
} else if ( STATUS_LED_GREEN = = mask ) {
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_GREEN ] )
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_GREEN ] )
green_LED _off ( ) ;
green_led _off ( ) ;
else
else
green_LED _on ( ) ;
green_led _on ( ) ;
} else if ( STATUS_LED_YELLOW = = mask ) {
} else if ( STATUS_LED_YELLOW = = mask ) {
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_YELLOW ] )
if ( STATUS_LED_ON = = saved_state [ STATUS_LED_YELLOW ] )
yellow_LED _off ( ) ;
yellow_led _off ( ) ;
else
else
yellow_LED _on ( ) ;
yellow_led _on ( ) ;
}
}
}
}
@ -133,23 +133,23 @@ void __led_set(led_id_t mask, int state)
{
{
if ( STATUS_LED_BLUE = = mask ) {
if ( STATUS_LED_BLUE = = mask ) {
if ( STATUS_LED_ON = = state )
if ( STATUS_LED_ON = = state )
blue_LED _on ( ) ;
blue_led _on ( ) ;
else
else
blue_LED _off ( ) ;
blue_led _off ( ) ;
} else if ( STATUS_LED_RED = = mask ) {
} else if ( STATUS_LED_RED = = mask ) {
if ( STATUS_LED_ON = = state )
if ( STATUS_LED_ON = = state )
red_LED _on ( ) ;
red_led _on ( ) ;
else
else
red_LED _off ( ) ;
red_led _off ( ) ;
} else if ( STATUS_LED_GREEN = = mask ) {
} else if ( STATUS_LED_GREEN = = mask ) {
if ( STATUS_LED_ON = = state )
if ( STATUS_LED_ON = = state )
green_LED _on ( ) ;
green_led _on ( ) ;
else
else
green_LED _off ( ) ;
green_led _off ( ) ;
} else if ( STATUS_LED_YELLOW = = mask ) {
} else if ( STATUS_LED_YELLOW = = mask ) {
if ( STATUS_LED_ON = = state )
if ( STATUS_LED_ON = = state )
yellow_LED _on ( ) ;
yellow_led _on ( ) ;
else
else
yellow_LED _off ( ) ;
yellow_led _off ( ) ;
}
}
}
}