1
0
mirror of git://projects.qi-hardware.com/openwrt-xburst.git synced 2025-04-21 12:27:27 +03:00

Add generic gpio support to rdc, convert the led driver to be a platform driver, need to convert the flash driver as well

git-svn-id: svn://svn.openwrt.org/openwrt/trunk@8348 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
florian
2007-08-06 14:15:57 +00:00
parent 94040edc45
commit 47ef8de260
8 changed files with 261 additions and 845 deletions

View File

@@ -10,100 +10,67 @@
*/
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/leds.h>
#include <linux/err.h>
#include <linux/delay.h>
#include <asm/io.h>
#include <asm/gpio.h>
#define LED_VAL 0x8000384C // the data ofset of gpio 0~30
int gpio;
module_param(gpio, int, 0444);
MODULE_PARM_DESC(gpio, " GPIO line");
static struct platform_device *pdev;
static void rdc3211_led_set(struct led_classdev *led_cdev, enum led_brightness brightness)
static void rdc321x_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);
gpio_set_value(gpio, brightness ? 1 : 0);
}
static struct led_classdev rdc3211_power_led = {
.name = "rdc3211:power",
.flags = 15,
.brightness_set = rdc3211_led_set,
static struct led_classdev rdc321x_dmz_led = {
.name = "rdc321x:dmz",
.brightness_set = rdc321x_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)
static int rdc321x_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;
return led_classdev_register(&pdev->dev, &rdc321x_dmz_led);
}
static int rdc3211_leds_remove(struct platform_device *pdev)
static int rdc321x_leds_remove(struct platform_device *pdev)
{
led_classdev_unregister(&rdc3211_power_led);
led_classdev_unregister(&rdc3211_dmz_led);
led_classdev_unregister(&rdc321x_dmz_led);
return 0;
}
static struct platform_driver rdc3211_leds_driver = {
.probe = rdc3211_leds_probe,
.remove = rdc3211_leds_remove,
static struct platform_driver rdc321x_leds_driver = {
.probe = rdc321x_leds_probe,
.remove = rdc321x_leds_remove,
.driver = {
.name = "rdc3211-leds",
.name = "rdc321x-leds",
.owner = THIS_MODULE,
}
};
static int __init rdc3211_leds_init(void)
static int __init rdc321x_leds_init(void)
{
int ret;
ret = platform_driver_register(&rdc3211_leds_driver);
if (ret < 0)
goto out;
ret = platform_driver_register(&rdc321x_leds_driver);
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)
static void __exit rdc321x_leds_exit(void)
{
platform_driver_unregister(&rdc3211_leds_driver);
platform_driver_unregister(&rdc321x_leds_driver);
}
module_init(rdc3211_leds_init);
module_exit(rdc3211_leds_exit);
module_init(rdc321x_leds_init);
module_exit(rdc321x_leds_exit);
MODULE_AUTHOR("Florian Fainelli <florian@openwrt.org>");
MODULE_DESCRIPTION("RDC3211 LED driver");
MODULE_DESCRIPTION("RDC321x LED driver");
MODULE_LICENSE("GPL");