lkml.org 
[lkml]   [2011]   [Nov]   [18]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    Date
    From
    Subject[tip:x86/platform] x86/platform: Add TS-5500 LED support
    Commit-ID:  3a338d79aa95fbd1154db9cbad2992c0e35dc71d
    Gitweb: http://git.kernel.org/tip/3a338d79aa95fbd1154db9cbad2992c0e35dc71d
    Author: Jonas Fonseca <jonas.fonseca@savoirfairelinux.com>
    AuthorDate: Fri, 2 Sep 2011 14:30:23 -0400
    Committer: Ingo Molnar <mingo@elte.hu>
    CommitDate: Wed, 12 Oct 2011 17:37:11 +0200

    x86/platform: Add TS-5500 LED support

    Signed-off-by: Jonas Fonseca <jonas.fonseca@savoirfairelinux.com>
    Signed-off-by: Vivien Didelot <vivien.didelot@savoirfairelinux.com>
    Acked-by: Thomas Gleixner <tglx@linutronix.de>
    Link: http://lkml.kernel.org/r/1314988224-13162-4-git-send-email-vivien.didelot@savoirfairelinux.com
    Signed-off-by: Ingo Molnar <mingo@elte.hu>
    ---
    arch/x86/platform/ts5500/Kconfig | 7 ++
    arch/x86/platform/ts5500/Makefile | 1 +
    arch/x86/platform/ts5500/ts5500.c | 41 ++++++++++++
    arch/x86/platform/ts5500/ts5500_led.c | 115 +++++++++++++++++++++++++++++++++
    4 files changed, 164 insertions(+), 0 deletions(-)

    diff --git a/arch/x86/platform/ts5500/Kconfig b/arch/x86/platform/ts5500/Kconfig
    index 7e56737..310025a 100644
    --- a/arch/x86/platform/ts5500/Kconfig
    +++ b/arch/x86/platform/ts5500/Kconfig
    @@ -13,3 +13,10 @@ config TS5500_GPIO
    default y
    help
    This enables support for the DIO headers for GPIO usage.
    +
    +config TS5500_LED
    + bool "TS-5500 LED Support"
    + depends on TS5500 && LEDS_CLASS
    + default y
    + help
    + This option enables support for the on-chip LED.
    diff --git a/arch/x86/platform/ts5500/Makefile b/arch/x86/platform/ts5500/Makefile
    index 71c1398..88eccc9 100644
    --- a/arch/x86/platform/ts5500/Makefile
    +++ b/arch/x86/platform/ts5500/Makefile
    @@ -1,2 +1,3 @@
    obj-$(CONFIG_TS5500) += ts5500.o
    obj-$(CONFIG_TS5500_GPIO) += ts5500_gpio.o
    +obj-$(CONFIG_TS5500_LED) += ts5500_led.o
    diff --git a/arch/x86/platform/ts5500/ts5500.c b/arch/x86/platform/ts5500/ts5500.c
    index fe2d3df..bf43a9a 100644
    --- a/arch/x86/platform/ts5500/ts5500.c
    +++ b/arch/x86/platform/ts5500/ts5500.c
    @@ -24,6 +24,7 @@
    #include <linux/io.h>
    #include <linux/slab.h>
    #include <asm/processor.h>
    +#include <linux/leds.h>
    #include <linux/gpio.h>
    #include "ts5500_gpio.h"

    @@ -170,6 +171,43 @@ error:

    #define TS5500_IS_JP_SET(sbc, jmp) (!!(sbc->jumpers & TS5500_JP##jmp))

    +#ifdef CONFIG_TS5500_LED
    +static struct led_info ts5500_led_info = {
    + .name = "ts5500_led",
    + .default_trigger = "ts5500_led",
    + .flags = TS5500_LED_MASK
    +};
    +
    +static struct led_platform_data ts5500_led_platform_data = {
    + .num_leds = 1,
    + .leds = &ts5500_led_info
    +};
    +
    +static struct resource ts5500_led_resources[] = {
    + {
    + .name = "ts5500_led",
    + .start = TS5500_LED_JMPRS_REG,
    + .end = TS5500_LED_JMPRS_REG,
    + .flags = IORESOURCE_IO
    + }
    +};
    +
    +static void ts5500_led_release(struct device *dev)
    +{
    + /* noop */
    +}
    +
    +static struct platform_device ts5500_led_device = {
    + .name = "ts5500_led",
    + .resource = ts5500_led_resources,
    + .num_resources = ARRAY_SIZE(ts5500_led_resources),
    + .id = -1,
    + .dev = {
    + .platform_data = &ts5500_led_platform_data,
    + .release = ts5500_led_release
    + }
    +};
    +#endif

    #ifdef CONFIG_TS5500_GPIO
    /* Callback for releasing resources */
    @@ -187,6 +225,9 @@ static struct platform_device ts5500_gpio_device = {
    };
    #endif
    static struct platform_device *ts5500_devices[] __initdata = {
    +#ifdef CONFIG_TS5500_LED
    + &ts5500_led_device,
    +#endif
    #ifdef CONFIG_TS5500_GPIO
    &ts5500_gpio_device,
    #endif
    diff --git a/arch/x86/platform/ts5500/ts5500_led.c b/arch/x86/platform/ts5500/ts5500_led.c
    new file mode 100644
    index 0000000..547d16b
    --- /dev/null
    +++ b/arch/x86/platform/ts5500/ts5500_led.c
    @@ -0,0 +1,115 @@
    +/*
    + * Technologic Systems TS-5500 boards - LED driver
    + *
    + * Copyright (c) 2010 Savoir-faire Linux Inc.
    + * Jonas Fonseca <jonas.fonseca@savoirfairelinux.com>
    + *
    + * Portions Copyright (c) 2008 Compulab, Ltd.
    + * Mike Rapoport <mike@compulab.co.il>
    + *
    + * Portions Copyright (c) 2006-2008 Marvell International Ltd.
    + * Eric Miao <eric.miao@marvell.com>
    + *
    + * Based on drivers/leds/leds-da903x.c from linux-2.6.32.8.
    + *
    + * 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/module.h>
    +#include <linux/kernel.h>
    +#include <linux/init.h>
    +#include <linux/platform_device.h>
    +#include <linux/slab.h>
    +#include <linux/io.h>
    +#include <linux/leds.h>
    +
    +/**
    + * struct ts5500_led - LED structure
    + * @cdev: LED class device structure.
    + * @ioaddr: LED I/O address.
    + */
    +struct ts5500_led {
    + struct led_classdev cdev;
    + int ioaddr;
    + int bit;
    +};
    +
    +static void ts5500_led_set(struct led_classdev *led_cdev,
    + enum led_brightness value)
    +{
    + struct ts5500_led *led = container_of(led_cdev, struct ts5500_led,
    + cdev);
    + outb(!!value, led->ioaddr);
    +}
    +
    +static int __devinit ts5500_led_probe(struct platform_device *pdev)
    +{
    + struct led_platform_data *pdata = pdev->dev.platform_data;
    + struct ts5500_led *led;
    + struct resource *res;
    + int ret;
    +
    + if (pdata == NULL || !pdata->num_leds) {
    + dev_err(&pdev->dev, "No platform data available\n");
    + return -ENODEV;
    + }
    +
    + res = platform_get_resource(pdev, IORESOURCE_IO, 0);
    + if (!res) {
    + dev_err(&pdev->dev, "Failed to get I/O resource\n");
    + return -EBUSY;
    + }
    +
    + led = kzalloc(sizeof(struct ts5500_led), GFP_KERNEL);
    + if (led == NULL) {
    + dev_err(&pdev->dev, "Failed to alloc memory for LED device\n");
    + return -ENOMEM;
    + }
    +
    + led->cdev.name = pdata->leds[0].name;
    + led->cdev.default_trigger = pdata->leds[0].default_trigger;
    + led->cdev.brightness_set = ts5500_led_set;
    + led->cdev.brightness = LED_OFF;
    +
    + led->ioaddr = res->start;
    + led->bit = pdata->leds[0].flags;
    +
    + ret = led_classdev_register(pdev->dev.parent, &led->cdev);
    + if (ret) {
    + dev_err(&pdev->dev, "Failed to register LED\n");
    + goto err;
    + }
    +
    + platform_set_drvdata(pdev, led);
    + return 0;
    +
    +err:
    + kfree(led);
    + return ret;
    +}
    +
    +static struct platform_driver ts5500_led_driver = {
    + .driver = {
    + .name = "ts5500_led",
    + .owner = THIS_MODULE
    + },
    + .probe = ts5500_led_probe
    +};
    +
    +static const struct platform_device_id ts5500_devices[] = {
    + { "ts5500_led", 0 },
    + {}
    +};
    +MODULE_DEVICE_TABLE(platform, ts5500_devices);
    +
    +static int __init ts5500_led_init(void)
    +{
    + return platform_driver_register(&ts5500_led_driver);
    +}
    +module_init(ts5500_led_init);
    +
    +MODULE_LICENSE("GPL");
    +MODULE_AUTHOR("Jonas Fonseca <jonas.fonseca@savoirfairelinux.com>");
    +MODULE_DESCRIPTION("LED driver for Technologic Systems TS-5500");

    \
     
     \ /
      Last update: 2011-11-19 00:05    [W:2.381 / U:0.568 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site