Doug / smarc-fsl-linux-kernel | Embedian Git Server

Commit 11efe71f6564e59ba9acfc636ac6f423e059dc69

Authored by Simon Guinot 2010-07-06 22:08:46 +0800

Committed by Nicolas Pitre 2010-07-17 10:02:00 +0800

Exists in master and in 7 other branches

leds: add LED driver for Network Space v2 LEDs

This patch add a LED class driver for the dual-GPIO LEDs found on the
Network Space v2 board (and parents). This include Internet Space v2,
Network Space (Max) v2 and d2 Network v2 boards.

This dual-GPIO LED is wired to a CPLD and can blink in relation with the
SATA activity. The driver expose this capability through a "sata" sysfs
attribute.

Signed-off-by: Simon Guinot <sguinot@lacie.com>
Signed-off-by: Nicolas Pitre <nico@fluxnic.net>

Showing 4 changed files with 374 additions and 0 deletions Inline Diff

arch/arm/mach-kirkwood/include/mach/leds-ns2.h
drivers/leds/Kconfig
drivers/leds/Makefile
drivers/leds/leds-ns2.c

arch/arm/mach-kirkwood/include/mach/leds-ns2.h

Diff comments View file @ 11efe71

File was created	1	/*
	2	* arch/arm/mach-kirkwood/include/mach/leds-ns2.h
	3	*
	4	* Platform data structure for Network Space v2 LED driver
	5	*
	6	* This file is licensed under the terms of the GNU General Public
	7	* License version 2. This program is licensed "as is" without any
	8	* warranty of any kind, whether express or implied.
	9	*/
	10
	11	#ifndef __MACH_LEDS_NS2_H
	12	#define __MACH_LEDS_NS2_H
	13
	14	struct ns2_led {
	15	const char *name;
	16	const char *default_trigger;
	17	unsigned cmd;
	18	unsigned slow;
	19	};
	20
	21	struct ns2_led_platform_data {
	22	int num_leds;
	23	struct ns2_led *leds;
	24	};
	25
	26	#endif /* __MACH_LEDS_NS2_H */
	27

drivers/leds/Kconfig

