]>
Commit | Line | Data |
---|---|---|
cc2832a1 AV |
1 | /* |
2 | * LED driver for Atmel AT91-based boards. | |
3 | * | |
4 | * Copyright (C) SAN People (Pty) Ltd | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or | |
7 | * modify it under the terms of the GNU General Public License | |
8 | * as published by the Free Software Foundation; either version | |
9 | * 2 of the License, or (at your option) any later version. | |
10 | */ | |
11 | ||
2f8163ba | 12 | #include <linux/gpio.h> |
cc2832a1 AV |
13 | #include <linux/kernel.h> |
14 | #include <linux/module.h> | |
15 | #include <linux/init.h> | |
a7307bf2 | 16 | #include <linux/platform_device.h> |
cc2832a1 | 17 | |
a09e64fb | 18 | #include <mach/board.h> |
cc2832a1 AV |
19 | |
20 | ||
a04ff1af AV |
21 | /* ------------------------------------------------------------------------- */ |
22 | ||
23 | #if defined(CONFIG_NEW_LEDS) | |
24 | ||
a04ff1af AV |
25 | /* |
26 | * New cross-platform LED support. | |
27 | */ | |
28 | ||
29 | static struct gpio_led_platform_data led_data; | |
30 | ||
791ccf2e | 31 | static struct platform_device at91_gpio_leds_device = { |
a04ff1af AV |
32 | .name = "leds-gpio", |
33 | .id = -1, | |
34 | .dev.platform_data = &led_data, | |
35 | }; | |
36 | ||
37 | void __init at91_gpio_leds(struct gpio_led *leds, int nr) | |
38 | { | |
39 | int i; | |
40 | ||
41 | if (!nr) | |
42 | return; | |
43 | ||
44 | for (i = 0; i < nr; i++) | |
45 | at91_set_gpio_output(leds[i].gpio, leds[i].active_low); | |
46 | ||
47 | led_data.leds = leds; | |
48 | led_data.num_leds = nr; | |
791ccf2e | 49 | platform_device_register(&at91_gpio_leds_device); |
a04ff1af AV |
50 | } |
51 | ||
52 | #else | |
53 | void __init at91_gpio_leds(struct gpio_led *leds, int nr) {} | |
54 | #endif | |
55 | ||
56 | ||
a7307bf2 AV |
57 | /* ------------------------------------------------------------------------- */ |
58 | ||
59 | #if defined (CONFIG_LEDS_ATMEL_PWM) | |
60 | ||
61 | /* | |
62 | * PWM Leds | |
63 | */ | |
64 | ||
65 | static struct gpio_led_platform_data pwm_led_data; | |
66 | ||
791ccf2e | 67 | static struct platform_device at91_pwm_leds_device = { |
a7307bf2 AV |
68 | .name = "leds-atmel-pwm", |
69 | .id = -1, | |
70 | .dev.platform_data = &pwm_led_data, | |
71 | }; | |
72 | ||
73 | void __init at91_pwm_leds(struct gpio_led *leds, int nr) | |
74 | { | |
75 | int i; | |
76 | u32 pwm_mask = 0; | |
77 | ||
78 | if (!nr) | |
79 | return; | |
80 | ||
81 | for (i = 0; i < nr; i++) | |
82 | pwm_mask |= (1 << leds[i].gpio); | |
83 | ||
84 | pwm_led_data.leds = leds; | |
85 | pwm_led_data.num_leds = nr; | |
86 | ||
87 | at91_add_device_pwm(pwm_mask); | |
791ccf2e | 88 | platform_device_register(&at91_pwm_leds_device); |
a7307bf2 AV |
89 | } |
90 | #else | |
91 | void __init at91_pwm_leds(struct gpio_led *leds, int nr){} | |
92 | #endif | |
93 | ||
94 | ||
a04ff1af AV |
95 | /* ------------------------------------------------------------------------- */ |
96 | ||
97 | #if defined(CONFIG_LEDS) | |
98 | ||
99 | #include <asm/leds.h> | |
100 | ||
101 | /* | |
102 | * Old ARM-specific LED framework; not fully functional when generic time is | |
103 | * in use. | |
104 | */ | |
105 | ||
106 | static u8 at91_leds_cpu; | |
107 | static u8 at91_leds_timer; | |
108 | ||
cc2832a1 AV |
109 | static inline void at91_led_on(unsigned int led) |
110 | { | |
111 | at91_set_gpio_value(led, 0); | |
112 | } | |
113 | ||
114 | static inline void at91_led_off(unsigned int led) | |
115 | { | |
116 | at91_set_gpio_value(led, 1); | |
117 | } | |
118 | ||
119 | static inline void at91_led_toggle(unsigned int led) | |
120 | { | |
121 | unsigned long is_off = at91_get_gpio_value(led); | |
122 | if (is_off) | |
123 | at91_led_on(led); | |
124 | else | |
125 | at91_led_off(led); | |
126 | } | |
127 | ||
128 | ||
129 | /* | |
130 | * Handle LED events. | |
131 | */ | |
132 | static void at91_leds_event(led_event_t evt) | |
133 | { | |
134 | unsigned long flags; | |
135 | ||
136 | local_irq_save(flags); | |
137 | ||
138 | switch(evt) { | |
139 | case led_start: /* System startup */ | |
140 | at91_led_on(at91_leds_cpu); | |
141 | break; | |
142 | ||
143 | case led_stop: /* System stop / suspend */ | |
144 | at91_led_off(at91_leds_cpu); | |
145 | break; | |
146 | ||
147 | #ifdef CONFIG_LEDS_TIMER | |
148 | case led_timer: /* Every 50 timer ticks */ | |
149 | at91_led_toggle(at91_leds_timer); | |
150 | break; | |
151 | #endif | |
152 | ||
153 | #ifdef CONFIG_LEDS_CPU | |
154 | case led_idle_start: /* Entering idle state */ | |
155 | at91_led_off(at91_leds_cpu); | |
156 | break; | |
157 | ||
158 | case led_idle_end: /* Exit idle state */ | |
159 | at91_led_on(at91_leds_cpu); | |
160 | break; | |
161 | #endif | |
162 | ||
163 | default: | |
164 | break; | |
165 | } | |
166 | ||
167 | local_irq_restore(flags); | |
168 | } | |
169 | ||
170 | ||
171 | static int __init leds_init(void) | |
172 | { | |
173 | if (!at91_leds_timer || !at91_leds_cpu) | |
174 | return -ENODEV; | |
175 | ||
cc2832a1 AV |
176 | leds_event = at91_leds_event; |
177 | ||
178 | leds_event(led_start); | |
179 | return 0; | |
180 | } | |
181 | ||
182 | __initcall(leds_init); | |
a04ff1af AV |
183 | |
184 | ||
185 | void __init at91_init_leds(u8 cpu_led, u8 timer_led) | |
186 | { | |
187 | /* Enable GPIO to access the LEDs */ | |
188 | at91_set_gpio_output(cpu_led, 1); | |
189 | at91_set_gpio_output(timer_led, 1); | |
190 | ||
191 | at91_leds_cpu = cpu_led; | |
192 | at91_leds_timer = timer_led; | |
193 | } | |
194 | ||
195 | #else | |
196 | void __init at91_init_leds(u8 cpu_led, u8 timer_led) {} | |
197 | #endif |