From 700d716f465f30b1168343191f5008beb3219a35 Mon Sep 17 00:00:00 2001 From: Gabor Juhos Date: Mon, 31 Aug 2009 09:14:14 +0000 Subject: [ramips] add common GPIO LED support git-svn-id: svn://svn.openwrt.org/openwrt/trunk@17448 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- .../mips/include/asm/mach-ralink/dev_gpio_leds.h | 26 +++++++++++ target/linux/ramips/files/arch/mips/ralink/Kconfig | 3 ++ .../ramips/files/arch/mips/ralink/common/Makefile | 2 + .../files/arch/mips/ralink/common/dev-gpio-leds.c | 54 ++++++++++++++++++++++ .../ramips/files/arch/mips/ralink/rt305x/Kconfig | 1 + 5 files changed, 86 insertions(+) create mode 100644 target/linux/ramips/files/arch/mips/include/asm/mach-ralink/dev_gpio_leds.h create mode 100644 target/linux/ramips/files/arch/mips/ralink/common/dev-gpio-leds.c (limited to 'target') diff --git a/target/linux/ramips/files/arch/mips/include/asm/mach-ralink/dev_gpio_leds.h b/target/linux/ramips/files/arch/mips/include/asm/mach-ralink/dev_gpio_leds.h new file mode 100644 index 0000000000..1d6fbc29d9 --- /dev/null +++ b/target/linux/ramips/files/arch/mips/include/asm/mach-ralink/dev_gpio_leds.h @@ -0,0 +1,26 @@ +/* + * Ralink SoC GPIO LED device support + * + * Copyright (C) 2009 Gabor Juhos + * + * 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 __ASM_MACH_RALINK_DEV_GPIO_LEDS_H +#define __ASM_MACH_RALINK_DEV_GPIO_LEDS_H + +struct gpio_led; + +#ifdef CONFIG_RALINK_DEV_GPIO_LEDS +__init void ramips_register_gpio_leds(int id, unsigned num_leds, + struct gpio_led *leds); +#else +static inline void ramips_register_gpio_leds(int id, unsigned num_leds, + struct gpio_led *leds) +{ +} +#endif + +#endif /* __ASM_MACH_RALINK_DEV_GPIO_LEDS_H */ diff --git a/target/linux/ramips/files/arch/mips/ralink/Kconfig b/target/linux/ramips/files/arch/mips/ralink/Kconfig index e180eabd65..fac5c7bfd6 100644 --- a/target/linux/ramips/files/arch/mips/ralink/Kconfig +++ b/target/linux/ramips/files/arch/mips/ralink/Kconfig @@ -48,4 +48,7 @@ config SOC_RT305X select SYS_HAS_EARLY_PRINTK select MIPS_MACHINE +config RALINK_DEV_GPIO_LEDS + def_bool n + endif diff --git a/target/linux/ramips/files/arch/mips/ralink/common/Makefile b/target/linux/ramips/files/arch/mips/ralink/common/Makefile index 08e16dd5c2..24f67ea6c3 100644 --- a/target/linux/ramips/files/arch/mips/ralink/common/Makefile +++ b/target/linux/ramips/files/arch/mips/ralink/common/Makefile @@ -8,3 +8,5 @@ # by the Free Software Foundation. obj-y := intc.o gpio.o + +obj-$(CONFIG_RALINK_DEV_GPIO_LEDS) += dev-gpio-leds.o diff --git a/target/linux/ramips/files/arch/mips/ralink/common/dev-gpio-leds.c b/target/linux/ramips/files/arch/mips/ralink/common/dev-gpio-leds.c new file mode 100644 index 0000000000..96651e7b9a --- /dev/null +++ b/target/linux/ramips/files/arch/mips/ralink/common/dev-gpio-leds.c @@ -0,0 +1,54 @@ +/* + * Ralink SoC GPIO LED device support + * + * Copyright (C) 2009 Gabor Juhos + * + * 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 + +void __init ramips_register_gpio_leds(int id, unsigned num_leds, + struct gpio_led *leds) +{ + struct platform_device *pdev; + struct gpio_led_platform_data pdata; + struct gpio_led *p; + int err; + + p = kmalloc(num_leds * sizeof(*p), GFP_KERNEL); + if (!p) + return; + + memcpy(p, leds, num_leds * sizeof(*p)); + + pdev = platform_device_alloc("leds-gpio", id); + if (!pdev) + goto err_free_leds; + + memset(&pdata, 0, sizeof(pdata)); + pdata.num_leds = num_leds; + pdata.leds = p; + + err = platform_device_add_data(pdev, &pdata, sizeof(pdata)); + if (err) + goto err_put_pdev; + + err = platform_device_add(pdev); + if (err) + goto err_put_pdev; + + return; + +err_put_pdev: + platform_device_put(pdev); + +err_free_leds: + kfree(p); +} diff --git a/target/linux/ramips/files/arch/mips/ralink/rt305x/Kconfig b/target/linux/ramips/files/arch/mips/ralink/rt305x/Kconfig index 3b5e15e1b8..85bee65423 100644 --- a/target/linux/ramips/files/arch/mips/ralink/rt305x/Kconfig +++ b/target/linux/ramips/files/arch/mips/ralink/rt305x/Kconfig @@ -9,6 +9,7 @@ config RT305X_MACH_GENERIC config RT305X_MACH_WHR_G300N bool "Buffalo WHR-G300N support" default y + select RALINK_DEV_GPIO_LEDS endmenu -- cgit v1.2.3