Staging: meilhaus: Correct use of ! and &
[linux-2.6] / drivers / leds / leds-gpio.c
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>
16 #include <linux/workqueue.h>
17
18 #include <asm/gpio.h>
19
20 struct gpio_led_data {
21         struct led_classdev cdev;
22         unsigned gpio;
23         struct work_struct work;
24         u8 new_level;
25         u8 can_sleep;
26         u8 active_low;
27         int (*platform_gpio_blink_set)(unsigned gpio,
28                         unsigned long *delay_on, unsigned long *delay_off);
29 };
30
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 }
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
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          */
58         if (led_dat->can_sleep) {
59                 led_dat->new_level = level;
60                 schedule_work(&led_dat->work);
61         } else
62                 gpio_set_value(led_dat->gpio, level);
63 }
64
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
74 static int gpio_led_probe(struct platform_device *pdev)
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
93                 ret = gpio_request(cur_led->gpio, cur_led->name);
94                 if (ret < 0)
95                         goto err;
96
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;
100                 led_dat->can_sleep = gpio_cansleep(cur_led->gpio);
101                 led_dat->active_low = cur_led->active_low;
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                 }
106                 led_dat->cdev.brightness_set = gpio_led_set;
107                 led_dat->cdev.brightness = LED_OFF;
108                 led_dat->cdev.flags |= LED_CORE_SUSPENDRESUME;
109
110                 gpio_direction_output(led_dat->gpio, led_dat->active_low);
111
112                 INIT_WORK(&led_dat->work, gpio_led_work);
113
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);
129                         cancel_work_sync(&leds_data[i].work);
130                         gpio_free(leds_data[i].gpio);
131                 }
132         }
133
134         kfree(leds_data);
135
136         return ret;
137 }
138
139 static int __devexit gpio_led_remove(struct platform_device *pdev)
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);
149                 cancel_work_sync(&leds_data[i].work);
150                 gpio_free(leds_data[i].gpio);
151         }
152
153         kfree(leds_data);
154
155         return 0;
156 }
157
158 static struct platform_driver gpio_led_driver = {
159         .probe          = gpio_led_probe,
160         .remove         = __devexit_p(gpio_led_remove),
161         .driver         = {
162                 .name   = "leds-gpio",
163                 .owner  = THIS_MODULE,
164         },
165 };
166
167 static int __init gpio_led_init(void)
168 {
169         return platform_driver_register(&gpio_led_driver);
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");
183 MODULE_ALIAS("platform:leds-gpio");