Rewrite LED driver, enable PCMCIA modules
SVN-Revision: 7185v19.07.3_mercusys_ac12_duma
Florian Fainelli
17 years ago
parent
a1d98e132f
commit
fdb603ed6b
@ -0,0 +1,109 @@
|
||||
/*
|
||||
* LED driver for RDC3211 boards
|
||||
*
|
||||
* Copyright 2007 Florian Fainelli <florian@openwrt.org>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/leds.h>
|
||||
#include <linux/err.h>
|
||||
|
||||
#include <asm/io.h>
|
||||
|
||||
#define LED_VAL 0x8000384C // the data ofset of gpio 0~30
|
||||
|
||||
static struct platform_device *pdev;
|
||||
|
||||
static void rdc3211_led_set(struct led_classdev *led_cdev, enum led_brightness brightness)
|
||||
{
|
||||
unsigned long ul_ledstat = 0xffffffff;
|
||||
unsigned long led_bit = 1 << (led_cdev->flags);
|
||||
|
||||
if (brightness)
|
||||
ul_ledstat &= ~led_bit;
|
||||
else
|
||||
ul_ledstat|= led_bit;
|
||||
|
||||
outl(LED_VAL, 0xcf8);
|
||||
outl(ul_ledstat, 0xcfc);
|
||||
}
|
||||
|
||||
static struct led_classdev rdc3211_power_led = {
|
||||
.name = "rdc3211:power",
|
||||
.flags = 15,
|
||||
.brightness_set = rdc3211_led_set,
|
||||
};
|
||||
|
||||
static struct led_classdev rdc3211_dmz_led = {
|
||||
.name = "rdc3211:dmz",
|
||||
.flags = 16,
|
||||
.brightness_set = rdc3211_led_set,
|
||||
};
|
||||
|
||||
static int rdc3211_leds_probe(struct platform_device *pdev)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = led_classdev_register(&pdev->dev, &rdc3211_power_led);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
ret = led_classdev_register(&pdev->dev, &rdc3211_dmz_led);
|
||||
if (ret < 0)
|
||||
led_classdev_unregister(&rdc3211_power_led);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int rdc3211_leds_remove(struct platform_device *pdev)
|
||||
{
|
||||
led_classdev_unregister(&rdc3211_power_led);
|
||||
led_classdev_unregister(&rdc3211_dmz_led);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver rdc3211_leds_driver = {
|
||||
.probe = rdc3211_leds_probe,
|
||||
.remove = rdc3211_leds_remove,
|
||||
.driver = {
|
||||
.name = "rdc3211-leds",
|
||||
}
|
||||
};
|
||||
|
||||
static int __init rdc3211_leds_init(void)
|
||||
{
|
||||
int ret;
|
||||
|
||||
ret = platform_driver_register(&rdc3211_leds_driver);
|
||||
if (ret < 0)
|
||||
goto out;
|
||||
|
||||
pdev = platform_device_register_simple("rdc3211-leds", -1, NULL, 0);
|
||||
if (IS_ERR(pdev)) {
|
||||
ret = PTR_ERR(pdev);
|
||||
platform_driver_unregister(&rdc3211_leds_driver);
|
||||
goto out;
|
||||
}
|
||||
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void __exit rdc3211_leds_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&rdc3211_leds_driver);
|
||||
}
|
||||
|
||||
module_init(rdc3211_leds_init);
|
||||
module_exit(rdc3211_leds_exit);
|
||||
|
||||
MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
|
||||
MODULE_DESCRIPTION("RDC3211 LED driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
@ -0,0 +1,27 @@
|
||||
diff -urN linux-2.6.19.2/drivers/leds/Kconfig linux-2.6.19.2.new/drivers/leds/Kconfig
|
||||
--- linux-2.6.19.2/drivers/leds/Kconfig 2007-01-10 20:10:37.000000000 +0100
|
||||
+++ linux-2.6.19.2.new/drivers/leds/Kconfig 2007-04-16 22:09:40.000000000 +0200
|
||||
@@ -76,6 +76,12 @@
|
||||
This option enables support for the Soekris net4801 and net4826 error
|
||||
LED.
|
||||
|
||||
+config LEDS_RDC3211
|
||||
+ tristate "LED Support for RDC3211 boards"
|
||||
+ depends on LEDS_CLASS && X86_RDC
|
||||
+ help
|
||||
+ This option enables support for the RDC3211 various LEDs.
|
||||
+
|
||||
comment "LED Triggers"
|
||||
|
||||
config LEDS_TRIGGERS
|
||||
diff -urN linux-2.6.19.2/drivers/leds/Makefile linux-2.6.19.2.new/drivers/leds/Makefile
|
||||
--- linux-2.6.19.2/drivers/leds/Makefile 2007-01-10 20:10:37.000000000 +0100
|
||||
+++ linux-2.6.19.2.new/drivers/leds/Makefile 2007-04-16 22:09:55.000000000 +0200
|
||||
@@ -13,6 +13,7 @@
|
||||
obj-$(CONFIG_LEDS_S3C24XX) += leds-s3c24xx.o
|
||||
obj-$(CONFIG_LEDS_AMS_DELTA) += leds-ams-delta.o
|
||||
obj-$(CONFIG_LEDS_NET48XX) += leds-net48xx.o
|
||||
+obj-$(CONFIG_LEDS_RDC3211) += leds-rdc3211.o
|
||||
|
||||
# LED Triggers
|
||||
obj-$(CONFIG_LEDS_TRIGGER_TIMER) += ledtrig-timer.o
|
||||
Loading…
Reference in New Issue