[lantiq]

[openwrt.git] / target / linux / lantiq / patches-2.6.32 / 140-falcon-easy98000-cpld-led.patch

diff --git a/target/linux/lantiq/patches-2.6.32/140-falcon-easy98000-cpld-led.patch b/target/linux/lantiq/patches-2.6.32/140-falcon-easy98000-cpld-led.patch
new file mode 100644 (file)
index 0000000..f623b2e
--- /dev/null
+++ b/target/linux/lantiq/patches-2.6.32/140-falcon-easy98000-cpld-led.patch
@@ -0,0 +1,193 @@
+--- a/arch/mips/lantiq/falcon/Makefile
++++ b/arch/mips/lantiq/falcon/Makefile
+@@ -1,3 +1,4 @@
+ obj-y := clk-falcon.o devices.o gpio.o prom.o sysctrl.o reset.o
+ obj-y += softdog_vpe.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 = 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_ */