mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-08-22 04:38:03 +03:00
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@27406 3c298f89-4303-0410-b956-a3cf2f4a3e73
194 lines
4.7 KiB
Diff
194 lines
4.7 KiB
Diff
--- a/arch/mips/lantiq/falcon/Makefile
|
|
+++ b/arch/mips/lantiq/falcon/Makefile
|
|
@@ -2,3 +2,4 @@ obj-y := clk-falcon.o devices.o gpio.o p
|
|
obj-y += softdog_vpe.o
|
|
obj-$(CONFIG_LANTIQ_MACH_EASY98000) += addon-easy98000.o
|
|
obj-$(CONFIG_LANTIQ_MACH_EASY98000) += mach-easy98000.o
|
|
+obj-$(CONFIG_LANTIQ_MACH_EASY98000) += dev-leds-easy98000-cpld.o
|
|
--- /dev/null
|
|
+++ b/arch/mips/lantiq/falcon/dev-leds-easy98000-cpld.c
|
|
@@ -0,0 +1,160 @@
|
|
+/*
|
|
+ * EASY98000 CPLD LED driver
|
|
+ *
|
|
+ * Copyright (C) 2010 Ralph Hempel <ralph.hempel@lantiq.com>
|
|
+ *
|
|
+ * 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/version.h>
|
|
+#include <linux/types.h>
|
|
+#include <linux/init.h>
|
|
+#include <linux/platform_device.h>
|
|
+#include <linux/errno.h>
|
|
+#include <linux/leds.h>
|
|
+#include <linux/slab.h>
|
|
+
|
|
+#include "dev-leds-easy98000-cpld.h"
|
|
+
|
|
+const char *led_name[8] = {
|
|
+ "ge0_act",
|
|
+ "ge0_link",
|
|
+ "ge1_act",
|
|
+ "ge1_link",
|
|
+ "fe2_act",
|
|
+ "fe2_link",
|
|
+ "fe3_act",
|
|
+ "fe3_link"
|
|
+};
|
|
+
|
|
+#define cpld_base7 ((u16 *)(KSEG1 | 0x17c0000c))
|
|
+#define cpld_base8 ((u16 *)(KSEG1 | 0x17c00012))
|
|
+
|
|
+#define ltq_r16(reg) __raw_readw(reg)
|
|
+#define ltq_w16(val, reg) __raw_writew(val, reg)
|
|
+
|
|
+struct cpld_led_dev {
|
|
+ struct led_classdev cdev;
|
|
+ u8 mask;
|
|
+ u16 *base;
|
|
+};
|
|
+
|
|
+struct cpld_led_drvdata {
|
|
+ struct cpld_led_dev *led_devs;
|
|
+ int num_leds;
|
|
+};
|
|
+
|
|
+void led_set(u8 mask, u16 *base)
|
|
+{
|
|
+ ltq_w16(ltq_r16(base) | mask, base);
|
|
+}
|
|
+
|
|
+void led_clear(u8 mask, u16 *base)
|
|
+{
|
|
+ ltq_w16(ltq_r16(base) & (~mask), base);
|
|
+}
|
|
+
|
|
+void led_blink_clear(u8 mask, u16 *base)
|
|
+{
|
|
+ led_clear(mask, base);
|
|
+}
|
|
+
|
|
+static void led_brightness(struct led_classdev *led_cdev,
|
|
+ enum led_brightness value)
|
|
+{
|
|
+ struct cpld_led_dev *led_dev =
|
|
+ container_of(led_cdev, struct cpld_led_dev, cdev);
|
|
+
|
|
+ if (value)
|
|
+ led_set(led_dev->mask, led_dev->base);
|
|
+ else
|
|
+ led_clear(led_dev->mask, led_dev->base);
|
|
+}
|
|
+
|
|
+static int led_probe(struct platform_device *pdev)
|
|
+{
|
|
+ int i;
|
|
+ char name[32];
|
|
+ struct cpld_led_drvdata *drvdata;
|
|
+ int ret = 0;
|
|
+
|
|
+ drvdata = kzalloc(sizeof(struct cpld_led_drvdata) +
|
|
+ sizeof(struct cpld_led_dev) * MAX_LED,
|
|
+ GFP_KERNEL);
|
|
+ if (!drvdata)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ drvdata->led_devs = (struct cpld_led_dev *) &drvdata[1];
|
|
+
|
|
+ for (i = 0; i < MAX_LED; i++) {
|
|
+ struct cpld_led_dev *led_dev = &drvdata->led_devs[i];
|
|
+ led_dev->cdev.brightness_set = led_brightness;
|
|
+ led_dev->cdev.default_trigger = NULL;
|
|
+ led_dev->mask = 1 << (i % 8);
|
|
+ if(i < 8) {
|
|
+ sprintf(name, "easy98000-cpld:%s", led_name[i]);
|
|
+ led_dev->base = cpld_base8;
|
|
+ } else {
|
|
+ sprintf(name, "easy98000-cpld:red:%d", i-8);
|
|
+ led_dev->base = cpld_base7;
|
|
+ }
|
|
+ led_dev->cdev.name = name;
|
|
+ ret = led_classdev_register(&pdev->dev, &led_dev->cdev);
|
|
+ if (ret)
|
|
+ goto err;
|
|
+ }
|
|
+ platform_set_drvdata(pdev, drvdata);
|
|
+ return 0;
|
|
+
|
|
+err:
|
|
+ printk("led_probe: 3\n");
|
|
+ for (i = i - 1; i >= 0; i--)
|
|
+ led_classdev_unregister(&drvdata->led_devs[i].cdev);
|
|
+
|
|
+ kfree(drvdata);
|
|
+ return ret;
|
|
+}
|
|
+
|
|
+static int led_remove(struct platform_device *pdev)
|
|
+{
|
|
+ int i;
|
|
+ struct cpld_led_drvdata *drvdata = platform_get_drvdata(pdev);
|
|
+ for (i = 0; i < MAX_LED; i++)
|
|
+ led_classdev_unregister(&drvdata->led_devs[i].cdev);
|
|
+ kfree(drvdata);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static struct platform_driver led_driver = {
|
|
+ .probe = led_probe,
|
|
+ .remove = __devexit_p(led_remove),
|
|
+ .driver = {
|
|
+ .name = LED_NAME,
|
|
+ .owner = THIS_MODULE,
|
|
+ },
|
|
+};
|
|
+
|
|
+int __init easy98000_cpld_led_init(void)
|
|
+{
|
|
+ pr_info(LED_DESC ", Version " LED_VERSION
|
|
+ " (c) Copyright 2011, Lantiq Deutschland GmbH\n");
|
|
+ return platform_driver_register(&led_driver);
|
|
+}
|
|
+
|
|
+void __exit easy98000_cpld_led_exit(void)
|
|
+{
|
|
+ platform_driver_unregister(&led_driver);
|
|
+}
|
|
+
|
|
+module_init(easy98000_cpld_led_init);
|
|
+module_exit(easy98000_cpld_led_exit);
|
|
+
|
|
+MODULE_DESCRIPTION(LED_NAME);
|
|
+MODULE_DESCRIPTION(LED_DESC);
|
|
+MODULE_AUTHOR("Ralph Hempel <ralph.hempel@lantiq.com>");
|
|
+MODULE_LICENSE("GPL v2");
|
|
+
|
|
--- /dev/null
|
|
+++ b/arch/mips/lantiq/falcon/dev-leds-easy98000-cpld.h
|
|
@@ -0,0 +1,20 @@
|
|
+/*
|
|
+ * EASY98000 CPLD LED driver
|
|
+ *
|
|
+ * Copyright (C) 2010 Ralph Hempel <ralph.hempel@lantiq.com>
|
|
+ *
|
|
+ * 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.
|
|
+ *
|
|
+ */
|
|
+#ifndef _INCLUDE_EASY98000_CPLD_LED_H_
|
|
+#define _INCLUDE_EASY98000_CPLD_LED_H_
|
|
+
|
|
+#define LED_NAME "easy98000_cpld_led"
|
|
+#define LED_DESC "EASY98000 LED driver"
|
|
+#define LED_VERSION "1.0.0"
|
|
+
|
|
+#define MAX_LED 16
|
|
+
|
|
+#endif /* _INCLUDE_EASY98000_CPLD_LED_H_ */
|