blob: 06dbe18a2065b8d0d799ed1cbcd92083d2a09fd9 [file] [log] [blame]
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +09001/*
2 * LEDs driver for the Cobalt Raq series.
3 *
Yoichi Yuasaada8e952009-07-03 00:39:38 +09004 * Copyright (C) 2007 Yoichi Yuasa <yuasa@linux-mips.org>
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +09005 *
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
Németh Márton4d404fd2008-03-09 20:59:57 +000018 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090019 */
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>
Paul Gortmakerd131c492011-07-10 12:24:44 -040027#include <linux/export.h>
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090028
29#define LED_WEB 0x04
30#define LED_POWER_OFF 0x08
31
32static void __iomem *led_port;
33static u8 led_value;
34static DEFINE_SPINLOCK(led_value_lock);
35
36static void raq_web_led_set(struct led_classdev *led_cdev,
Németh Márton4d404fd2008-03-09 20:59:57 +000037 enum led_brightness brightness)
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090038{
39 unsigned long flags;
40
41 spin_lock_irqsave(&led_value_lock, flags);
42
43 if (brightness)
44 led_value |= LED_WEB;
45 else
46 led_value &= ~LED_WEB;
47 writeb(led_value, led_port);
48
49 spin_unlock_irqrestore(&led_value_lock, flags);
50}
51
52static struct led_classdev raq_web_led = {
Olaf Heringdb3f5202009-09-07 14:37:27 +010053 .name = "raq::web",
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090054 .brightness_set = raq_web_led_set,
55};
56
57static void raq_power_off_led_set(struct led_classdev *led_cdev,
Németh Márton4d404fd2008-03-09 20:59:57 +000058 enum led_brightness brightness)
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090059{
60 unsigned long flags;
61
62 spin_lock_irqsave(&led_value_lock, flags);
63
64 if (brightness)
65 led_value |= LED_POWER_OFF;
66 else
67 led_value &= ~LED_POWER_OFF;
68 writeb(led_value, led_port);
69
70 spin_unlock_irqrestore(&led_value_lock, flags);
71}
72
73static struct led_classdev raq_power_off_led = {
Olaf Heringdb3f5202009-09-07 14:37:27 +010074 .name = "raq::power-off",
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090075 .brightness_set = raq_power_off_led_set,
76 .default_trigger = "power-off",
77};
78
Bill Pemberton98ea1ea2012-11-19 13:23:02 -050079static int cobalt_raq_led_probe(struct platform_device *pdev)
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090080{
81 struct resource *res;
82 int retval;
83
84 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
85 if (!res)
86 return -EBUSY;
87
Jingoo Han50e51942012-10-23 05:20:50 -070088 led_port = devm_ioremap(&pdev->dev, res->start, resource_size(res));
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090089 if (!led_port)
90 return -ENOMEM;
91
92 retval = led_classdev_register(&pdev->dev, &raq_power_off_led);
93 if (retval)
Jingoo Han50e51942012-10-23 05:20:50 -070094 goto err_null;
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +090095
96 retval = led_classdev_register(&pdev->dev, &raq_web_led);
97 if (retval)
98 goto err_unregister;
99
100 return 0;
101
102err_unregister:
103 led_classdev_unregister(&raq_power_off_led);
104
Jingoo Han50e51942012-10-23 05:20:50 -0700105err_null:
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +0900106 led_port = NULL;
107
108 return retval;
109}
110
Bill Pemberton678e8a62012-11-19 13:26:00 -0500111static int cobalt_raq_led_remove(struct platform_device *pdev)
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +0900112{
113 led_classdev_unregister(&raq_power_off_led);
114 led_classdev_unregister(&raq_web_led);
115
Jingoo Han50e51942012-10-23 05:20:50 -0700116 if (led_port)
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +0900117 led_port = NULL;
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +0900118
119 return 0;
120}
121
122static struct platform_driver cobalt_raq_led_driver = {
123 .probe = cobalt_raq_led_probe,
Bill Pembertondf07cf82012-11-19 13:20:20 -0500124 .remove = cobalt_raq_led_remove,
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +0900125 .driver = {
126 .name = "cobalt-raq-leds",
Yoichi Yuasa97da7aa2007-09-27 17:51:05 +0900127 },
128};
129
130static int __init cobalt_raq_led_init(void)
131{
132 return platform_driver_register(&cobalt_raq_led_driver);
133}
134
135module_init(cobalt_raq_led_init);