Diff comments View file @ 11efe71

 menuconfig NEW_LEDS
 	bool "LED Support"
 	help
 	  Say Y to enable Linux LED support.  This allows control of supported
 	  LEDs from both userspace and optionally, by kernel events (triggers).
 	  This is not related to standard keyboard LEDs which are controlled
 	  via the input system.
 if NEW_LEDS
 config LEDS_CLASS
 	tristate "LED Class Support"
 	help
 	  This option enables the led sysfs class in /sys/class/leds.  You'll
 	  need this to do anything useful with LEDs.  If unsure, say N.
 if LEDS_CLASS
 comment "LED drivers"
 config LEDS_88PM860X
 	tristate "LED Support for Marvell 88PM860x PMIC"
 	depends on MFD_88PM860X
 	help
 	  This option enables support for on-chip LED drivers found on Marvell
 	  Semiconductor 88PM8606 PMIC.
 config LEDS_ATMEL_PWM
 	tristate "LED Support using Atmel PWM outputs"
 	depends on ATMEL_PWM
 	help
 	  This option enables support for LEDs driven using outputs
 	  of the dedicated PWM controller found on newer Atmel SOCs.
 config LEDS_LOCOMO
 	tristate "LED Support for Locomo device"
 	depends on SHARP_LOCOMO
 	help
 	  This option enables support for the LEDs on Sharp Locomo.
 	  Zaurus models SL-5500 and SL-5600.
 config LEDS_MIKROTIK_RB532
 	tristate "LED Support for Mikrotik Routerboard 532"
 	depends on MIKROTIK_RB532
 	help
 	  This option enables support for the so called "User LED" of
 	  Mikrotik's Routerboard 532.
 config LEDS_S3C24XX
 	tristate "LED Support for Samsung S3C24XX GPIO LEDs"
 	depends on ARCH_S3C2410
 	help
 	  This option enables support for LEDs connected to GPIO lines
 	  on Samsung S3C24XX series CPUs, such as the S3C2410 and S3C2440.
 config LEDS_AMS_DELTA
 	tristate "LED Support for the Amstrad Delta (E3)"
 	depends on MACH_AMS_DELTA
 	help
 	  This option enables support for the LEDs on Amstrad Delta (E3).
 config LEDS_NET48XX
 	tristate "LED Support for Soekris net48xx series Error LED"
 	depends on SCx200_GPIO
 	help
 	  This option enables support for the Soekris net4801 and net4826 error
 	  LED.
 config LEDS_NET5501
 	tristate "LED Support for Soekris net5501 series Error LED"
 	depends on LEDS_TRIGGERS
 	depends on X86 && LEDS_GPIO_PLATFORM && GPIO_CS5535
 	select LEDS_TRIGGER_DEFAULT_ON
 	default n
 	help
 	  Add support for the Soekris net5501 board (detection, error led
 	  and GPIO).
 config LEDS_FSG
 	tristate "LED Support for the Freecom FSG-3"
 	depends on MACH_FSG
 	help
 	  This option enables support for the LEDs on the Freecom FSG-3.
 config LEDS_WRAP
 	tristate "LED Support for the WRAP series LEDs"
 	depends on SCx200_GPIO
 	help
 	  This option enables support for the PCEngines WRAP programmable LEDs.
 config LEDS_ALIX2
 	tristate "LED Support for ALIX.2 and ALIX.3 series"
 	depends on X86 && !GPIO_CS5535 && !CS5535_GPIO
 	help
 	  This option enables support for the PCEngines ALIX.2 and ALIX.3 LEDs.
 	  You have to set leds-alix2.force=1 for boards with Award BIOS.
 config LEDS_H1940
 	tristate "LED Support for iPAQ H1940 device"
 	depends on ARCH_H1940
 	help
 	  This option enables support for the LEDs on the h1940.
 config LEDS_COBALT_QUBE
 	tristate "LED Support for the Cobalt Qube series front LED"
 	depends on MIPS_COBALT
 	help
 	  This option enables support for the front LED on Cobalt Qube series
 config LEDS_COBALT_RAQ
 	bool "LED Support for the Cobalt Raq series"
 	depends on LEDS_CLASS=y && MIPS_COBALT
 	select LEDS_TRIGGERS
 	help
 	  This option enables support for the Cobalt Raq series LEDs.
 config LEDS_SUNFIRE
 	tristate "LED support for SunFire servers."
 	depends on SPARC64
 	select LEDS_TRIGGERS
 	help
 	  This option enables support for the Left, Middle, and Right
 	  LEDs on the I/O and CPU boards of SunFire UltraSPARC servers.
 config LEDS_HP6XX
 	tristate "LED Support for the HP Jornada 6xx"
 	depends on SH_HP6XX
 	help
 	  This option enables LED support for the handheld
 	  HP Jornada 620/660/680/690.
 config LEDS_PCA9532
 	tristate "LED driver for PCA9532 dimmer"
 	depends on I2C && INPUT && EXPERIMENTAL
 	help
 	  This option enables support for NXP pca9532
 	  LED controller. It is generally only useful
 	  as a platform driver
 config LEDS_GPIO
 	tristate "LED Support for GPIO connected LEDs"
 	depends on GENERIC_GPIO
 	help
 	  This option enables support for the LEDs connected to GPIO
 	  outputs. To be useful the particular board must have LEDs
 	  and they must be connected to the GPIO lines.  The LEDs must be
 	  defined as platform devices and/or OpenFirmware platform devices.
 	  The code to use these bindings can be selected below.
 config LEDS_GPIO_PLATFORM
 	bool "Platform device bindings for GPIO LEDs"
 	depends on LEDS_GPIO
 	default y
 	help
 	  Let the leds-gpio driver drive LEDs which have been defined as
 	  platform devices.  If you don't know what this means, say yes.
 config LEDS_GPIO_OF
 	bool "OpenFirmware platform device bindings for GPIO LEDs"
 	depends on LEDS_GPIO && OF_DEVICE
 	default y
 	help
 	  Let the leds-gpio driver drive LEDs which have been defined as
 	  of_platform devices.  For instance, LEDs which are listed in a "dts"
 	  file.
 config LEDS_LP3944
 	tristate "LED Support for N.S. LP3944 (Fun Light) I2C chip"
 	depends on I2C
 	help
 	  This option enables support for LEDs connected to the National
 	  Semiconductor LP3944 Lighting Management Unit (LMU) also known as
 	  Fun Light Chip.
 	  To compile this driver as a module, choose M here: the
 	  module will be called leds-lp3944.
 config LEDS_CLEVO_MAIL
 	tristate "Mail LED on Clevo notebook"
 	depends on X86 && SERIO_I8042 && DMI
 	help
 	  This driver makes the mail LED accessible from userspace
 	  programs through the leds subsystem. This LED have three
 	  known mode: off, blink at 0.5Hz and blink at 1Hz.
 	  The driver supports two kinds of interface: using ledtrig-timer
 	  or through /sys/class/leds/clevo::mail/brightness. As this LED
 	  cannot change it's brightness it blinks instead. The brightness
 	  value 0 means off, 1..127 means blink at 0.5Hz and 128..255 means
 	  blink at 1Hz.
 	  This module can drive the mail LED for the following notebooks:
 	  	Clevo D400P
 	  	Clevo D410J
 	  	Clevo D410V
 	  	Clevo D400V/D470V (not tested, but might work)
 	  	Clevo M540N
 	  	Clevo M5x0N (not tested, but might work)
 	  	Positivo Mobile (Clevo M5x0V)
 	  If your model is not listed here you can try the "nodetect"
 	  module parameter.
 	  To compile this driver as a module, choose M here: the
 	  module will be called leds-clevo-mail.
 config LEDS_PCA955X
 	tristate "LED Support for PCA955x I2C chips"
 	depends on I2C
 	help
 	  This option enables support for LEDs connected to PCA955x
 	  LED driver chips accessed via the I2C bus.  Supported
 	  devices include PCA9550, PCA9551, PCA9552, and PCA9553.
 config LEDS_WM831X_STATUS
 	tristate "LED support for status LEDs on WM831x PMICs"
 	depends on MFD_WM831X
 	help
 	  This option enables support for the status LEDs of the WM831x
           series of PMICs.
 config LEDS_WM8350
 	tristate "LED Support for WM8350 AudioPlus PMIC"
 	depends on MFD_WM8350
 	help
 	  This option enables support for LEDs driven by the Wolfson
 	  Microelectronics WM8350 AudioPlus PMIC.
 config LEDS_DA903X
 	tristate "LED Support for DA9030/DA9034 PMIC"
 	depends on PMIC_DA903X
 	help
 	  This option enables support for on-chip LED drivers found
 	  on Dialog Semiconductor DA9030/DA9034 PMICs.
 config LEDS_DAC124S085
 	tristate "LED Support for DAC124S085 SPI DAC"
 	depends on SPI
 	help
 	  This option enables support for DAC124S085 SPI DAC from NatSemi,
 	  which can be used to control up to four LEDs.
 config LEDS_PWM
 	tristate "PWM driven LED Support"
 	depends on HAVE_PWM
 	help
 	  This option enables support for pwm driven LEDs
 config LEDS_REGULATOR
 	tristate "REGULATOR driven LED support"
 	depends on REGULATOR
 	help
 	  This option enables support for regulator driven LEDs.
 config LEDS_BD2802
 	tristate "LED driver for BD2802 RGB LED"
 	depends on I2C
 	help
 	  This option enables support for BD2802GU RGB LED driver chips
 	  accessed via the I2C bus.
 config LEDS_INTEL_SS4200
 	tristate "LED driver for Intel NAS SS4200 series"
 	depends on PCI && DMI
 	help
 	  This option enables support for the Intel SS4200 series of
 	  Network Attached Storage servers.  You may control the hard
 	  drive or power LEDs on the front panel.  Using this driver
 	  can stop the front LED from blinking after startup.
 config LEDS_LT3593
 	tristate "LED driver for LT3593 controllers"
 	depends on GENERIC_GPIO
 	help
 	  This option enables support for LEDs driven by a Linear Technology
 	  LT3593 controller. This controller uses a special one-wire pulse
 	  coding protocol to set the brightness.
 config LEDS_ADP5520
 	tristate "LED Support for ADP5520/ADP5501 PMIC"
 	depends on PMIC_ADP5520
 	help
 	  This option enables support for on-chip LED drivers found
 	  on Analog Devices ADP5520/ADP5501 PMICs.
 	  To compile this driver as a module, choose M here: the module will
 	  be called leds-adp5520.
 config LEDS_DELL_NETBOOKS
 	tristate "External LED on Dell Business Netbooks"
 	depends on X86 && ACPI_WMI
 	help
 	  This adds support for the Latitude 2100 and similar
 	  notebooks that have an external LED.
 config LEDS_MC13783
 	tristate "LED Support for MC13783 PMIC"
 	depends on MFD_MC13783
 	help
 	  This option enable support for on-chip LED drivers found
 	  on Freescale Semiconductor MC13783 PMIC.
