URL https://opencores.org/ocsvn/test_project/test_project/trunk

Subversion Repositories test_project

[/] [test_project/] [trunk/] [linux_sd_driver/] [drivers/] [leds/] [leds-cobalt-raq.c] - Blame information for rev 67

Go to most recent revision | Details | Compare with Previous | View Log


/*
 *  LEDs driver for the Cobalt Raq series.
 *
 *  Copyright (C) 2007  Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp>
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
 */
#include <linux/init.h>
#include <linux/io.h>
#include <linux/ioport.h>
#include <linux/leds.h>
#include <linux/platform_device.h>
#include <linux/spinlock.h>
#include <linux/types.h>
 
#define LED_WEB         0x04
#define LED_POWER_OFF   0x08
 
static void __iomem *led_port;
static u8 led_value;
static DEFINE_SPINLOCK(led_value_lock);
 
static void raq_web_led_set(struct led_classdev *led_cdev,
                            enum led_brightness brightness)
{
        unsigned long flags;
 
        spin_lock_irqsave(&led_value_lock, flags);
 
        if (brightness)
                led_value |= LED_WEB;
        else
                led_value &= ~LED_WEB;
        writeb(led_value, led_port);
 
        spin_unlock_irqrestore(&led_value_lock, flags);
}
 
static struct led_classdev raq_web_led = {
        .name           = "raq-web",
        .brightness_set = raq_web_led_set,
};
 
static void raq_power_off_led_set(struct led_classdev *led_cdev,
                                  enum led_brightness brightness)
{
        unsigned long flags;
 
        spin_lock_irqsave(&led_value_lock, flags);
 
        if (brightness)
                led_value |= LED_POWER_OFF;
        else
                led_value &= ~LED_POWER_OFF;
        writeb(led_value, led_port);
 
        spin_unlock_irqrestore(&led_value_lock, flags);
}
 
static struct led_classdev raq_power_off_led = {
        .name                   = "raq-power-off",
        .brightness_set         = raq_power_off_led_set,
        .default_trigger        = "power-off",
};
 
static int __devinit cobalt_raq_led_probe(struct platform_device *pdev)
{
        struct resource *res;
        int retval;
 
        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
        if (!res)
                return -EBUSY;
 
        led_port = ioremap(res->start, res->end - res->start + 1);
        if (!led_port)
                return -ENOMEM;
 
        retval = led_classdev_register(&pdev->dev, &raq_power_off_led);
        if (retval)
                goto err_iounmap;
 
        retval = led_classdev_register(&pdev->dev, &raq_web_led);
        if (retval)
                goto err_unregister;
 
        return 0;
 
err_unregister:
        led_classdev_unregister(&raq_power_off_led);
 
err_iounmap:
        iounmap(led_port);
        led_port = NULL;
 
        return retval;
}
 
static int __devexit cobalt_raq_led_remove(struct platform_device *pdev)
{
        led_classdev_unregister(&raq_power_off_led);
        led_classdev_unregister(&raq_web_led);
 
        if (led_port) {
                iounmap(led_port);
                led_port = NULL;
        }
 
        return 0;
}
 
static struct platform_driver cobalt_raq_led_driver = {
        .probe  = cobalt_raq_led_probe,
        .remove = __devexit_p(cobalt_raq_led_remove),
        .driver = {
                .name   = "cobalt-raq-leds",
                .owner  = THIS_MODULE,
        },
};
 
static int __init cobalt_raq_led_init(void)
{
        return platform_driver_register(&cobalt_raq_led_driver);
}
 
module_init(cobalt_raq_led_init);

Line No.	Rev	Author	Line
1	62	marcus.erl	`/*`
2			`* LEDs driver for the Cobalt Raq series.`
3			`*`
4			`* Copyright (C) 2007 Yoichi Yuasa <yoichi_yuasa@tripeaks.co.jp>`
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, res->end - res->start + 1);`
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);`

Browse

Tools

Subversion Repositories test_project

[/] [test_project/] [trunk/] [linux_sd_driver/] [drivers/] [leds/] [leds-cobalt-raq.c] - Blame information for rev 67