Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
leds-wrap.c
Go to the documentation of this file.
1 /*
2  * LEDs driver for PCEngines WRAP
3  *
4  * Copyright (C) 2006 Kristian Kielhofner <[email protected]>
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 {
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 <[email protected]>");
152 MODULE_DESCRIPTION("PCEngines WRAP LED driver");
153 MODULE_LICENSE("GPL");
154