Merge branch '83xx' into for_paulus
[linux-2.6] / drivers / leds / leds-ixp4xx-gpio.c
1 /*
2  * IXP4XX GPIO driver LED driver
3  *
4  * Author: John Bowler <jbowler@acm.org>
5  *
6  * Copyright (c) 2006 John Bowler
7  *
8  * Permission is hereby granted, free of charge, to any
9  * person obtaining a copy of this software and associated
10  * documentation files (the "Software"), to deal in the
11  * Software without restriction, including without
12  * limitation the rights to use, copy, modify, merge,
13  * publish, distribute, sublicense, and/or sell copies of
14  * the Software, and to permit persons to whom the
15  * Software is furnished to do so, subject to the
16  * following conditions:
17  *
18  * The above copyright notice and this permission notice
19  * shall be included in all copies or substantial portions
20  * of the Software.
21  *
22  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF
23  * ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED
24  * TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A
25  * PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT
26  * SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR
27  * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
29  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
30  * OTHER DEALINGS IN THE SOFTWARE.
31  *
32  */
33
34 #include <linux/kernel.h>
35 #include <linux/init.h>
36 #include <linux/platform_device.h>
37 #include <linux/spinlock.h>
38 #include <linux/leds.h>
39 #include <asm/arch/hardware.h>
40
41 extern spinlock_t gpio_lock;
42
43 /* Up to 16 gpio lines are possible. */
44 #define GPIO_MAX 16
45 static struct ixp4xxgpioled_device {
46         struct led_classdev ancestor;
47         int               flags;
48 } ixp4xxgpioled_devices[GPIO_MAX];
49
50 void ixp4xxgpioled_brightness_set(struct led_classdev *pled,
51                                 enum led_brightness value)
52 {
53         const struct ixp4xxgpioled_device *const ixp4xx_dev =
54                 container_of(pled, struct ixp4xxgpioled_device, ancestor);
55         const u32 gpio_pin = ixp4xx_dev - ixp4xxgpioled_devices;
56
57         if (gpio_pin < GPIO_MAX && ixp4xx_dev->ancestor.name != 0) {
58                 /* Set or clear the 'gpio_pin' bit according to the style
59                  * and the required setting (value > 0 == on)
60                  */
61                 const int gpio_value =
62                         (value > 0) == (ixp4xx_dev->flags != IXP4XX_GPIO_LOW) ?
63                                 IXP4XX_GPIO_HIGH : IXP4XX_GPIO_LOW;
64
65                 {
66                         unsigned long flags;
67                         spin_lock_irqsave(&gpio_lock, flags);
68                         gpio_line_set(gpio_pin, gpio_value);
69                         spin_unlock_irqrestore(&gpio_lock, flags);
70                 }
71         }
72 }
73
74 /* LEDs are described in resources, the following iterates over the valid
75  * LED resources.
76  */
77 #define for_all_leds(i, pdev) \
78         for (i=0; i<pdev->num_resources; ++i) \
79                 if (pdev->resource[i].start < GPIO_MAX && \
80                         pdev->resource[i].name != 0)
81
82 /* The following applies 'operation' to each LED from the given platform,
83  * the function always returns 0 to allow tail call elimination.
84  */
85 static int apply_to_all_leds(struct platform_device *pdev,
86         void (*operation)(struct led_classdev *pled))
87 {
88         int i;
89
90         for_all_leds(i, pdev)
91                 operation(&ixp4xxgpioled_devices[pdev->resource[i].start].ancestor);
92         return 0;
93 }
94
95 #ifdef CONFIG_PM
96 static int ixp4xxgpioled_suspend(struct platform_device *pdev,
97                                 pm_message_t state)
98 {
99         return apply_to_all_leds(pdev, led_classdev_suspend);
100 }
101
102 static int ixp4xxgpioled_resume(struct platform_device *pdev)
103 {
104         return apply_to_all_leds(pdev, led_classdev_resume);
105 }
106 #endif
107
108 static void ixp4xxgpioled_remove_one_led(struct led_classdev *pled)
109 {
110         led_classdev_unregister(pled);
111         pled->name = 0;
112 }
113
114 static int ixp4xxgpioled_remove(struct platform_device *pdev)
115 {
116         return apply_to_all_leds(pdev, ixp4xxgpioled_remove_one_led);
117 }
118
119 static int ixp4xxgpioled_probe(struct platform_device *pdev)
120 {
121         /* The board level has to tell the driver where the
122          * LEDs are connected - there is no way to find out
123          * electrically.  It must also say whether the GPIO
124          * lines are active high or active low.
125          *
126          * To do this read the num_resources (the number of
127          * LEDs) and the struct resource (the data for each
128          * LED).  The name comes from the resource, and it
129          * isn't copied.
130          */
131         int i;
132
133         for_all_leds(i, pdev) {
134                 const u8 gpio_pin = pdev->resource[i].start;
135                 int      rc;
136
137                 if (ixp4xxgpioled_devices[gpio_pin].ancestor.name == 0) {
138                         unsigned long flags;
139
140                         spin_lock_irqsave(&gpio_lock, flags);
141                         gpio_line_config(gpio_pin, IXP4XX_GPIO_OUT);
142                         /* The config can, apparently, reset the state,
143                          * I suspect the gpio line may be an input and
144                          * the config may cause the line to be latched,
145                          * so the setting depends on how the LED is
146                          * connected to the line (which affects how it
147                          * floats if not driven).
148                          */
149                         gpio_line_set(gpio_pin, IXP4XX_GPIO_HIGH);
150                         spin_unlock_irqrestore(&gpio_lock, flags);
151
152                         ixp4xxgpioled_devices[gpio_pin].flags =
153                                 pdev->resource[i].flags & IORESOURCE_BITS;
154
155                         ixp4xxgpioled_devices[gpio_pin].ancestor.name =
156                                 pdev->resource[i].name;
157
158                         /* This is how a board manufacturer makes the LED
159                          * come on on reset - the GPIO line will be high, so
160                          * make the LED light when the line is low...
161                          */
162                         if (ixp4xxgpioled_devices[gpio_pin].flags != IXP4XX_GPIO_LOW)
163                                 ixp4xxgpioled_devices[gpio_pin].ancestor.brightness = 100;
164                         else
165                                 ixp4xxgpioled_devices[gpio_pin].ancestor.brightness = 0;
166
167                         ixp4xxgpioled_devices[gpio_pin].ancestor.flags = 0;
168
169                         ixp4xxgpioled_devices[gpio_pin].ancestor.brightness_set =
170                                 ixp4xxgpioled_brightness_set;
171
172                         ixp4xxgpioled_devices[gpio_pin].ancestor.default_trigger = 0;
173                 }
174
175                 rc = led_classdev_register(&pdev->dev,
176                                 &ixp4xxgpioled_devices[gpio_pin].ancestor);
177                 if (rc < 0) {
178                         ixp4xxgpioled_devices[gpio_pin].ancestor.name = 0;
179                         ixp4xxgpioled_remove(pdev);
180                         return rc;
181                 }
182         }
183
184         return 0;
185 }
186
187 static struct platform_driver ixp4xxgpioled_driver = {
188         .probe   = ixp4xxgpioled_probe,
189         .remove  = ixp4xxgpioled_remove,
190 #ifdef CONFIG_PM
191         .suspend = ixp4xxgpioled_suspend,
192         .resume  = ixp4xxgpioled_resume,
193 #endif
194         .driver  = {
195                 .name = "IXP4XX-GPIO-LED",
196         },
197 };
198
199 static int __init ixp4xxgpioled_init(void)
200 {
201         return platform_driver_register(&ixp4xxgpioled_driver);
202 }
203
204 static void __exit ixp4xxgpioled_exit(void)
205 {
206         platform_driver_unregister(&ixp4xxgpioled_driver);
207 }
208
209 module_init(ixp4xxgpioled_init);
210 module_exit(ixp4xxgpioled_exit);
211
212 MODULE_AUTHOR("John Bowler <jbowler@acm.org>");
213 MODULE_DESCRIPTION("IXP4XX GPIO LED driver");
214 MODULE_LICENSE("Dual MIT/GPL");