Root/
1 | /* |
2 | * LEDs driver for the Cobalt Raq series. |
3 | * |
4 | * Copyright (C) 2007 Yoichi Yuasa <yuasa@linux-mips.org> |
5 | * |
6 | * This program is free software; you can redistribute it and/or modify |
7 | * it under the terms of the GNU General Public License as published by |
8 | * the Free Software Foundation; either version 2 of the License, or |
9 | * (at your option) any later version. |
10 | * |
11 | * This program is distributed in the hope that it will be useful, |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
14 | * GNU General Public License for more details. |
15 | * |
16 | * You should have received a copy of the GNU General Public License |
17 | * along with this program; if not, write to the Free Software |
18 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
19 | */ |
20 | #include <linux/init.h> |
21 | #include <linux/io.h> |
22 | #include <linux/ioport.h> |
23 | #include <linux/leds.h> |
24 | #include <linux/platform_device.h> |
25 | #include <linux/spinlock.h> |
26 | #include <linux/types.h> |
27 | |
28 | #define LED_WEB 0x04 |
29 | #define LED_POWER_OFF 0x08 |
30 | |
31 | static void __iomem *led_port; |
32 | static u8 led_value; |
33 | static DEFINE_SPINLOCK(led_value_lock); |
34 | |
35 | static void raq_web_led_set(struct led_classdev *led_cdev, |
36 | enum led_brightness brightness) |
37 | { |
38 | unsigned long flags; |
39 | |
40 | spin_lock_irqsave(&led_value_lock, flags); |
41 | |
42 | if (brightness) |
43 | led_value |= LED_WEB; |
44 | else |
45 | led_value &= ~LED_WEB; |
46 | writeb(led_value, led_port); |
47 | |
48 | spin_unlock_irqrestore(&led_value_lock, flags); |
49 | } |
50 | |
51 | static struct led_classdev raq_web_led = { |
52 | .name = "raq::web", |
53 | .brightness_set = raq_web_led_set, |
54 | }; |
55 | |
56 | static void raq_power_off_led_set(struct led_classdev *led_cdev, |
57 | enum led_brightness brightness) |
58 | { |
59 | unsigned long flags; |
60 | |
61 | spin_lock_irqsave(&led_value_lock, flags); |
62 | |
63 | if (brightness) |
64 | led_value |= LED_POWER_OFF; |
65 | else |
66 | led_value &= ~LED_POWER_OFF; |
67 | writeb(led_value, led_port); |
68 | |
69 | spin_unlock_irqrestore(&led_value_lock, flags); |
70 | } |
71 | |
72 | static struct led_classdev raq_power_off_led = { |
73 | .name = "raq::power-off", |
74 | .brightness_set = raq_power_off_led_set, |
75 | .default_trigger = "power-off", |
76 | }; |
77 | |
78 | static int __devinit cobalt_raq_led_probe(struct platform_device *pdev) |
79 | { |
80 | struct resource *res; |
81 | int retval; |
82 | |
83 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
84 | if (!res) |
85 | return -EBUSY; |
86 | |
87 | led_port = ioremap(res->start, resource_size(res)); |
88 | if (!led_port) |
89 | return -ENOMEM; |
90 | |
91 | retval = led_classdev_register(&pdev->dev, &raq_power_off_led); |
92 | if (retval) |
93 | goto err_iounmap; |
94 | |
95 | retval = led_classdev_register(&pdev->dev, &raq_web_led); |
96 | if (retval) |
97 | goto err_unregister; |
98 | |
99 | return 0; |
100 | |
101 | err_unregister: |
102 | led_classdev_unregister(&raq_power_off_led); |
103 | |
104 | err_iounmap: |
105 | iounmap(led_port); |
106 | led_port = NULL; |
107 | |
108 | return retval; |
109 | } |
110 | |
111 | static int __devexit cobalt_raq_led_remove(struct platform_device *pdev) |
112 | { |
113 | led_classdev_unregister(&raq_power_off_led); |
114 | led_classdev_unregister(&raq_web_led); |
115 | |
116 | if (led_port) { |
117 | iounmap(led_port); |
118 | led_port = NULL; |
119 | } |
120 | |
121 | return 0; |
122 | } |
123 | |
124 | static struct platform_driver cobalt_raq_led_driver = { |
125 | .probe = cobalt_raq_led_probe, |
126 | .remove = __devexit_p(cobalt_raq_led_remove), |
127 | .driver = { |
128 | .name = "cobalt-raq-leds", |
129 | .owner = THIS_MODULE, |
130 | }, |
131 | }; |
132 | |
133 | static int __init cobalt_raq_led_init(void) |
134 | { |
135 | return platform_driver_register(&cobalt_raq_led_driver); |
136 | } |
137 | |
138 | module_init(cobalt_raq_led_init); |
139 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9