1
2
3
4
5
6
7
8
9
10
11
12#include <linux/gpio.h>
13#include <linux/kernel.h>
14#include <linux/module.h>
15#include <linux/init.h>
16#include <linux/platform_device.h>
17
18#include "board.h"
19
20
21
22
23#if defined(CONFIG_NEW_LEDS)
24
25
26
27
28
29static struct gpio_led_platform_data led_data;
30
31static struct platform_device at91_gpio_leds_device = {
32 .name = "leds-gpio",
33 .id = -1,
34 .dev.platform_data = &led_data,
35};
36
37void __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;
49 platform_device_register(&at91_gpio_leds_device);
50}
51
52#else
53void __init at91_gpio_leds(struct gpio_led *leds, int nr) {}
54#endif
55
56
57
58
59#if defined (CONFIG_LEDS_ATMEL_PWM)
60
61
62
63
64
65static struct gpio_led_platform_data pwm_led_data;
66
67static struct platform_device at91_pwm_leds_device = {
68 .name = "leds-atmel-pwm",
69 .id = -1,
70 .dev.platform_data = &pwm_led_data,
71};
72
73void __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);
88 platform_device_register(&at91_pwm_leds_device);
89}
90#else
91void __init at91_pwm_leds(struct gpio_led *leds, int nr){}
92#endif
93