lkml.org 
[lkml]   [2007]   [May]   [10]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    Date
    SubjectRe: [PATCH 1/2] leds:arch/sh/boards/landisk LEDs supports
    From
    > Following patch sitting for a long time in our handhelds.org tree.
    >
    > kogiidena, I'm almost sure you'll find it useful, just apply patch,
    > and implement .is_led_supported function for your trigger, which will
    > eliminate trigger showing in
    > /sys/class/leds/LED_WHICH_NOT_SUPPORTS_CUSTOM_TRIGGER/triggers

    Anton Vorontsov-san
    Thank you very much .
    I confirmed the correct operation by the following patch.

    Hi Richard-san
    Is it OK ?

    LED driver of I-O DATA LANDISK and USL-5P

    Signed-off-by: kogiidena <kogiidena@eggplant.ddo.jp>

    ---
    diff -urpN OLD/drivers/leds/Kconfig NEW/drivers/leds/Kconfig
    --- OLD/drivers/leds/Kconfig 2007-04-28 06:49:26.000000000 +0900
    +++ NEW/drivers/leds/Kconfig 2007-05-10 19:54:23.000000000 +0900
    @@ -94,6 +94,12 @@ config LEDS_COBALT
    help
    This option enables support for the front LED on Cobalt Server

    +config LEDS_LANDISK
    + tristate "LED Support for LANDISK Series"
    + depends on LEDS_CLASS && SH_LANDISK
    + help
    + This option enables support for the LED on LANDISK Series
    +
    comment "LED Triggers"

    config LEDS_TRIGGERS
    diff -urpN OLD/drivers/leds/Makefile NEW/drivers/leds/Makefile
    --- OLD/drivers/leds/Makefile 2007-04-28 06:49:26.000000000 +0900
    +++ NEW/drivers/leds/Makefile 2007-05-10 19:54:44.000000000 +0900
    @@ -16,6 +16,7 @@ obj-$(CONFIG_LEDS_NET48XX) += leds-net4
    obj-$(CONFIG_LEDS_WRAP) += leds-wrap.o
    obj-$(CONFIG_LEDS_H1940) += leds-h1940.o
    obj-$(CONFIG_LEDS_COBALT) += leds-cobalt.o
    +obj-$(CONFIG_LEDS_LANDISK) += leds-landisk.o

    # LED Triggers
    obj-$(CONFIG_LEDS_TRIGGER_TIMER) += ledtrig-timer.o
    diff -urpN OLD/drivers/leds/leds-landisk.c NEW/drivers/leds/leds-landisk.c
    --- OLD/drivers/leds/leds-landisk.c 1970-01-01 09:00:00.000000000 +0900
    +++ NEW/drivers/leds/leds-landisk.c 2007-05-10 20:07:11.000000000 +0900
    @@ -0,0 +1,194 @@
    +/*
    + * LEDs driver for I-O DATA DEVICE, INC. "LANDISK Series" support.
    + *
    + * Copyright (C) 2007 kogiidena
    + *
    + * Based on the drivers/leds/leds-ams-delta.c by:
    + * Copyright (C) 2006 Jonathan McDowell <noodles@earth.li>
    + *
    + * 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/init.h>
    +#include <linux/platform_device.h>
    +#include <linux/spinlock.h>
    +#include <linux/leds.h>
    +#include <asm/io.h>
    +#include <asm/landisk/iodata_landisk.h>
    +
    +spinlock_t landisk_led_lock;
    +static int landisk_arch; /* 0:LANDISK, LANTank 1:USL-5P */
    +
    +static void landisk_led_set(struct led_classdev *led_cdev,
    + enum led_brightness value);
    +
    +static struct led_classdev landisk_leds[] = {
    + [0] = {
    + .name = "power",
    + .brightness_set = landisk_led_set,
    + .default_trigger = "blink",
    + },
    + [1] = {
    + .name = "status",
    + .brightness_set = landisk_led_set,
    + .default_trigger = "blink",
    + },
    + [2] = {
    + .name = "led1",
    + .brightness_set = landisk_led_set,
    + },
    + [3] = {
    + .name = "led2",
    + .brightness_set = landisk_led_set,
    + },
    + [4] = {
    + .name = "led3",
    + .brightness_set = landisk_led_set,
    + },
    + [5] = {
    + .name = "led4",
    + .brightness_set = landisk_led_set,
    + },
    + [6] = {
    + .name = "led5",
    + .brightness_set = landisk_led_set,
    + },
    + [7] = {
    + .name = "buzzer",
    + .default_trigger = "bitshift",
    + .brightness_set = landisk_led_set,
    + },
    +};
    +
    +static void landisk_led_set(struct led_classdev *led_cdev,
    + enum led_brightness value)
    +{
    + u8 tmp;
    + int bitmask;
    + unsigned long flags;
    +
    + bitmask = 0x01 << (led_cdev - &landisk_leds[0]);
    +
    + spin_lock_irqsave(&landisk_led_lock, flags);
    + tmp = ctrl_inb(PA_LED);
    + if (value)
    + tmp |= bitmask;
    + else
    + tmp &= ~bitmask;
    + ctrl_outb(tmp, PA_LED);
    + spin_unlock_irqrestore(&landisk_led_lock, flags);
    +}
    +
    +static int landisk_led_probe(struct platform_device *pdev)
    +{
    + int i, nr_leds;
    + int ret;
    +
    + nr_leds = landisk_arch ? 8 : 2;
    +
    + for (i = ret = 0; ret >= 0 && i < nr_leds; i++) {
    + ret = led_classdev_register(&pdev->dev, &landisk_leds[i]);
    + }
    +
    + if (ret < 0 && i > 1) {
    + nr_leds = i - 1;
    + for (i = 0; i < nr_leds; i++)
    + led_classdev_unregister(&landisk_leds[i]);
    + }
    + return ret;
    +}
    +
    +static int landisk_led_remove(struct platform_device *pdev)
    +{
    + int i, nr_leds;
    +
    + nr_leds = landisk_arch ? 8 : 2;
    +
    + for (i = 0; i < nr_leds; i++) {
    + led_classdev_unregister(&landisk_leds[i]);
    + }
    + return 0;
    +}
    +
    +static struct platform_driver landisk_led_driver = {
    + .probe = landisk_led_probe,
    + .remove = landisk_led_remove,
    + .driver = {
    + .name = "landisk-led",
    + },
    +};
    +
    +/* HDD-access-LED setting at landisk status LED */
    +static void landisk_disk_trig_activate(struct led_classdev *led_cdev)
    +{
    + unsigned long flags;
    + spin_lock_irqsave(&landisk_led_lock, flags);
    + ctrl_outb((ctrl_inb(PA_LED) & ~0x0c) | 0x04, PA_LED);
    + spin_unlock_irqrestore(&landisk_led_lock, flags);
    +}
    +
    +static void landisk_disk_trig_deactivate(struct led_classdev *led_cdev)
    +{
    + unsigned long flags;
    + spin_lock_irqsave(&landisk_led_lock, flags);
    + ctrl_outb((ctrl_inb(PA_LED) & ~0x0c) | 0x0c, PA_LED);
    + spin_unlock_irqrestore(&landisk_led_lock, flags);
    +}
    +
    +static int landisk_disk_trig_is_led_supported(struct led_classdev *led_cdev)
    +{
    + int led;
    +
    + led = (led_cdev - &landisk_leds[0]);
    + return ((landisk_arch == 0) && (led == 1));
    +}
    +
    +static struct led_trigger landisk_disk_led_trigger = {
    + .name = "disk",
    + .activate = landisk_disk_trig_activate,
    + .deactivate = landisk_disk_trig_deactivate,
    + .is_led_supported = landisk_disk_trig_is_led_supported,
    +};
    +
    +static int __init landisk_led_init(void)
    +{
    + u8 orig, test;
    + int err = 0;
    +
    + orig = ctrl_inb(PA_LED);
    + ctrl_outb(0x40, PA_LED);
    +
    + test = ctrl_inb(PA_LED);
    + ctrl_outb(orig, PA_LED);
    +
    + landisk_arch = (test == 0x40);
    +
    + if (landisk_arch == 0) {
    + /* arch == landisk */
    + ctrl_outb(orig | 0x07, PA_LED);
    + landisk_leds[1].default_trigger = "disk";
    + } else {
    + /* arch == usl-5p */
    + ctrl_outb(orig | 0x03, PA_LED);
    + }
    +
    + err = led_trigger_register(&landisk_disk_led_trigger);
    + if (err)
    + return err;
    +
    + return platform_driver_register(&landisk_led_driver);
    +}
    +
    +static void __exit landisk_led_exit(void)
    +{
    + led_trigger_unregister(&landisk_disk_led_trigger);
    + platform_driver_unregister(&landisk_led_driver);
    +}
    +
    +module_init(landisk_led_init);
    +module_exit(landisk_led_exit);
    +
    +MODULE_AUTHOR("kogiidena <kogiidena@eggplant.ddo.jp>");
    +MODULE_DESCRIPTION("landisk LED driver");
    +MODULE_LICENSE("GPL");

    -
    To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
    the body of a message to majordomo@vger.kernel.org
    More majordomo info at http://vger.kernel.org/majordomo-info.html
    Please read the FAQ at http://www.tux.org/lkml/

    \
     
     \ /
      Last update: 2007-05-10 13:55    [W:0.031 / U:0.688 seconds]
    ©2003-2016 Jasper Spaans. hosted at Digital OceanAdvertise on this site