+config LEDS_NS2
+	tristate "LED support for Network Space v2 GPIO LEDs"
+	depends on MACH_NETSPACE_V2 || MACH_INETSPACE_V2 || MACH_NETSPACE_MAX_V2
+	default y
+	help
+	  This option enable support for the dual-GPIO LED found on the
+	  Network Space v2 board (and parents). This include Internet Space v2,
+	  Network Space (Max) v2 and d2 Network v2 boards.
 config LEDS_TRIGGERS
 	bool "LED Trigger support"
 	help
 	  This option enables trigger support for the leds class.
 	  These triggers allow kernel events to drive the LEDs and can
 	  be configured via sysfs. If unsure, say Y.
 if LEDS_TRIGGERS
 comment "LED Triggers"
 config LEDS_TRIGGER_TIMER
 	tristate "LED Timer Trigger"
 	help
 	  This allows LEDs to be controlled by a programmable timer
 	  via sysfs. Some LED hardware can be programmed to start
 	  blinking the LED without any further software interaction.
 	  For more details read Documentation/leds-class.txt.
 	  If unsure, say Y.
 config LEDS_TRIGGER_IDE_DISK
 	bool "LED IDE Disk Trigger"
 	depends on IDE_GD_ATA
 	help
 	  This allows LEDs to be controlled by IDE disk activity.
 	  If unsure, say Y.
 config LEDS_TRIGGER_HEARTBEAT
 	tristate "LED Heartbeat Trigger"
 	help
 	  This allows LEDs to be controlled by a CPU load average.
 	  The flash frequency is a hyperbolic function of the 1-minute
 	  load average.
 	  If unsure, say Y.
 config LEDS_TRIGGER_BACKLIGHT
 	tristate "LED backlight Trigger"
 	help
 	  This allows LEDs to be controlled as a backlight device: they
 	  turn off and on when the display is blanked and unblanked.
 	  If unsure, say N.
 config LEDS_TRIGGER_GPIO
 	tristate "LED GPIO Trigger"
 	depends on GPIOLIB
 	help
 	  This allows LEDs to be controlled by gpio events. It's good
 	  when using gpios as switches and triggering the needed LEDs
 	  from there. One use case is n810's keypad LEDs that could
 	  be triggered by this trigger when user slides up to show
 	  keypad.
 	  If unsure, say N.
 config LEDS_TRIGGER_DEFAULT_ON
 	tristate "LED Default ON Trigger"
 	help
 	  This allows LEDs to be initialised in the ON state.
 	  If unsure, say Y.
 comment "iptables trigger is under Netfilter config (LED target)"
 	depends on LEDS_TRIGGERS
 endif # LEDS_TRIGGERS
 endif # LEDS_CLASS
 endif # NEW_LEDS

