diff options
Diffstat (limited to 'target/linux/lantiq/patches/920-falcon-easy98000-cpld-led.patch')
-rw-r--r-- | target/linux/lantiq/patches/920-falcon-easy98000-cpld-led.patch | 193 |
1 files changed, 193 insertions, 0 deletions
diff --git a/target/linux/lantiq/patches/920-falcon-easy98000-cpld-led.patch b/target/linux/lantiq/patches/920-falcon-easy98000-cpld-led.patch new file mode 100644 index 0000000000..6e8b302e04 --- /dev/null +++ b/target/linux/lantiq/patches/920-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 lq_r16(reg) __raw_readw(reg) ++#define lq_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) ++{ ++ lq_w16(lq_r16(base) | mask, base); ++} ++ ++void led_clear(u8 mask, u16 *base) ++{ ++ lq_w16(lq_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_ */ |