/* * linux/arch/arm/mach-sa1100/leds-cerf.c * * Author: ??? */ #include <linux/init.h> #include <asm/hardware.h> #include <asm/leds.h> #include <asm/system.h> #include "leds.h" #define LED_STATE_ENABLED 1 #define LED_STATE_CLAIMED 2 static unsigned int led_state; static unsigned int hw_led_state; #define LED_D0 GPIO_GPIO(0) #define LED_D1 GPIO_GPIO(1) #define LED_D2 GPIO_GPIO(2) #define LED_D3 GPIO_GPIO(3) #define LED_MASK (LED_D0|LED_D1|LED_D2|LED_D3) void cerf_leds_event(led_event_t evt) { unsigned long flags; local_irq_save(flags); switch (evt) { case led_start: hw_led_state = LED_MASK; led_state = LED_STATE_ENABLED; break; case led_stop: led_state &= ~LED_STATE_ENABLED; break; case led_claim: led_state |= LED_STATE_CLAIMED; hw_led_state = LED_MASK; break; case led_release: led_state &= ~LED_STATE_CLAIMED; hw_led_state = LED_MASK; break; #ifdef CONFIG_LEDS_TIMER case led_timer: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state ^= LED_D0; break; #endif #ifdef CONFIG_LEDS_CPU case led_idle_start: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state &= ~LED_D1; break; case led_idle_end: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state |= LED_D1; break; #endif case led_green_on: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state &= ~LED_D2; break; case led_green_off: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state |= LED_D2; break; case led_amber_on: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state &= ~LED_D3; break; case led_amber_off: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state |= LED_D3; break; case led_red_on: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state &= ~LED_D1; break; case led_red_off: if (!(led_state & LED_STATE_CLAIMED)) hw_led_state |= LED_D1; break; default: break; } if (led_state & LED_STATE_ENABLED) { GPSR = hw_led_state; GPCR = hw_led_state ^ LED_MASK; } local_irq_restore(flags); }