diff options
Diffstat (limited to 'arch/arm/mach-pxa/leds-mainstone.c')
-rw-r--r-- | arch/arm/mach-pxa/leds-mainstone.c | 120 |
1 files changed, 120 insertions, 0 deletions
diff --git a/arch/arm/mach-pxa/leds-mainstone.c b/arch/arm/mach-pxa/leds-mainstone.c new file mode 100644 index 00000000000..db4af5eee8b --- /dev/null +++ b/arch/arm/mach-pxa/leds-mainstone.c | |||
@@ -0,0 +1,120 @@ | |||
1 | /* | ||
2 | * linux/arch/arm/mach-pxa/leds-mainstone.c | ||
3 | * | ||
4 | * Author: Nicolas Pitre | ||
5 | * Created: Nov 05, 2002 | ||
6 | * Copyright: MontaVista Software Inc. | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or modify | ||
9 | * it under the terms of the GNU General Public License version 2 as | ||
10 | * published by the Free Software Foundation. | ||
11 | */ | ||
12 | |||
13 | #include <linux/init.h> | ||
14 | |||
15 | #include <mach/hardware.h> | ||
16 | #include <asm/leds.h> | ||
17 | #include <asm/system.h> | ||
18 | |||
19 | #include <mach/pxa27x.h> | ||
20 | #include <mach/mainstone.h> | ||
21 | |||
22 | #include "leds.h" | ||
23 | |||
24 | |||
25 | /* 8 discrete leds available for general use: */ | ||
26 | #define D28 (1 << 0) | ||
27 | #define D27 (1 << 1) | ||
28 | #define D26 (1 << 2) | ||
29 | #define D25 (1 << 3) | ||
30 | #define D24 (1 << 4) | ||
31 | #define D23 (1 << 5) | ||
32 | #define D22 (1 << 6) | ||
33 | #define D21 (1 << 7) | ||
34 | |||
35 | #define LED_STATE_ENABLED 1 | ||
36 | #define LED_STATE_CLAIMED 2 | ||
37 | |||
38 | static unsigned int led_state; | ||
39 | static unsigned int hw_led_state; | ||
40 | |||
41 | void mainstone_leds_event(led_event_t evt) | ||
42 | { | ||
43 | unsigned long flags; | ||
44 | |||
45 | local_irq_save(flags); | ||
46 | |||
47 | switch (evt) { | ||
48 | case led_start: | ||
49 | hw_led_state = 0; | ||
50 | led_state = LED_STATE_ENABLED; | ||
51 | break; | ||
52 | |||
53 | case led_stop: | ||
54 | led_state &= ~LED_STATE_ENABLED; | ||
55 | break; | ||
56 | |||
57 | case led_claim: | ||
58 | led_state |= LED_STATE_CLAIMED; | ||
59 | hw_led_state = 0; | ||
60 | break; | ||
61 | |||
62 | case led_release: | ||
63 | led_state &= ~LED_STATE_CLAIMED; | ||
64 | hw_led_state = 0; | ||
65 | break; | ||
66 | |||
67 | #ifdef CONFIG_LEDS_TIMER | ||
68 | case led_timer: | ||
69 | hw_led_state ^= D26; | ||
70 | break; | ||
71 | #endif | ||
72 | |||
73 | #ifdef CONFIG_LEDS_CPU | ||
74 | case led_idle_start: | ||
75 | hw_led_state &= ~D27; | ||
76 | break; | ||
77 | |||
78 | case led_idle_end: | ||
79 | hw_led_state |= D27; | ||
80 | break; | ||
81 | #endif | ||
82 | |||
83 | case led_halted: | ||
84 | break; | ||
85 | |||
86 | case led_green_on: | ||
87 | hw_led_state |= D21; | ||
88 | break; | ||
89 | |||
90 | case led_green_off: | ||
91 | hw_led_state &= ~D21; | ||
92 | break; | ||
93 | |||
94 | case led_amber_on: | ||
95 | hw_led_state |= D22; | ||
96 | break; | ||
97 | |||
98 | case led_amber_off: | ||
99 | hw_led_state &= ~D22; | ||
100 | break; | ||
101 | |||
102 | case led_red_on: | ||
103 | hw_led_state |= D23; | ||
104 | break; | ||
105 | |||
106 | case led_red_off: | ||
107 | hw_led_state &= ~D23; | ||
108 | break; | ||
109 | |||
110 | default: | ||
111 | break; | ||
112 | } | ||
113 | |||
114 | if (led_state & LED_STATE_ENABLED) | ||
115 | MST_LEDCTRL = (MST_LEDCTRL | 0xff) & ~hw_led_state; | ||
116 | else | ||
117 | MST_LEDCTRL |= 0xff; | ||
118 | |||
119 | local_irq_restore(flags); | ||
120 | } | ||