Commit | Line | Data |
---|---|---|
22e03f3b RA |
1 | /* |
2 | * LEDs driver for GPIOs | |
3 | * | |
4 | * Copyright (C) 2007 8D Technologies inc. | |
5 | * Raphael Assenat <raph@8d.com> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License version 2 as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | */ | |
12 | #include <linux/kernel.h> | |
13 | #include <linux/init.h> | |
14 | #include <linux/platform_device.h> | |
15 | #include <linux/leds.h> | |
00852279 DB |
16 | #include <linux/workqueue.h> |
17 | ||
22e03f3b RA |
18 | #include <asm/gpio.h> |
19 | ||
20 | struct gpio_led_data { | |
21 | struct led_classdev cdev; | |
22 | unsigned gpio; | |
00852279 DB |
23 | struct work_struct work; |
24 | u8 new_level; | |
25 | u8 can_sleep; | |
22e03f3b | 26 | u8 active_low; |
ca3259b3 HVR |
27 | int (*platform_gpio_blink_set)(unsigned gpio, |
28 | unsigned long *delay_on, unsigned long *delay_off); | |
22e03f3b RA |
29 | }; |
30 | ||
00852279 DB |
31 | static void gpio_led_work(struct work_struct *work) |
32 | { | |
33 | struct gpio_led_data *led_dat = | |
34 | container_of(work, struct gpio_led_data, work); | |
35 | ||
36 | gpio_set_value_cansleep(led_dat->gpio, led_dat->new_level); | |
37 | } | |
22e03f3b RA |
38 | |
39 | static void gpio_led_set(struct led_classdev *led_cdev, | |
40 | enum led_brightness value) | |
41 | { | |
42 | struct gpio_led_data *led_dat = | |
43 | container_of(led_cdev, struct gpio_led_data, cdev); | |
44 | int level; | |
45 | ||
46 | if (value == LED_OFF) | |
47 | level = 0; | |
48 | else | |
49 | level = 1; | |
50 | ||
51 | if (led_dat->active_low) | |
52 | level = !level; | |
53 | ||
306dd85c DB |
54 | /* Setting GPIOs with I2C/etc requires a task context, and we don't |
55 | * seem to have a reliable way to know if we're already in one; so | |
56 | * let's just assume the worst. | |
57 | */ | |
00852279 | 58 | if (led_dat->can_sleep) { |
306dd85c DB |
59 | led_dat->new_level = level; |
60 | schedule_work(&led_dat->work); | |
00852279 DB |
61 | } else |
62 | gpio_set_value(led_dat->gpio, level); | |
22e03f3b RA |
63 | } |
64 | ||
ca3259b3 HVR |
65 | static int gpio_blink_set(struct led_classdev *led_cdev, |
66 | unsigned long *delay_on, unsigned long *delay_off) | |
67 | { | |
68 | struct gpio_led_data *led_dat = | |
69 | container_of(led_cdev, struct gpio_led_data, cdev); | |
70 | ||
71 | return led_dat->platform_gpio_blink_set(led_dat->gpio, delay_on, delay_off); | |
72 | } | |
73 | ||
199fb21d | 74 | static int gpio_led_probe(struct platform_device *pdev) |
22e03f3b RA |
75 | { |
76 | struct gpio_led_platform_data *pdata = pdev->dev.platform_data; | |
77 | struct gpio_led *cur_led; | |
78 | struct gpio_led_data *leds_data, *led_dat; | |
79 | int i, ret = 0; | |
80 | ||
81 | if (!pdata) | |
82 | return -EBUSY; | |
83 | ||
84 | leds_data = kzalloc(sizeof(struct gpio_led_data) * pdata->num_leds, | |
85 | GFP_KERNEL); | |
86 | if (!leds_data) | |
87 | return -ENOMEM; | |
88 | ||
89 | for (i = 0; i < pdata->num_leds; i++) { | |
90 | cur_led = &pdata->leds[i]; | |
91 | led_dat = &leds_data[i]; | |
92 | ||
d95cbe61 UKK |
93 | ret = gpio_request(cur_led->gpio, cur_led->name); |
94 | if (ret < 0) | |
95 | goto err; | |
96 | ||
22e03f3b RA |
97 | led_dat->cdev.name = cur_led->name; |
98 | led_dat->cdev.default_trigger = cur_led->default_trigger; | |
99 | led_dat->gpio = cur_led->gpio; | |
00852279 | 100 | led_dat->can_sleep = gpio_cansleep(cur_led->gpio); |
22e03f3b | 101 | led_dat->active_low = cur_led->active_low; |
ca3259b3 HVR |
102 | if (pdata->gpio_blink_set) { |
103 | led_dat->platform_gpio_blink_set = pdata->gpio_blink_set; | |
104 | led_dat->cdev.blink_set = gpio_blink_set; | |
105 | } | |
22e03f3b | 106 | led_dat->cdev.brightness_set = gpio_led_set; |
2b7f1b8c | 107 | led_dat->cdev.brightness = LED_OFF; |
859cb7f2 | 108 | led_dat->cdev.flags |= LED_CORE_SUSPENDRESUME; |
22e03f3b | 109 | |
22e03f3b RA |
110 | gpio_direction_output(led_dat->gpio, led_dat->active_low); |
111 | ||
199fb21d DB |
112 | INIT_WORK(&led_dat->work, gpio_led_work); |
113 | ||
22e03f3b RA |
114 | ret = led_classdev_register(&pdev->dev, &led_dat->cdev); |
115 | if (ret < 0) { | |
116 | gpio_free(led_dat->gpio); | |
117 | goto err; | |
118 | } | |
119 | } | |
120 | ||
121 | platform_set_drvdata(pdev, leds_data); | |
122 | ||
123 | return 0; | |
124 | ||
125 | err: | |
126 | if (i > 0) { | |
127 | for (i = i - 1; i >= 0; i--) { | |
128 | led_classdev_unregister(&leds_data[i].cdev); | |
199fb21d | 129 | cancel_work_sync(&leds_data[i].work); |
22e03f3b RA |
130 | gpio_free(leds_data[i].gpio); |
131 | } | |
132 | } | |
00852279 | 133 | |
22e03f3b RA |
134 | kfree(leds_data); |
135 | ||
136 | return ret; | |
137 | } | |
138 | ||
199fb21d | 139 | static int __devexit gpio_led_remove(struct platform_device *pdev) |
22e03f3b RA |
140 | { |
141 | int i; | |
142 | struct gpio_led_platform_data *pdata = pdev->dev.platform_data; | |
143 | struct gpio_led_data *leds_data; | |
144 | ||
145 | leds_data = platform_get_drvdata(pdev); | |
146 | ||
147 | for (i = 0; i < pdata->num_leds; i++) { | |
148 | led_classdev_unregister(&leds_data[i].cdev); | |
199fb21d | 149 | cancel_work_sync(&leds_data[i].work); |
22e03f3b RA |
150 | gpio_free(leds_data[i].gpio); |
151 | } | |
199fb21d | 152 | |
22e03f3b RA |
153 | kfree(leds_data); |
154 | ||
155 | return 0; | |
156 | } | |
157 | ||
22e03f3b | 158 | static struct platform_driver gpio_led_driver = { |
199fb21d DB |
159 | .probe = gpio_led_probe, |
160 | .remove = __devexit_p(gpio_led_remove), | |
22e03f3b RA |
161 | .driver = { |
162 | .name = "leds-gpio", | |
163 | .owner = THIS_MODULE, | |
164 | }, | |
165 | }; | |
166 | ||
167 | static int __init gpio_led_init(void) | |
168 | { | |
199fb21d | 169 | return platform_driver_register(&gpio_led_driver); |
22e03f3b RA |
170 | } |
171 | ||
172 | static void __exit gpio_led_exit(void) | |
173 | { | |
174 | platform_driver_unregister(&gpio_led_driver); | |
175 | } | |
176 | ||
177 | module_init(gpio_led_init); | |
178 | module_exit(gpio_led_exit); | |
179 | ||
180 | MODULE_AUTHOR("Raphael Assenat <raph@8d.com>"); | |
181 | MODULE_DESCRIPTION("GPIO LED driver"); | |
182 | MODULE_LICENSE("GPL"); | |
3c4ded97 | 183 | MODULE_ALIAS("platform:leds-gpio"); |