2 * linux/arch/arm/mach-pxa/leds-idp.c
4 * Copyright (C) 2000 John Dorsey <john+@cs.cmu.edu>
6 * Copyright (c) 2001 Jeff Sutherland <jeffs@accelent.com>
8 * Original (leds-footbridge.c) by Russell King
10 * Macros for actual LED manipulation should be in machine specific
11 * files in this 'mach' directory.
15 #include <linux/init.h>
17 #include <mach/hardware.h>
20 #include <mach/pxa25x.h>
25 #define LED_STATE_ENABLED 1
26 #define LED_STATE_CLAIMED 2
28 static unsigned int led_state;
29 static unsigned int hw_led_state;
31 void idp_leds_event(led_event_t evt)
35 local_irq_save(flags);
39 hw_led_state = IDP_HB_LED | IDP_BUSY_LED;
40 led_state = LED_STATE_ENABLED;
44 led_state &= ~LED_STATE_ENABLED;
48 led_state |= LED_STATE_CLAIMED;
49 hw_led_state = IDP_HB_LED | IDP_BUSY_LED;
53 led_state &= ~LED_STATE_CLAIMED;
54 hw_led_state = IDP_HB_LED | IDP_BUSY_LED;
57 #ifdef CONFIG_LEDS_TIMER
59 if (!(led_state & LED_STATE_CLAIMED))
60 hw_led_state ^= IDP_HB_LED;
64 #ifdef CONFIG_LEDS_CPU
66 if (!(led_state & LED_STATE_CLAIMED))
67 hw_led_state &= ~IDP_BUSY_LED;
71 if (!(led_state & LED_STATE_CLAIMED))
72 hw_led_state |= IDP_BUSY_LED;
80 if (led_state & LED_STATE_CLAIMED)
81 hw_led_state |= IDP_HB_LED;
85 if (led_state & LED_STATE_CLAIMED)
86 hw_led_state &= ~IDP_HB_LED;
96 if (led_state & LED_STATE_CLAIMED)
97 hw_led_state |= IDP_BUSY_LED;
101 if (led_state & LED_STATE_CLAIMED)
102 hw_led_state &= ~IDP_BUSY_LED;
109 if (led_state & LED_STATE_ENABLED)
110 IDP_CPLD_LED_CONTROL = ( (IDP_CPLD_LED_CONTROL | IDP_LEDS_MASK) & ~hw_led_state);
112 IDP_CPLD_LED_CONTROL |= IDP_LEDS_MASK;
114 local_irq_restore(flags);