From fdb603ed6ba85180366c03cb3aae33afc1f19bfa Mon Sep 17 00:00:00 2001 From: Florian Fainelli Date: Fri, 11 May 2007 16:43:25 +0000 Subject: Rewrite LED driver, enable PCMCIA modules SVN-Revision: 7185 --- .../rdc-2.6/files/drivers/leds/leds-rdc3211.c | 109 +++++++++++++++++++++ 1 file changed, 109 insertions(+) create mode 100644 target/linux/rdc-2.6/files/drivers/leds/leds-rdc3211.c (limited to 'target/linux/rdc-2.6/files') diff --git a/target/linux/rdc-2.6/files/drivers/leds/leds-rdc3211.c b/target/linux/rdc-2.6/files/drivers/leds/leds-rdc3211.c new file mode 100644 index 0000000000..b98b43a5b5 --- /dev/null +++ b/target/linux/rdc-2.6/files/drivers/leds/leds-rdc3211.c @@ -0,0 +1,109 @@ +/* + * LED driver for RDC3211 boards + * + * Copyright 2007 Florian Fainelli + * + * 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 +#include +#include +#include +#include + +#include + +#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 "); +MODULE_DESCRIPTION("RDC3211 LED driver"); +MODULE_LICENSE("GPL"); -- cgit v1.2.3