lists.openwall.net   lists  /  announce  owl-users  owl-dev  john-users  john-dev  passwdqc-users  yescrypt  popa3d-users  /  oss-security  kernel-hardening  musl  sabotage  tlsify  passwords  /  crypt-dev  xvendor  /  Bugtraq  Full-Disclosure  linux-kernel  linux-netdev  linux-ext4  linux-hardening  linux-cve-announce  PHC 
Open Source and information security mailing list archives
 
Hash Suite: Windows password security audit tool. GUI, reports in PDF.
[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-ID: <AM5PR0501MB209772CE71020EB43FB6A797A2F80@AM5PR0501MB2097.eurprd05.prod.outlook.com>
Date:   Wed, 7 Sep 2016 12:18:29 +0000
From:   Vadim Pasternak <vadimp@...lanox.com>
To:     "Dr. David Alan Gilbert" <dave@...blig.org>
CC:     "rpurdie@...ys.net" <rpurdie@...ys.net>,
        "j.anaszewski@...sung.com" <j.anaszewski@...sung.com>,
        "linux-leds@...r.kernel.org" <linux-leds@...r.kernel.org>,
        "linux-kernel@...r.kernel.org" <linux-kernel@...r.kernel.org>,
        "jiri@...nulli.us" <jiri@...nulli.us>,
        Michael Shych <michaelsh@...lanox.com>
Subject: RE: [patch] leds: add driver for Mellanox systems leds



> -----Original Message-----
> From: Dr. David Alan Gilbert [mailto:dave@...blig.org]
> Sent: Wednesday, September 07, 2016 3:11 PM
> To: Vadim Pasternak <vadimp@...lanox.com>
> Cc: rpurdie@...ys.net; j.anaszewski@...sung.com; linux-
> leds@...r.kernel.org; linux-kernel@...r.kernel.org; jiri@...nulli.us; Michael
> Shych <michaelsh@...lanox.com>
> Subject: Re: [patch] leds: add driver for Mellanox systems leds
> 
> * vadimp@...lanox.com (vadimp@...lanox.com) wrote:
> > From: Vadim Pasternak <vadimp@...lanox.com>
> >
> > This makes it possible to create a set of LEDs for Mellanox systems:
> > "msx6710", "msx6720", "msb7700", "msn2700", "msx1410", "msn2410",
> > "msb7800", "msn2740", "msn2100".
> >
> > Driver obtains led devices according to system configuration, provided
> > through system DMI data, like fan1:green, fan1:red and creates devices
> > in
> > form: "devicename:colour:function".
> >
> > led setting is controlled through on board CPLD Lattice device.
> > For setting particular led off, solid, blink (blink requires
> > ledtrig-timer module):
> > echo 0 > /sys/class/leds/status\:green/brightness
> > echo 1 > /sys/class/leds/status\:green/brightness
> > echo timer > /sys/class/leds/status\:green/trigger
> >
> > On module probing all leds are set green, on removing - off.
> >
> > Last setting overwrites previous, f.e. sequence for changing led from
> > green - red - green:
> > echo 1 > /sys/class/leds/psu\:green/brightness
> > echo 1 > /sys/class/leds/psu\:red/brightness
> > echo 1 > /sys/class/leds/psu\:green/brightness
> > Note: leds cannot be turned on/off simultaneously.
> >
> > The Kconfig currently controlling compilation of this code is:
> > drivers/leds/Kconfig:config LEDS_MLXCPLD
> >
> > Signed-off-by: Vadim Pasternak <vadimp@...lanox.com>
> > Reviewed-by: Jiri Pirko <jiri@...lanox.com>
> > ---
> >  Documentation/leds/leds-mlxcpld.txt |  88 ++++++++
> >  MAINTAINERS                         |   8 +
> >  drivers/leds/Kconfig                |   8 +
> >  drivers/leds/Makefile               |   1 +
> >  drivers/leds/leds-mlxcpld.c         | 399
> ++++++++++++++++++++++++++++++++++++
> >  5 files changed, 504 insertions(+)
> >  create mode 100644 Documentation/leds/leds-mlxcpld.txt
> >  create mode 100644 drivers/leds/leds-mlxcpld.c
> >
> > diff --git a/Documentation/leds/leds-mlxcpld.txt
> > b/Documentation/leds/leds-mlxcpld.txt
> > new file mode 100644
> > index 0000000..575d765
> > --- /dev/null
> > +++ b/Documentation/leds/leds-mlxcpld.txt
> > @@ -0,0 +1,88 @@
> > +ver leds-mlxcpld
> > +==========================
> > +Driver for Mellanox systems leds.
> > +Provide system led support for the nex Mellanox systems:
> > +"msx6710", "msx6720", "msb7700", "msn2700", "msx1410", "msn2410",
> > +"msb7800", "msn2740", "msn2100".
> > +
> > +Description
> > +-----------
> > +Driver provides the following leds for the systems "msx6710",
> > +"msx6720", "msb7700", "msn2700", "msx1410", "msn2410", "msb7800",
> "msn2740":
> > +
> > + "status"
> > +  CPLD reg offset: 0x20
> > +  Bits [3:0]
> > +
> > + "psu"
> > +  CPLD reg offset: 0x20
> > +  Bits [7:4]
> > +
> > + "fan1"
> > +  CPLD reg offset: 0x21
> > +  Bits [3:0]
> > +
> > + "fan2"
> > +  CPLD reg offset: 0x21
> > +  Bits [7:4]
> > +
> > + "fan3"
> > +  CPLD reg offset: 0x22
> > +  Bits [3:0]
> > +
> > + "fan4"
> > +  CPLD reg offset: 0x22
> > +  Bits [7:4]
> > +
> > + Color mask for all the above leds:
> > +  [bit3,bit2,bit1,bit0] or
> > +  [bit7,bit6,bit5,bit4]:
> > +	[0,0,0,0] = LED OFF
> > +	[0,1,0,1] = Red static ON
> > +	[1,1,0,1] = Green static ON
> > +	[0,1,1,0] = Red blink 3Hz
> > +	[1,1,1,0] = Green blink 3Hz
> > +	[0,1,1,1] = Red blink 6Hz
> > +	[1,1,1,1] = Green blink 6Hz
> > +
> > +Driver provides the following leds for the system "msn2100":
> > + "status"
> > +  CPLD reg offset: 0x20
> > +  Bits [3:0]
> > +
> > + "fan"
> > +  CPLD reg offset: 0x21
> > +  Bits [3:0]
> > +
> > + "psu1"
> > +  CPLD reg offset: 0x23
> > +  Bits [3:0]
> > +
> > + "psu2"
> > +  CPLD reg offset: 0x23
> > +  Bits [7:4]
> > +
> > + "uid"
> > +  CPLD reg offset: 0x24
> > +  Bits [3:0]
> > +
> > + Color mask for all the above leds, excepted uid:
> > +  [bit3,bit2,bit1,bit0] or
> > +  [bit7,bit6,bit5,bit4]:
> > +	[0,0,0,0] = LED OFF
> > +	[0,1,0,1] = Red static ON
> > +	[1,1,0,1] = Green static ON
> > +	[0,1,1,0] = Red blink 3Hz
> > +	[1,1,1,0] = Green blink 3Hz
> > +	[0,1,1,1] = Red blink 6Hz
> > +	[1,1,1,1] = Green blink 6Hz
> > +
> > + Color mask for uid led:
> > +  [bit3,bit2,bit1,bit0]:
> > +	[0,0,0,0] = LED OFF
> > +	[1,1,0,1] = Blue static ON
> > +	[1,1,1,0] = Blue blink 3Hz
> > +	[1,1,1,1] = Blue blink 6Hz
> > +
> > +Driver supports HW blinking at 3Hz and 6Hz frequency (50% duty cycle).
> > +For 3Hz it is about 40 msec off and 40 msec on, for 6Hz - 80 msec off and on.
> > diff --git a/MAINTAINERS b/MAINTAINERS index 0bbe4b1..adb9e9b 100644
> > --- a/MAINTAINERS
> > +++ b/MAINTAINERS
> > @@ -7655,6 +7655,14 @@ W:	http://www.mellanox.com
> >  Q:	http://patchwork.ozlabs.org/project/netdev/list/
> >  F:	drivers/net/ethernet/mellanox/mlxsw/
> >
> > +MELLANOX MLXCPLD LED DRIVER
> > +M:	Vadim Pasternak <vadimp@...lanox.com>
> > +L:	linux-leds@...r.kernel.org
> > +S:	Supported
> > +W:	http://www.mellanox.com
> > +F:	drivers/leds/leds-mlxcpld.c
> > +F:	Documentation/leds/leds-mlxcpld.txt
> > +
> >  SOFT-ROCE DRIVER (rxe)
> >  M:	Moni Shoua <monis@...lanox.com>
> >  L:	linux-rdma@...r.kernel.org
> > diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig index
> > 9dcc9b1..4cd85be 100644
> > --- a/drivers/leds/Kconfig
> > +++ b/drivers/leds/Kconfig
> > @@ -631,6 +631,14 @@ config LEDS_VERSATILE
> >  	  This option enabled support for the LEDs on the ARM Versatile
> >  	  and RealView boards. Say Y to enabled these.
> >
> > +config LEDS_MLXCPLD
> > +	tristate "LED support for the Mellanox boards"
> > +	depends on X86_64 && DMI
> > +	depends on LEDS_CLASS
> > +	help
> > +	  This option enabled support for the LEDs on the Mellanox
> > +	  boards. Say Y to enabled these.
> > +
> >  comment "LED Triggers"
> >  source "drivers/leds/trigger/Kconfig"
> >
> > diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile index
> > 0684c86..9a2494b 100644
> > --- a/drivers/leds/Makefile
> > +++ b/drivers/leds/Makefile
> > @@ -68,6 +68,7 @@ obj-$(CONFIG_LEDS_KTD2692)		+= leds-
> ktd2692.o
> >  obj-$(CONFIG_LEDS_POWERNV)		+= leds-powernv.o
> >  obj-$(CONFIG_LEDS_SEAD3)		+= leds-sead3.o
> >  obj-$(CONFIG_LEDS_IS31FL32XX)		+= leds-is31fl32xx.o
> > +obj-$(CONFIG_LEDS_MLXCPLD)		+= leds-mlxcpld.o
> >
> >  # LED SPI Drivers
> >  obj-$(CONFIG_LEDS_DAC124S085)		+= leds-dac124s085.o
> > diff --git a/drivers/leds/leds-mlxcpld.c b/drivers/leds/leds-mlxcpld.c
> > new file mode 100644 index 0000000..0ec2375
> > --- /dev/null
> > +++ b/drivers/leds/leds-mlxcpld.c
> > @@ -0,0 +1,399 @@
> > +/*
> > + * drivers/leds/leds-mlxcpld.c
> > + * Copyright (c) 2016 Mellanox Technologies. All rights reserved.
> > + * Copyright (c) 2016 Vadim Pasternak <vadimp@...lanox.com>
> > + *
> > + * Redistribution and use in source and binary forms, with or without
> > + * modification, are permitted provided that the following conditions are
> met:
> > + *
> > + * 1. Redistributions of source code must retain the above copyright
> > + *    notice, this list of conditions and the following disclaimer.
> > + * 2. Redistributions in binary form must reproduce the above copyright
> > + *    notice, this list of conditions and the following disclaimer in the
> > + *    documentation and/or other materials provided with the distribution.
> > + * 3. Neither the names of the copyright holders nor the names of its
> > + *    contributors may be used to endorse or promote products derived from
> > + *    this software without specific prior written permission.
> > + *
> > + * Alternatively, this software may be distributed under the terms of
> > +the
> > + * GNU General Public License ("GPL") version 2 as published by the
> > +Free
> > + * Software Foundation.
> > + *
> > + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
> CONTRIBUTORS "AS IS"
> > + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
> LIMITED
> > +TO, THE
> > + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
> PARTICULAR
> > +PURPOSE
> > + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
> > +CONTRIBUTORS BE
> > + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
> > +OR
> > + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
> PROCUREMENT
> > +OF
> > + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
> > +BUSINESS
> > + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
> > +WHETHER IN
> > + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
> > +OTHERWISE)
> > + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
> > +ADVISED OF THE
> > + * POSSIBILITY OF SUCH DAMAGE.
> > + */
> > +
> > +#include <linux/acpi.h>
> > +#include <linux/device.h>
> > +#include <linux/dmi.h>
> > +#include <linux/hwmon.h>
> > +#include <linux/hwmon-sysfs.h>
> > +#include <linux/leds.h>
> > +#include <linux/module.h>
> > +#include <linux/mod_devicetable.h>
> > +#include <linux/platform_device.h>
> > +#include <linux/slab.h>
> > +#include <linux/version.h>
> > +
> > +#define MLXPLAT_CPLD_LPC_REG_BASE_ADRR     0x2500 /* LPC bus access
> */
> > +
> > +/* Color codes for leds */
> > +#define LED_OFFSET_HALF		0x01 /* Offset from solid for 3KHz blink
> */
> > +#define LED_OFFSET_FULL		0x02 /* Offset from solid for 6KHz blink
> */
> 
> Is that Hz rather than kHz ?
> (Your comments below also say KHz).
> 
> Dave


Hi Dave,
Thank for your review.
Right, it's Hz.
My mistake.
Thanks,
Vadim.
> 
> > +#define LED_IS_OFF		0x00 /* Off */
> > +#define LED_RED_STATIC_ON	0x05 /* Solid red */
> > +#define LED_RED_BLINK_HALF	(LED_RED_STATIC_ON +
> LED_OFFSET_HALF)
> > +#define LED_RED_BLINK_FULL	(LED_RED_STATIC_ON +
> LED_OFFSET_FULL)
> > +#define LED_GREEN_STATIC_ON	0x0D /* Solid green */
> > +#define LED_GREEN_BLINK_HALF	(LED_GREEN_STATIC_ON +
> LED_OFFSET_HALF)
> > +#define LED_GREEN_BLINK_FULL	(LED_GREEN_STATIC_ON +
> LED_OFFSET_FULL)
> > +#define LED_BLINK_3HZ		160 /* ~160 msec off/on */
> > +#define LED_BLINK_6HZ		80 /* ~80 msec off/on */
> > +
> > +/**
> > + * mlxcpld_param - led access parameters:
> > + * @offset - offset for led access in CPLD device
> > + * @mask - mask for led access in CPLD device
> > + * @base_color - base color code for led **/ struct mlxcpld_param {
> > +	u8 offset;
> > +	u8 mask;
> > +	u8 base_color;
> > +};
> > +
> > +/**
> > + * mlxcpld_led_priv - led private data:
> > + * @cled - led class device instance
> > + * @param - led CPLD access parameters **/ struct mlxcpld_led_priv {
> > +	struct led_classdev cdev;
> > +	struct mlxcpld_param param;
> > +};
> > +
> > +#define cdev_to_priv(c)		container_of(c, struct
> mlxcpld_led_priv, cdev)
> > +
> > +/**
> > + * mlxcpld_led_profile - system led profile (defined per system class):
> > + * @offset - offset for led access in CPLD device
> > + * @mask - mask for led access in CPLD device
> > + * @base_color - base color code
> > + * @brightness - default brightness setting (on/off)
> > + * @name - led name
> > +**/
> > +struct mlxcpld_led_profile {
> > +	u8 offset;
> > +	u8 mask;
> > +	u8 base_color;
> > +	enum led_brightness brightness;
> > +	const char *name;
> > +};
> > +
> > +/**
> > + * mlxcpld_led_pdata - system led private data
> > + * @pdev - platform device pointer
> > + * @pled - led class device instance
> > + * @profile - system configuration profile
> > + * @num_led_instances - number of led instances
> > + * @lock - device access lock
> > +**/
> > +struct mlxcpld_led_pdata {
> > +	struct platform_device *pdev;
> > +	struct mlxcpld_led_priv *pled;
> > +	struct mlxcpld_led_profile *profile;
> > +	int num_led_instances;
> > +	spinlock_t lock;
> > +};
> > +
> > +static struct mlxcpld_led_pdata *mlxcpld_led;
> > +
> > +/* Default profile fit the next Mellanox systems:
> > + * "msx6710", "msx6720", "msb7700", "msn2700", "msx1410",
> > + * "msn2410", "msb7800", "msn2740"
> > + */
> > +struct mlxcpld_led_profile mlxcpld_led_default_profile[] = {
> > +	{
> > +		0x21, 0xf0, LED_GREEN_STATIC_ON, 1, "fan1:green",
> > +	},
> > +	{
> > +		0x21, 0xf0, LED_RED_STATIC_ON, LED_OFF, "fan1:red",
> > +	},
> > +	{
> > +		0x21, 0x0f, LED_GREEN_STATIC_ON, 1, "fan2:green",
> > +	},
> > +	{
> > +		0x21, 0x0f, LED_RED_STATIC_ON, LED_OFF, "fan2:red",
> > +	},
> > +	{
> > +		0x22, 0xf0, LED_GREEN_STATIC_ON, 1, "fan3:green",
> > +	},
> > +	{
> > +		0x22, 0xf0, LED_RED_STATIC_ON, LED_OFF, "fan3:red",
> > +	},
> > +	{
> > +		0x22, 0x0f, LED_GREEN_STATIC_ON, 1, "fan4:green",
> > +	},
> > +	{
> > +		0x22, 0x0f, LED_RED_STATIC_ON, LED_OFF, "fan4:red",
> > +	},
> > +	{
> > +		0x20, 0x0f, LED_GREEN_STATIC_ON, 1, "psu:green",
> > +	},
> > +	{
> > +		0x20, 0x0f, LED_RED_STATIC_ON, LED_OFF, "psu:red",
> > +	},
> > +	{
> > +		0x20, 0xf0, LED_GREEN_STATIC_ON, 1, "status:green",
> > +	},
> > +	{
> > +		0x20, 0xf0, LED_RED_STATIC_ON, LED_OFF, "status:red",
> > +	},
> > +};
> > +
> > +/* Profile fit the Mellanox systems based on "msn2100" */ struct
> > +mlxcpld_led_profile mlxcpld_led_msn2100_profile[] = {
> > +	{
> > +		0x21, 0xf0, LED_GREEN_STATIC_ON, 1, "fan:green",
> > +	},
> > +	{
> > +		0x21, 0xf0, LED_RED_STATIC_ON, LED_OFF, "fan:red",
> > +	},
> > +	{
> > +		0x23, 0xf0, LED_GREEN_STATIC_ON, 1, "psu1:green",
> > +	},
> > +	{
> > +		0x23, 0xf0, LED_RED_STATIC_ON, LED_OFF, "psu1:red",
> > +	},
> > +	{
> > +		0x23, 0x0f, LED_GREEN_STATIC_ON, 1, "psu2:green",
> > +	},
> > +	{
> > +		0x23, 0x0f, LED_RED_STATIC_ON, LED_OFF, "psu2:red",
> > +	},
> > +	{
> > +		0x20, 0xf0, LED_GREEN_STATIC_ON, 1, "status:green",
> > +	},
> > +	{
> > +		0x20, 0xf0, LED_RED_STATIC_ON, LED_OFF, "status:red",
> > +	},
> > +	{
> > +		0x24, 0xf0, LED_GREEN_STATIC_ON, LED_OFF,  "uid:blue",
> > +	},
> > +};
> > +
> > +enum mlxcpld_led_platform_types {
> > +	MLXCPLD_LED_PLATFORM_DEFAULT,
> > +	MLXCPLD_LED_PLATFORM_MSN2100,
> > +};
> > +
> > +const char *mlx_product_names[] = {
> > +	"DEFAULT",
> > +	"MSN2100",
> > +};
> > +
> > +static enum
> > +mlxcpld_led_platform_types mlxcpld_led_platform_check_sys_type(void)
> > +{
> > +	const char *mlx_product_name;
> > +	int i;
> > +
> > +	mlx_product_name = dmi_get_system_info(DMI_PRODUCT_NAME);
> > +	if (!mlx_product_name)
> > +		return MLXCPLD_LED_PLATFORM_DEFAULT;
> > +
> > +	for (i = 1;  i < ARRAY_SIZE(mlx_product_names); i++) {
> > +		if (strstr(mlx_product_name, mlx_product_names[i]))
> > +			return i;
> > +	}
> > +
> > +	return MLXCPLD_LED_PLATFORM_DEFAULT; }
> > +
> > +static void mlxcpld_led_bus_access_func(u16 base, u8 offset, u8 rw_flag,
> > +					u8 *data)
> > +{
> > +	u32 addr = base + offset;
> > +
> > +	if (rw_flag == 0)
> > +		outb(*data, addr);
> > +	else
> > +		*data = inb(addr);
> > +}
> > +
> > +static void mlxcpld_led_store_hw(u8 mask, u8 off, u8 vset) {
> > +	u8 nib, val;
> > +
> > +	/* Each led is controlled through low or high nibble of the relevant
> > +	 * CPLD register. Register offset is specified by off parameter.
> > +	 * Parameter vset provides color code: 0x0 for off, 0x5 for solid red,
> > +	 * 0x6 for 3KHz blink red, 0xd for solid green, 0xe for 3KHz blink
> > +	 * green.
> > +	 * Parameter mask specifies which nibble is used for specific led: mask
> > +	 * 0xf0 - lower nibble is to be used (bits from 0 to 3), mask 0x0f -
> > +	 * higher nibble (bits from 4 to 7).
> > +	 */
> > +	spin_lock(&mlxcpld_led->lock);
> > +	mlxcpld_led_bus_access_func(MLXPLAT_CPLD_LPC_REG_BASE_ADRR,
> off, 1,
> > +				    &val);
> > +	nib = (mask == 0xf0) ? vset : (vset << 4);
> > +	val = (val & mask) | nib;
> > +	mlxcpld_led_bus_access_func(MLXPLAT_CPLD_LPC_REG_BASE_ADRR,
> off, 0,
> > +				    &val);
> > +	spin_unlock(&mlxcpld_led->lock);
> > +}
> > +
> > +static void mlxcpld_led_brightness(struct led_classdev *led,
> > +				   enum led_brightness value)
> > +{
> > +	struct mlxcpld_led_priv *pled = cdev_to_priv(led);
> > +
> > +	if (value) {
> > +		mlxcpld_led_store_hw(pled->param.mask, pled->param.offset,
> > +				     pled->param.base_color);
> > +		return;
> > +	}
> > +
> > +	mlxcpld_led_store_hw(pled->param.mask, pled->param.offset,
> > +			     LED_IS_OFF);
> > +}
> > +
> > +static int mlxcpld_led_blink(struct led_classdev *led,
> > +			     unsigned long *delay_on,
> > +			     unsigned long *delay_off)
> > +{
> > +	struct mlxcpld_led_priv *pled = cdev_to_priv(led);
> > +
> > +	/* HW supports two types of blinking: full (6KHz) and half (3KHz).
> > +	 * For delay on/off zero default setting 3KHz is used.
> > +	 */
> > +	if (!(*delay_on == 0 && *delay_off == 0) &&
> > +	    !(*delay_on == LED_BLINK_3HZ && *delay_off == LED_BLINK_3HZ)
> &&
> > +	    !(*delay_on == LED_BLINK_6HZ && *delay_off == LED_BLINK_6HZ))
> > +		return -EINVAL;
> > +
> > +	if (*delay_on == LED_BLINK_6HZ)
> > +		mlxcpld_led_store_hw(pled->param.mask, pled->param.offset,
> > +				     pled->param.base_color +
> LED_OFFSET_FULL);
> > +	else
> > +		mlxcpld_led_store_hw(pled->param.mask, pled->param.offset,
> > +				     pled->param.base_color +
> LED_OFFSET_HALF);
> > +
> > +	return 0;
> > +}
> > +
> > +static int mlxcpld_led_config(struct device *dev,
> > +			      struct mlxcpld_led_pdata *cpld) {
> > +	int i;
> > +	int err;
> > +
> > +	cpld->pled = devm_kzalloc(dev, sizeof(struct mlxcpld_led_priv) *
> > +				  cpld->num_led_instances, GFP_KERNEL);
> > +	if (!cpld->pled)
> > +		return -ENOMEM;
> > +
> > +	for (i = 0; i < cpld->num_led_instances; i++) {
> > +		cpld->pled[i].cdev.name = cpld->profile[i].name;
> > +		cpld->pled[i].cdev.brightness = cpld->profile[i].brightness;
> > +		cpld->pled[i].cdev.max_brightness = 1;
> > +		cpld->pled[i].cdev.brightness_set = mlxcpld_led_brightness;
> > +		cpld->pled[i].cdev.blink_set = mlxcpld_led_blink;
> > +		cpld->pled[i].cdev.flags = LED_CORE_SUSPENDRESUME;
> > +		err = devm_led_classdev_register(dev, &cpld->pled[i].cdev);
> > +		if (err)
> > +			return err;
> > +
> > +		cpld->pled[i].param.offset = mlxcpld_led->profile[i].offset;
> > +		cpld->pled[i].param.mask = mlxcpld_led->profile[i].mask;
> > +		cpld->pled[i].param.base_color =
> > +					mlxcpld_led->profile[i].base_color;
> > +
> > +		if (mlxcpld_led->profile[i].brightness)
> > +			mlxcpld_led_brightness(&cpld->pled[i].cdev,
> > +					mlxcpld_led->profile[i].brightness);
> > +	}
> > +
> > +	return 0;
> > +}
> > +
> > +static int __init mlxcpld_led_probe(struct platform_device *pdev) {
> > +	enum mlxcpld_led_platform_types mlxcpld_led_plat =
> > +
> 	mlxcpld_led_platform_check_sys_type();
> > +
> > +	mlxcpld_led = devm_kzalloc(&pdev->dev, sizeof(*mlxcpld_led),
> > +				   GFP_KERNEL);
> > +	if (!mlxcpld_led)
> > +		return -ENOMEM;
> > +
> > +	mlxcpld_led->pdev = pdev;
> > +
> > +	switch (mlxcpld_led_plat) {
> > +	case MLXCPLD_LED_PLATFORM_MSN2100:
> > +		mlxcpld_led->profile = mlxcpld_led_msn2100_profile;
> > +		mlxcpld_led->num_led_instances =
> > +				ARRAY_SIZE(mlxcpld_led_msn2100_profile);
> > +		break;
> > +
> > +	default:
> > +		mlxcpld_led->profile = mlxcpld_led_default_profile;
> > +		mlxcpld_led->num_led_instances =
> > +				ARRAY_SIZE(mlxcpld_led_default_profile);
> > +		break;
> > +	}
> > +
> > +	spin_lock_init(&mlxcpld_led->lock);
> > +
> > +	return mlxcpld_led_config(&pdev->dev, mlxcpld_led); }
> > +
> > +static struct platform_driver mlxcpld_led_driver = {
> > +	.driver = {
> > +		.name	= KBUILD_MODNAME,
> > +	},
> > +};
> > +
> > +static int __init mlxcpld_led_init(void) {
> > +	struct platform_device *pdev;
> > +	int err;
> > +
> > +	pdev = platform_device_register_simple(KBUILD_MODNAME, -1, NULL,
> 0);
> > +	if (!pdev) {
> > +		pr_err("Device allocation failed\n");
> > +		return -ENOMEM;
> > +	}
> > +
> > +	err = platform_driver_probe(&mlxcpld_led_driver, mlxcpld_led_probe);
> > +	if (err) {
> > +		pr_err("Probe platform driver failed\n");
> > +		platform_device_unregister(pdev);
> > +	}
> > +
> > +	return err;
> > +}
> > +
> > +static void __exit mlxcpld_led_exit(void) {
> > +	platform_device_unregister(mlxcpld_led->pdev);
> > +	platform_driver_unregister(&mlxcpld_led_driver);
> > +}
> > +
> > +module_init(mlxcpld_led_init);
> > +module_exit(mlxcpld_led_exit);
> > +
> > +MODULE_AUTHOR("Vadim Pasternak (vadimp@...lanox.com)");
> > +MODULE_DESCRIPTION("Mellanox board LED driver");
> MODULE_LICENSE("GPL
> > +v2"); MODULE_ALIAS("platform:leds_mlxcpld");
> > --
> > 2.1.4
> >
> --
>  -----Open up your eyes, open up your mind, open up your code -------
> / Dr. David Alan Gilbert    |       Running GNU/Linux       | Happy  \
> \        dave @ treblig.org |                               | In Hex /
>  \ _________________________|_____ http://www.treblig.org   |_______/

Powered by blists - more mailing lists

Powered by Openwall GNU/*/Linux Powered by OpenVZ