Staging: rtl8712: fix math errors in snprintf()
[zen-stable.git] / drivers / leds / leds-h1940.c
blob173d104d9ff2a95f147f901aaea9ad98cbe2be49
1 /*
2 * drivers/leds/leds-h1940.c
3 * Copyright (c) Arnaud Patard <arnaud.patard@rtp-net.org>
5 * This file is subject to the terms and conditions of the GNU General Public
6 * License. See the file COPYING in the main directory of this archive for
7 * more details.
9 * H1940 leds driver
13 #include <linux/module.h>
14 #include <linux/platform_device.h>
15 #include <linux/delay.h>
16 #include <linux/string.h>
17 #include <linux/ctype.h>
18 #include <linux/leds.h>
19 #include <linux/gpio.h>
21 #include <mach/regs-gpio.h>
22 #include <mach/hardware.h>
23 #include <mach/h1940-latch.h>
26 * Green led.
28 static void h1940_greenled_set(struct led_classdev *led_dev,
29 enum led_brightness value)
31 switch (value) {
32 case LED_HALF:
33 h1940_latch_control(0, H1940_LATCH_LED_FLASH);
34 s3c2410_gpio_setpin(S3C2410_GPA7, 1);
35 break;
36 case LED_FULL:
37 h1940_latch_control(0, H1940_LATCH_LED_GREEN);
38 s3c2410_gpio_setpin(S3C2410_GPA7, 1);
39 break;
40 default:
41 case LED_OFF:
42 h1940_latch_control(H1940_LATCH_LED_FLASH, 0);
43 h1940_latch_control(H1940_LATCH_LED_GREEN, 0);
44 s3c2410_gpio_setpin(S3C2410_GPA7, 0);
45 break;
49 static struct led_classdev h1940_greenled = {
50 .name = "h1940:green",
51 .brightness_set = h1940_greenled_set,
52 .default_trigger = "h1940-charger",
56 * Red led.
58 static void h1940_redled_set(struct led_classdev *led_dev,
59 enum led_brightness value)
61 switch (value) {
62 case LED_HALF:
63 h1940_latch_control(0, H1940_LATCH_LED_FLASH);
64 s3c2410_gpio_setpin(S3C2410_GPA1, 1);
65 break;
66 case LED_FULL:
67 h1940_latch_control(0, H1940_LATCH_LED_RED);
68 s3c2410_gpio_setpin(S3C2410_GPA1, 1);
69 break;
70 default:
71 case LED_OFF:
72 h1940_latch_control(H1940_LATCH_LED_FLASH, 0);
73 h1940_latch_control(H1940_LATCH_LED_RED, 0);
74 s3c2410_gpio_setpin(S3C2410_GPA1, 0);
75 break;
79 static struct led_classdev h1940_redled = {
80 .name = "h1940:red",
81 .brightness_set = h1940_redled_set,
82 .default_trigger = "h1940-charger",
86 * Blue led.
87 * (it can only be blue flashing led)
89 static void h1940_blueled_set(struct led_classdev *led_dev,
90 enum led_brightness value)
92 if (value) {
93 /* flashing Blue */
94 h1940_latch_control(0, H1940_LATCH_LED_FLASH);
95 s3c2410_gpio_setpin(S3C2410_GPA3, 1);
96 } else {
97 h1940_latch_control(H1940_LATCH_LED_FLASH, 0);
98 s3c2410_gpio_setpin(S3C2410_GPA3, 0);
103 static struct led_classdev h1940_blueled = {
104 .name = "h1940:blue",
105 .brightness_set = h1940_blueled_set,
106 .default_trigger = "h1940-bluetooth",
109 static int __devinit h1940leds_probe(struct platform_device *pdev)
111 int ret;
113 ret = led_classdev_register(&pdev->dev, &h1940_greenled);
114 if (ret)
115 goto err_green;
117 ret = led_classdev_register(&pdev->dev, &h1940_redled);
118 if (ret)
119 goto err_red;
121 ret = led_classdev_register(&pdev->dev, &h1940_blueled);
122 if (ret)
123 goto err_blue;
125 return 0;
127 err_blue:
128 led_classdev_unregister(&h1940_redled);
129 err_red:
130 led_classdev_unregister(&h1940_greenled);
131 err_green:
132 return ret;
135 static int h1940leds_remove(struct platform_device *pdev)
137 led_classdev_unregister(&h1940_greenled);
138 led_classdev_unregister(&h1940_redled);
139 led_classdev_unregister(&h1940_blueled);
140 return 0;
144 static struct platform_driver h1940leds_driver = {
145 .driver = {
146 .name = "h1940-leds",
147 .owner = THIS_MODULE,
149 .probe = h1940leds_probe,
150 .remove = h1940leds_remove,
154 static int __init h1940leds_init(void)
156 return platform_driver_register(&h1940leds_driver);
159 static void __exit h1940leds_exit(void)
161 platform_driver_unregister(&h1940leds_driver);
164 module_init(h1940leds_init);
165 module_exit(h1940leds_exit);
167 MODULE_AUTHOR("Arnaud Patard <arnaud.patard@rtp-net.org>");
168 MODULE_DESCRIPTION("LED driver for the iPAQ H1940");
169 MODULE_LICENSE("GPL");
170 MODULE_ALIAS("platform:h1940-leds");