drivers/leds/Makefile

Diff comments View file @ 11efe71

 # LED Core
 obj-$(CONFIG_NEW_LEDS)			+= led-core.o
 obj-$(CONFIG_LEDS_CLASS)		+= led-class.o
 obj-$(CONFIG_LEDS_TRIGGERS)		+= led-triggers.o
 # LED Platform Drivers
 obj-$(CONFIG_LEDS_88PM860X)		+= leds-88pm860x.o
 obj-$(CONFIG_LEDS_ATMEL_PWM)		+= leds-atmel-pwm.o
 obj-$(CONFIG_LEDS_BD2802)		+= leds-bd2802.o
 obj-$(CONFIG_LEDS_LOCOMO)		+= leds-locomo.o
 obj-$(CONFIG_LEDS_MIKROTIK_RB532)	+= leds-rb532.o
 obj-$(CONFIG_LEDS_S3C24XX)		+= leds-s3c24xx.o
 obj-$(CONFIG_LEDS_AMS_DELTA)		+= leds-ams-delta.o
 obj-$(CONFIG_LEDS_NET48XX)		+= leds-net48xx.o
 obj-$(CONFIG_LEDS_NET5501)		+= leds-net5501.o
 obj-$(CONFIG_LEDS_WRAP)			+= leds-wrap.o
 obj-$(CONFIG_LEDS_ALIX2)		+= leds-alix2.o
 obj-$(CONFIG_LEDS_H1940)		+= leds-h1940.o
 obj-$(CONFIG_LEDS_COBALT_QUBE)		+= leds-cobalt-qube.o
 obj-$(CONFIG_LEDS_COBALT_RAQ)		+= leds-cobalt-raq.o
 obj-$(CONFIG_LEDS_SUNFIRE)		+= leds-sunfire.o
 obj-$(CONFIG_LEDS_PCA9532)		+= leds-pca9532.o
 obj-$(CONFIG_LEDS_GPIO)			+= leds-gpio.o
 obj-$(CONFIG_LEDS_LP3944)		+= leds-lp3944.o
 obj-$(CONFIG_LEDS_CLEVO_MAIL)		+= leds-clevo-mail.o
 obj-$(CONFIG_LEDS_HP6XX)		+= leds-hp6xx.o
 obj-$(CONFIG_LEDS_FSG)			+= leds-fsg.o
 obj-$(CONFIG_LEDS_PCA955X)		+= leds-pca955x.o
 obj-$(CONFIG_LEDS_DA903X)		+= leds-da903x.o
 obj-$(CONFIG_LEDS_WM831X_STATUS)	+= leds-wm831x-status.o
 obj-$(CONFIG_LEDS_WM8350)		+= leds-wm8350.o
 obj-$(CONFIG_LEDS_PWM)			+= leds-pwm.o
 obj-$(CONFIG_LEDS_REGULATOR)		+= leds-regulator.o
 obj-$(CONFIG_LEDS_INTEL_SS4200)		+= leds-ss4200.o
 obj-$(CONFIG_LEDS_LT3593)		+= leds-lt3593.o
 obj-$(CONFIG_LEDS_ADP5520)		+= leds-adp5520.o
 obj-$(CONFIG_LEDS_DELL_NETBOOKS)	+= dell-led.o
 obj-$(CONFIG_LEDS_MC13783)		+= leds-mc13783.o
