4d404fd5c5
Break the lines which were more than 80 characters into more lines; replace SPACEs with TABs; correct ident at switch-case; change character encoding from ISO-8859-2 to UTF-8. The order of the functions in led-triggers.c changed in order the similar functions can still be together under titles "Used by LED Class", "LED Trigger Interface" and "Simple LED Tigger Interface" as was grouped before when exported with EXPORT_SYMBOL. Signed-off-by: Márton Németh <nm127@freemail.hu> Signed-off-by: Richard Purdie <rpurdie@rpsys.net>
105 lines
2.2 KiB
C
105 lines
2.2 KiB
C
/*
|
|
* Copyright 2006 - Florian Fainelli <florian@openwrt.org>
|
|
*
|
|
* Control the Cobalt Qube/RaQ front LED
|
|
*/
|
|
#include <linux/init.h>
|
|
#include <linux/io.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/leds.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/types.h>
|
|
|
|
#define LED_FRONT_LEFT 0x01
|
|
#define LED_FRONT_RIGHT 0x02
|
|
|
|
static void __iomem *led_port;
|
|
static u8 led_value;
|
|
|
|
static void qube_front_led_set(struct led_classdev *led_cdev,
|
|
enum led_brightness brightness)
|
|
{
|
|
if (brightness)
|
|
led_value = LED_FRONT_LEFT | LED_FRONT_RIGHT;
|
|
else
|
|
led_value = ~(LED_FRONT_LEFT | LED_FRONT_RIGHT);
|
|
writeb(led_value, led_port);
|
|
}
|
|
|
|
static struct led_classdev qube_front_led = {
|
|
.name = "qube-front",
|
|
.brightness = LED_FULL,
|
|
.brightness_set = qube_front_led_set,
|
|
.default_trigger = "ide-disk",
|
|
};
|
|
|
|
static int __devinit cobalt_qube_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;
|
|
|
|
led_value = LED_FRONT_LEFT | LED_FRONT_RIGHT;
|
|
writeb(led_value, led_port);
|
|
|
|
retval = led_classdev_register(&pdev->dev, &qube_front_led);
|
|
if (retval)
|
|
goto err_iounmap;
|
|
|
|
return 0;
|
|
|
|
err_iounmap:
|
|
iounmap(led_port);
|
|
led_port = NULL;
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int __devexit cobalt_qube_led_remove(struct platform_device *pdev)
|
|
{
|
|
led_classdev_unregister(&qube_front_led);
|
|
|
|
if (led_port) {
|
|
iounmap(led_port);
|
|
led_port = NULL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* work with hotplug and coldplug */
|
|
MODULE_ALIAS("platform:cobalt-qube-leds");
|
|
|
|
static struct platform_driver cobalt_qube_led_driver = {
|
|
.probe = cobalt_qube_led_probe,
|
|
.remove = __devexit_p(cobalt_qube_led_remove),
|
|
.driver = {
|
|
.name = "cobalt-qube-leds",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
};
|
|
|
|
static int __init cobalt_qube_led_init(void)
|
|
{
|
|
return platform_driver_register(&cobalt_qube_led_driver);
|
|
}
|
|
|
|
static void __exit cobalt_qube_led_exit(void)
|
|
{
|
|
platform_driver_unregister(&cobalt_qube_led_driver);
|
|
}
|
|
|
|
module_init(cobalt_qube_led_init);
|
|
module_exit(cobalt_qube_led_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_DESCRIPTION("Front LED support for Cobalt Server");
|
|
MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
|