v2.4.8 -> v2.4.8.1
[opensuse:kernel.git] / arch / arm / mach-sa1100 / leds-cerf.c
1 /*
2  * linux/arch/arm/mach-sa1100/leds-cerf.c
3  *
4  * Author: ???
5  */
6 #include <linux/config.h>
7 #include <linux/init.h>
8
9 #include <asm/hardware.h>
10 #include <asm/leds.h>
11 #include <asm/system.h>
12
13 #include "leds.h"
14
15
16 #define LED_STATE_ENABLED       1
17 #define LED_STATE_CLAIMED       2
18
19 static unsigned int led_state;
20 static unsigned int hw_led_state;
21
22 #define LED_D0          GPIO_GPIO(0)
23 #define LED_D1          GPIO_GPIO(1)
24 #define LED_D2          GPIO_GPIO(2)
25 #define LED_D3          GPIO_GPIO(3)
26 #define LED_MASK        (LED_D0|LED_D1|LED_D2|LED_D3)
27
28 void cerf_leds_event(led_event_t evt)
29 {
30         unsigned long flags;
31
32         local_irq_save(flags);
33
34         switch (evt) {
35         case led_start:
36                 hw_led_state = LED_MASK;
37                 led_state = LED_STATE_ENABLED;
38                 break;
39
40         case led_stop:
41                 led_state &= ~LED_STATE_ENABLED;
42                 break;
43
44         case led_claim:
45                 led_state |= LED_STATE_CLAIMED;
46                 hw_led_state = LED_MASK;
47                 break;
48         case led_release:
49                 led_state &= ~LED_STATE_CLAIMED;
50                 hw_led_state = LED_MASK;
51                 break;
52
53 #ifdef CONFIG_LEDS_TIMER
54         case led_timer:
55                 if (!(led_state & LED_STATE_CLAIMED))
56                         hw_led_state ^= LED_D0;
57                 break;
58 #endif
59
60 #ifdef CONFIG_LEDS_CPU
61         case led_idle_start:
62                 if (!(led_state & LED_STATE_CLAIMED))
63                         hw_led_state &= ~LED_D1;
64                 break;
65
66         case led_idle_end:
67                 if (!(led_state & LED_STATE_CLAIMED))
68                         hw_led_state |= LED_D1;
69                 break;
70 #endif
71         case led_green_on:
72                 if (!(led_state & LED_STATE_CLAIMED))
73                         hw_led_state &= ~LED_D2;
74                 break;
75
76         case led_green_off:
77                 if (!(led_state & LED_STATE_CLAIMED))
78                         hw_led_state |= LED_D2;
79                 break;
80
81         case led_amber_on:
82                 if (!(led_state & LED_STATE_CLAIMED))
83                         hw_led_state &= ~LED_D3;
84                 break;
85
86         case led_amber_off:
87                 if (!(led_state & LED_STATE_CLAIMED))
88                         hw_led_state |= LED_D3;
89                 break;
90
91         case led_red_on:
92                 if (!(led_state & LED_STATE_CLAIMED))
93                         hw_led_state &= ~LED_D1;
94                 break;
95
96         case led_red_off:
97                 if (!(led_state & LED_STATE_CLAIMED))
98                         hw_led_state |= LED_D1;
99                 break;
100
101         default:
102                 break;
103         }
104
105         if  (led_state & LED_STATE_ENABLED) {
106                 GPSR = hw_led_state;
107                 GPCR = hw_led_state ^ LED_MASK;
108         }
109
110         local_irq_restore(flags);
111 }