[SCSI] libsas: execute transport link resets with libata-eh via host workqueue
[linux-2.6.git] / drivers / leds / leds-wrap.c
1 /*
2  * LEDs driver for PCEngines WRAP
3  *
4  * Copyright (C) 2006 Kristian Kielhofner <kris@krisk.org>
5  *
6  * Based on leds-net48xx.c
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License version 2 as
10  * published by the Free Software Foundation.
11  */
12
13 #include <linux/kernel.h>
14 #include <linux/init.h>
15 #include <linux/platform_device.h>
16 #include <linux/leds.h>
17 #include <linux/err.h>
18 #include <asm/io.h>
19 #include <linux/scx200_gpio.h>
20 #include <linux/module.h>
21
22 #define DRVNAME "wrap-led"
23 #define WRAP_POWER_LED_GPIO     2
24 #define WRAP_ERROR_LED_GPIO     3
25 #define WRAP_EXTRA_LED_GPIO     18
26
27 static struct platform_device *pdev;
28
29 static void wrap_power_led_set(struct led_classdev *led_cdev,
30                 enum led_brightness value)
31 {
32         if (value)
33                 scx200_gpio_set_low(WRAP_POWER_LED_GPIO);
34         else
35                 scx200_gpio_set_high(WRAP_POWER_LED_GPIO);
36 }
37
38 static void wrap_error_led_set(struct led_classdev *led_cdev,
39                 enum led_brightness value)
40 {
41         if (value)
42                 scx200_gpio_set_low(WRAP_ERROR_LED_GPIO);
43         else
44                 scx200_gpio_set_high(WRAP_ERROR_LED_GPIO);
45 }
46
47 static void wrap_extra_led_set(struct led_classdev *led_cdev,
48                 enum led_brightness value)
49 {
50         if (value)
51                 scx200_gpio_set_low(WRAP_EXTRA_LED_GPIO);
52         else
53                 scx200_gpio_set_high(WRAP_EXTRA_LED_GPIO);
54 }
55
56 static struct led_classdev wrap_power_led = {
57         .name                   = "wrap::power",
58         .brightness_set         = wrap_power_led_set,
59         .default_trigger        = "default-on",
60         .flags                  = LED_CORE_SUSPENDRESUME,
61 };
62
63 static struct led_classdev wrap_error_led = {
64         .name           = "wrap::error",
65         .brightness_set = wrap_error_led_set,
66         .flags                  = LED_CORE_SUSPENDRESUME,
67 };
68
69 static struct led_classdev wrap_extra_led = {
70         .name           = "wrap::extra",
71         .brightness_set = wrap_extra_led_set,
72         .flags                  = LED_CORE_SUSPENDRESUME,
73 };
74
75 static int wrap_led_probe(struct platform_device *pdev)
76 {
77         int ret;
78
79         ret = led_classdev_register(&pdev->dev, &wrap_power_led);
80         if (ret < 0)
81                 return ret;
82
83         ret = led_classdev_register(&pdev->dev, &wrap_error_led);
84         if (ret < 0)
85                 goto err1;
86
87         ret = led_classdev_register(&pdev->dev, &wrap_extra_led);
88         if (ret < 0)
89                 goto err2;
90
91         return ret;
92
93 err2:
94         led_classdev_unregister(&wrap_error_led);
95 err1:
96         led_classdev_unregister(&wrap_power_led);
97
98         return ret;
99 }
100
101 static int wrap_led_remove(struct platform_device *pdev)
102 {
103         led_classdev_unregister(&wrap_power_led);
104         led_classdev_unregister(&wrap_error_led);
105         led_classdev_unregister(&wrap_extra_led);
106         return 0;
107 }
108
109 static struct platform_driver wrap_led_driver = {
110         .probe          = wrap_led_probe,
111         .remove         = wrap_led_remove,
112         .driver         = {
113                 .name           = DRVNAME,
114                 .owner          = THIS_MODULE,
115         },
116 };
117
118 static int __init wrap_led_init(void)
119 {
120         int ret;
121
122         if (!scx200_gpio_present()) {
123                 ret = -ENODEV;
124                 goto out;
125         }
126
127         ret = platform_driver_register(&wrap_led_driver);
128         if (ret < 0)
129                 goto out;
130
131         pdev = platform_device_register_simple(DRVNAME, -1, NULL, 0);
132         if (IS_ERR(pdev)) {
133                 ret = PTR_ERR(pdev);
134                 platform_driver_unregister(&wrap_led_driver);
135                 goto out;
136         }
137
138 out:
139         return ret;
140 }
141
142 static void __exit wrap_led_exit(void)
143 {
144         platform_device_unregister(pdev);
145         platform_driver_unregister(&wrap_led_driver);
146 }
147
148 module_init(wrap_led_init);
149 module_exit(wrap_led_exit);
150
151 MODULE_AUTHOR("Kristian Kielhofner <kris@krisk.org>");
152 MODULE_DESCRIPTION("PCEngines WRAP LED driver");
153 MODULE_LICENSE("GPL");
154