+obj-$(CONFIG_LEDS_NS2)			+= leds-ns2.o
 # LED SPI Drivers
 obj-$(CONFIG_LEDS_DAC124S085)		+= leds-dac124s085.o
 # LED Triggers
 obj-$(CONFIG_LEDS_TRIGGER_TIMER)	+= ledtrig-timer.o
 obj-$(CONFIG_LEDS_TRIGGER_IDE_DISK)	+= ledtrig-ide-disk.o
 obj-$(CONFIG_LEDS_TRIGGER_HEARTBEAT)	+= ledtrig-heartbeat.o
 obj-$(CONFIG_LEDS_TRIGGER_BACKLIGHT)	+= ledtrig-backlight.o
 obj-$(CONFIG_LEDS_TRIGGER_GPIO)		+= ledtrig-gpio.o
 obj-$(CONFIG_LEDS_TRIGGER_DEFAULT_ON)	+= ledtrig-default-on.o

drivers/leds/leds-ns2.c

Diff comments View file @ 11efe71

File was created	1	/*
	2	* leds-ns2.c - Driver for the Network Space v2 (and parents) dual-GPIO LED
	3	*
	4	* Copyright (C) 2010 LaCie
	5	*
	6	* Author: Simon Guinot <sguinot@lacie.com>
	7	*
	8	* Based on leds-gpio.c by Raphael Assenat <raph@8d.com>
	9	*
	10	* This program is free software; you can redistribute it and/or modify
	11	* it under the terms of the GNU General Public License as published by
	12	* the Free Software Foundation; either version 2 of the License, or
	13	* (at your option) any later version.
	14	*
	15	* This program is distributed in the hope that it will be useful,
	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	18	* GNU General Public License for more details.
	19	*
	20	* You should have received a copy of the GNU General Public License
	21	* along with this program; if not, write to the Free Software
	22	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	23	*/
	24
	25	#include <linux/kernel.h>
	26	#include <linux/init.h>
	27	#include <linux/platform_device.h>
	28	#include <linux/slab.h>
	29	#include <linux/gpio.h>
	30	#include <linux/leds.h>
	31	#include <mach/leds-ns2.h>
	32
	33	/*
	34	* The Network Space v2 dual-GPIO LED is wired to a CPLD and can blink in
	35	* relation with the SATA activity. This capability is exposed through the
	36	* "sata" sysfs attribute.
	37	*
	38	* The following array detail the different LED registers and the combination
	39	* of their possible values:
	40	*
	41	* cmd_led \| slow_led \| /SATA active \| LED state
	42	* \| \| \|
	43	* 1 \| 0 \| x \| off
	44	* - \| 1 \| x \| on
	45	* 0 \| 0 \| 1 \| on
	46	* 0 \| 0 \| 0 \| blink (rate 300ms)
	47	*/
	48
	49	enum ns2_led_modes {
	50	NS_V2_LED_OFF,
	51	NS_V2_LED_ON,
	52	NS_V2_LED_SATA,
	53	};
	54
	55	struct ns2_led_mode_value {
	56	enum ns2_led_modes mode;
	57	int cmd_level;
	58	int slow_level;
	59	};
	60
	61	static struct ns2_led_mode_value ns2_led_modval[] = {
	62	{ NS_V2_LED_OFF , 1, 0 },
	63	{ NS_V2_LED_ON , 0, 1 },
	64	{ NS_V2_LED_ON , 1, 1 },
	65	{ NS_V2_LED_SATA, 0, 0 },
	66	};
	67
	68	struct ns2_led_data {
	69	struct led_classdev cdev;
	70	unsigned cmd;
	71	unsigned slow;
	72	unsigned char sata; /* True when SATA mode active. */
	73	rwlock_t rw_lock; /* Lock GPIOs. */
	74	};
	75
	76	static int ns2_led_get_mode(struct ns2_led_data *led_dat,
	77	enum ns2_led_modes *mode)
	78	{
	79	int i;
	80	int ret = -EINVAL;
	81	int cmd_level;
	82	int slow_level;
	83
	84	read_lock(&led_dat->rw_lock);
	85
	86	cmd_level = gpio_get_value(led_dat->cmd);
	87	slow_level = gpio_get_value(led_dat->slow);
	88
	89	for (i = 0; i < ARRAY_SIZE(ns2_led_modval); i++) {
	90	if (cmd_level == ns2_led_modval[i].cmd_level &&
	91	slow_level == ns2_led_modval[i].slow_level) {
	92	*mode = ns2_led_modval[i].mode;
	93	ret = 0;
	94	break;
	95	}
	96	}
	97
	98	read_unlock(&led_dat->rw_lock);
	99
	100	return ret;
	101	}
	102
	103	static void ns2_led_set_mode(struct ns2_led_data *led_dat,
	104	enum ns2_led_modes mode)
	105	{
	106	int i;
	107
	108	write_lock(&led_dat->rw_lock);
	109
	110	for (i = 0; i < ARRAY_SIZE(ns2_led_modval); i++) {
	111	if (mode == ns2_led_modval[i].mode) {
	112	gpio_set_value(led_dat->cmd,
	113	ns2_led_modval[i].cmd_level);
	114	gpio_set_value(led_dat->slow,
	115	ns2_led_modval[i].slow_level);
	116	}
	117	}
	118
	119	write_unlock(&led_dat->rw_lock);
	120	}
	121
	122	static void ns2_led_set(struct led_classdev *led_cdev,
	123	enum led_brightness value)
	124	{
	125	struct ns2_led_data *led_dat =
	126	container_of(led_cdev, struct ns2_led_data, cdev);
	127	enum ns2_led_modes mode;
	128
	129	if (value == LED_OFF)
	130	mode = NS_V2_LED_OFF;
	131	else if (led_dat->sata)
	132	mode = NS_V2_LED_SATA;
	133	else
	134	mode = NS_V2_LED_ON;
	135
	136	ns2_led_set_mode(led_dat, mode);
	137	}
	138
	139	static ssize_t ns2_led_sata_store(struct device *dev,
	140	struct device_attribute *attr,
	141	const char *buff, size_t count)
	142	{
	143	int ret;
	144	unsigned long enable;
	145	enum ns2_led_modes mode;
	146	struct ns2_led_data *led_dat = dev_get_drvdata(dev);
	147
	148	ret = strict_strtoul(buff, 10, &enable);
	149	if (ret < 0)
	150	return ret;
	151
	152	enable = !!enable;
	153
	154	if (led_dat->sata == enable)
	155	return count;
	156
	157	ret = ns2_led_get_mode(led_dat, &mode);
	158	if (ret < 0)
	159	return ret;
	160
	161	if (enable && mode == NS_V2_LED_ON)
	162	ns2_led_set_mode(led_dat, NS_V2_LED_SATA);
	163	if (!enable && mode == NS_V2_LED_SATA)
	164	ns2_led_set_mode(led_dat, NS_V2_LED_ON);
	165
	166	led_dat->sata = enable;
	167
	168	return count;
	169	}
	170
	171	static ssize_t ns2_led_sata_show(struct device *dev,
	172	struct device_attribute attr, char buf)
	173	{
	174	struct ns2_led_data *led_dat = dev_get_drvdata(dev);
	175
	176	return sprintf(buf, "%d\n", led_dat->sata);
	177	}
	178
	179	static DEVICE_ATTR(sata, 0644, ns2_led_sata_show, ns2_led_sata_store);
	180
	181	static int __devinit
	182	create_ns2_led(struct platform_device pdev, struct ns2_led_data led_dat,
	183	const struct ns2_led *template)
	184	{
	185	int ret;
	186	enum ns2_led_modes mode;
	187
	188	ret = gpio_request(template->cmd, template->name);
	189	if (ret == 0) {
	190	ret = gpio_direction_output(template->cmd,
	191	gpio_get_value(template->cmd));
	192	if (ret)
	193	gpio_free(template->cmd);
	194	}
	195	if (ret) {
	196	dev_err(&pdev->dev, "%s: failed to setup command GPIO\n",
	197	template->name);
	198	}
	199
	200	ret = gpio_request(template->slow, template->name);
	201	if (ret == 0) {
	202	ret = gpio_direction_output(template->slow,
	203	gpio_get_value(template->slow));
	204	if (ret)
	205	gpio_free(template->slow);
	206	}
	207	if (ret) {
	208	dev_err(&pdev->dev, "%s: failed to setup slow GPIO\n",
	209	template->name);
	210	goto err_free_cmd;
	211	}
	212
	213	rwlock_init(&led_dat->rw_lock);
	214
	215	led_dat->cdev.name = template->name;
	216	led_dat->cdev.default_trigger = template->default_trigger;
	217	led_dat->cdev.blink_set = NULL;
	218	led_dat->cdev.brightness_set = ns2_led_set;
	219	led_dat->cdev.flags \|= LED_CORE_SUSPENDRESUME;
	220	led_dat->cmd = template->cmd;
	221	led_dat->slow = template->slow;
	222
	223	ret = ns2_led_get_mode(led_dat, &mode);
	224	if (ret < 0)
	225	goto err_free_slow;
	226
	227	/* Set LED initial state. */
	228	led_dat->sata = (mode == NS_V2_LED_SATA) ? 1 : 0;
	229	led_dat->cdev.brightness =
	230	(mode == NS_V2_LED_OFF) ? LED_OFF : LED_FULL;
	231
	232	ret = led_classdev_register(&pdev->dev, &led_dat->cdev);
	233	if (ret < 0)
	234	goto err_free_slow;
	235
	236	dev_set_drvdata(led_dat->cdev.dev, led_dat);
	237	ret = device_create_file(led_dat->cdev.dev, &dev_attr_sata);
	238	if (ret < 0)
	239	goto err_free_cdev;
	240
	241	return 0;
	242
	243	err_free_cdev:
	244	led_classdev_unregister(&led_dat->cdev);
	245	err_free_slow:
	246	gpio_free(led_dat->slow);
	247	err_free_cmd:
	248	gpio_free(led_dat->cmd);
	249
	250	return ret;
	251	}
	252
	253	static void __devexit delete_ns2_led(struct ns2_led_data *led_dat)
	254	{
	255	device_remove_file(led_dat->cdev.dev, &dev_attr_sata);
	256	led_classdev_unregister(&led_dat->cdev);
	257	gpio_free(led_dat->cmd);
	258	gpio_free(led_dat->slow);
	259	}
	260
	261	static int __devinit ns2_led_probe(struct platform_device *pdev)
	262	{
	263	struct ns2_led_platform_data *pdata = pdev->dev.platform_data;
	264	struct ns2_led_data *leds_data;
	265	int i;
	266	int ret;
	267
	268	if (!pdata)
	269	return -EINVAL;
	270
	271	leds_data = kzalloc(sizeof(struct ns2_led_data) *
	272	pdata->num_leds, GFP_KERNEL);
	273	if (!leds_data)
	274	return -ENOMEM;
	275
	276	for (i = 0; i < pdata->num_leds; i++) {
	277	ret = create_ns2_led(pdev, &leds_data[i], &pdata->leds[i]);
	278	if (ret < 0)
	279	goto err;
	280
	281	}
	282
	283	platform_set_drvdata(pdev, leds_data);
	284
	285	return 0;
	286
	287	err:
	288	for (i = i - 1; i >= 0; i--)
	289	delete_ns2_led(&leds_data[i]);
	290
	291	kfree(leds_data);
	292
	293	return ret;
	294	}
	295
	296	static int __devexit ns2_led_remove(struct platform_device *pdev)
	297	{
	298	int i;
	299	struct ns2_led_platform_data *pdata = pdev->dev.platform_data;
	300	struct ns2_led_data *leds_data;
	301
	302	leds_data = platform_get_drvdata(pdev);
	303
	304	for (i = 0; i < pdata->num_leds; i++)
	305	delete_ns2_led(&leds_data[i]);
	306
	307	kfree(leds_data);
	308	platform_set_drvdata(pdev, NULL);
	309
	310	return 0;
	311	}
	312
	313	static struct platform_driver ns2_led_driver = {
	314	.probe = ns2_led_probe,
	315	.remove = __devexit_p(ns2_led_remove),
	316	.driver = {
	317	.name = "leds-ns2",
	318	.owner = THIS_MODULE,
	319	},
	320	};
	321	MODULE_ALIAS("platform:leds-ns2");
	322
	323	static int __init ns2_led_init(void)
	324	{
	325	return platform_driver_register(&ns2_led_driver);
	326	}
	327
	328	static void __exit ns2_led_exit(void)
	329	{
	330	platform_driver_unregister(&ns2_led_driver);
	331	}
	332
	333	module_init(ns2_led_init);
	334	module_exit(ns2_led_exit);
	335
	336	MODULE_AUTHOR("Simon Guinot <sguinot@lacie.com>");
	337	MODULE_DESCRIPTION("Network Space v2 LED driver");
	338	MODULE_LICENSE("GPL");
	339