111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot/* 211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * leds-ns2.c - Driver for the Network Space v2 (and parents) dual-GPIO LED 311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * Copyright (C) 2010 LaCie 511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * Author: Simon Guinot <sguinot@lacie.com> 711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * Based on leds-gpio.c by Raphael Assenat <raph@8d.com> 911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 1011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * This program is free software; you can redistribute it and/or modify 1111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * it under the terms of the GNU General Public License as published by 1211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * the Free Software Foundation; either version 2 of the License, or 1311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * (at your option) any later version. 1411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 1511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * This program is distributed in the hope that it will be useful, 1611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * but WITHOUT ANY WARRANTY; without even the implied warranty of 1711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * GNU General Public License for more details. 1911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 2011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * You should have received a copy of the GNU General Public License 2111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * along with this program; if not, write to the Free Software 2211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 2311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot */ 2411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 2511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot#include <linux/kernel.h> 2611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot#include <linux/platform_device.h> 2711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot#include <linux/slab.h> 2811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot#include <linux/gpio.h> 2911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot#include <linux/leds.h> 3054f4dedb5368fff81b722b551e2f15a75175d7b7Paul Gortmaker#include <linux/module.h> 31c02cecb92ed49f36196ee9e29d29c4cfcbad05aeArnd Bergmann#include <linux/platform_data/leds-kirkwood-ns2.h> 32c68f46dd6aec29b4db9eb85d014981bbdd686428Sachin Kamat#include <linux/of.h> 3372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot#include <linux/of_gpio.h> 3411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 3511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot/* 3611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * The Network Space v2 dual-GPIO LED is wired to a CPLD and can blink in 3711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * relation with the SATA activity. This capability is exposed through the 3811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * "sata" sysfs attribute. 3911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 4011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * The following array detail the different LED registers and the combination 4111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * of their possible values: 4211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 4311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * cmd_led | slow_led | /SATA active | LED state 4411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * | | | 4511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 1 | 0 | x | off 4611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * - | 1 | x | on 4711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 0 | 0 | 1 | on 4811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot * 0 | 0 | 0 | blink (rate 300ms) 4911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot */ 5011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 5111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotenum ns2_led_modes { 5211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot NS_V2_LED_OFF, 5311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot NS_V2_LED_ON, 5411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot NS_V2_LED_SATA, 5511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot}; 5611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 5711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstruct ns2_led_mode_value { 5811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enum ns2_led_modes mode; 5911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int cmd_level; 6011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int slow_level; 6111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot}; 6211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 6311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic struct ns2_led_mode_value ns2_led_modval[] = { 6411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot { NS_V2_LED_OFF , 1, 0 }, 6511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot { NS_V2_LED_ON , 0, 1 }, 6611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot { NS_V2_LED_ON , 1, 1 }, 6711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot { NS_V2_LED_SATA, 0, 0 }, 6811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot}; 6911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 7011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstruct ns2_led_data { 7111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot struct led_classdev cdev; 7211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot unsigned cmd; 7311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot unsigned slow; 7411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot unsigned char sata; /* True when SATA mode active. */ 7511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot rwlock_t rw_lock; /* Lock GPIOs. */ 7611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot}; 7711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 7811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic int ns2_led_get_mode(struct ns2_led_data *led_dat, 7911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enum ns2_led_modes *mode) 8011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 8111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int i; 8211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int ret = -EINVAL; 8311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int cmd_level; 8411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int slow_level; 8511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 86f539dfedbd169e5ed47912bb517c75976ab556f3Simon Guinot read_lock_irq(&led_dat->rw_lock); 8711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 8811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot cmd_level = gpio_get_value(led_dat->cmd); 8911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot slow_level = gpio_get_value(led_dat->slow); 9011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 9111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot for (i = 0; i < ARRAY_SIZE(ns2_led_modval); i++) { 9211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (cmd_level == ns2_led_modval[i].cmd_level && 9311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot slow_level == ns2_led_modval[i].slow_level) { 9411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot *mode = ns2_led_modval[i].mode; 9511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ret = 0; 9611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot break; 9711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot } 9811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot } 9911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 100f539dfedbd169e5ed47912bb517c75976ab556f3Simon Guinot read_unlock_irq(&led_dat->rw_lock); 10111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 10211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return ret; 10311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 10411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 10511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic void ns2_led_set_mode(struct ns2_led_data *led_dat, 10611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enum ns2_led_modes mode) 10711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 10811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int i; 109f539dfedbd169e5ed47912bb517c75976ab556f3Simon Guinot unsigned long flags; 11011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 111f539dfedbd169e5ed47912bb517c75976ab556f3Simon Guinot write_lock_irqsave(&led_dat->rw_lock, flags); 11211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 11311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot for (i = 0; i < ARRAY_SIZE(ns2_led_modval); i++) { 11411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (mode == ns2_led_modval[i].mode) { 11511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot gpio_set_value(led_dat->cmd, 11611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ns2_led_modval[i].cmd_level); 11711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot gpio_set_value(led_dat->slow, 11811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ns2_led_modval[i].slow_level); 11911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot } 12011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot } 12111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 122f539dfedbd169e5ed47912bb517c75976ab556f3Simon Guinot write_unlock_irqrestore(&led_dat->rw_lock, flags); 12311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 12411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 12511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic void ns2_led_set(struct led_classdev *led_cdev, 12611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enum led_brightness value) 12711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 12811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot struct ns2_led_data *led_dat = 12911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot container_of(led_cdev, struct ns2_led_data, cdev); 13011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enum ns2_led_modes mode; 13111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 13211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (value == LED_OFF) 13311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot mode = NS_V2_LED_OFF; 13411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot else if (led_dat->sata) 13511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot mode = NS_V2_LED_SATA; 13611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot else 13711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot mode = NS_V2_LED_ON; 13811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 13911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ns2_led_set_mode(led_dat, mode); 14011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 14111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 14211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic ssize_t ns2_led_sata_store(struct device *dev, 14311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot struct device_attribute *attr, 14411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot const char *buff, size_t count) 14511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 146e5971bbc1caf0ccbab3fea74fe37abb649d1c7cfSimon Guinot struct led_classdev *led_cdev = dev_get_drvdata(dev); 147e5971bbc1caf0ccbab3fea74fe37abb649d1c7cfSimon Guinot struct ns2_led_data *led_dat = 148e5971bbc1caf0ccbab3fea74fe37abb649d1c7cfSimon Guinot container_of(led_cdev, struct ns2_led_data, cdev); 14911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int ret; 15011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot unsigned long enable; 15111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enum ns2_led_modes mode; 15211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 1533874350c598d7796a6dd2da111247be88e56d002Jingoo Han ret = kstrtoul(buff, 10, &enable); 15411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (ret < 0) 15511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return ret; 15611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 15711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enable = !!enable; 15811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 15911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (led_dat->sata == enable) 16011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return count; 16111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 16211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ret = ns2_led_get_mode(led_dat, &mode); 16311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (ret < 0) 16411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return ret; 16511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 16611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (enable && mode == NS_V2_LED_ON) 16711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ns2_led_set_mode(led_dat, NS_V2_LED_SATA); 16811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (!enable && mode == NS_V2_LED_SATA) 16911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ns2_led_set_mode(led_dat, NS_V2_LED_ON); 17011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 17111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->sata = enable; 17211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 17311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return count; 17411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 17511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 17611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic ssize_t ns2_led_sata_show(struct device *dev, 17711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot struct device_attribute *attr, char *buf) 17811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 179e5971bbc1caf0ccbab3fea74fe37abb649d1c7cfSimon Guinot struct led_classdev *led_cdev = dev_get_drvdata(dev); 180e5971bbc1caf0ccbab3fea74fe37abb649d1c7cfSimon Guinot struct ns2_led_data *led_dat = 181e5971bbc1caf0ccbab3fea74fe37abb649d1c7cfSimon Guinot container_of(led_cdev, struct ns2_led_data, cdev); 18211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 18311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return sprintf(buf, "%d\n", led_dat->sata); 18411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 18511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 18611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic DEVICE_ATTR(sata, 0644, ns2_led_sata_show, ns2_led_sata_store); 18711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 188475f85482663985550e589496bc3c1e09521838aJohan Hovoldstatic struct attribute *ns2_led_attrs[] = { 189475f85482663985550e589496bc3c1e09521838aJohan Hovold &dev_attr_sata.attr, 190475f85482663985550e589496bc3c1e09521838aJohan Hovold NULL 191475f85482663985550e589496bc3c1e09521838aJohan Hovold}; 192475f85482663985550e589496bc3c1e09521838aJohan HovoldATTRIBUTE_GROUPS(ns2_led); 193475f85482663985550e589496bc3c1e09521838aJohan Hovold 19498ea1ea20cb7090d5ae2003c23fc8a7f14fca4c7Bill Pembertonstatic int 19511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotcreate_ns2_led(struct platform_device *pdev, struct ns2_led_data *led_dat, 19611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot const struct ns2_led *template) 19711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 19811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int ret; 19911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot enum ns2_led_modes mode; 20011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 20104195823aa16d648cd7f52abd2ea6df1b9aee53fSachin Kamat ret = devm_gpio_request_one(&pdev->dev, template->cmd, 2029d04cbaadf563db3ba04426c317d3e84bc27bac1Jingoo Han gpio_get_value(template->cmd) ? 2039d04cbaadf563db3ba04426c317d3e84bc27bac1Jingoo Han GPIOF_OUT_INIT_HIGH : GPIOF_OUT_INIT_LOW, 20431c3dc7488f2564fc398d5a416726031f56d6343Jingoo Han template->name); 20511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (ret) { 20611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot dev_err(&pdev->dev, "%s: failed to setup command GPIO\n", 20711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot template->name); 20831c3dc7488f2564fc398d5a416726031f56d6343Jingoo Han return ret; 20911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot } 21011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 21104195823aa16d648cd7f52abd2ea6df1b9aee53fSachin Kamat ret = devm_gpio_request_one(&pdev->dev, template->slow, 2129d04cbaadf563db3ba04426c317d3e84bc27bac1Jingoo Han gpio_get_value(template->slow) ? 2139d04cbaadf563db3ba04426c317d3e84bc27bac1Jingoo Han GPIOF_OUT_INIT_HIGH : GPIOF_OUT_INIT_LOW, 21431c3dc7488f2564fc398d5a416726031f56d6343Jingoo Han template->name); 21511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (ret) { 21611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot dev_err(&pdev->dev, "%s: failed to setup slow GPIO\n", 21711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot template->name); 21804195823aa16d648cd7f52abd2ea6df1b9aee53fSachin Kamat return ret; 21911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot } 22011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 22111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot rwlock_init(&led_dat->rw_lock); 22211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 22311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->cdev.name = template->name; 22411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->cdev.default_trigger = template->default_trigger; 22511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->cdev.blink_set = NULL; 22611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->cdev.brightness_set = ns2_led_set; 22711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->cdev.flags |= LED_CORE_SUSPENDRESUME; 228475f85482663985550e589496bc3c1e09521838aJohan Hovold led_dat->cdev.groups = ns2_led_groups; 22911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->cmd = template->cmd; 23011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->slow = template->slow; 23111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 23211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ret = ns2_led_get_mode(led_dat, &mode); 23311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (ret < 0) 23404195823aa16d648cd7f52abd2ea6df1b9aee53fSachin Kamat return ret; 23511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 23611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot /* Set LED initial state. */ 23711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->sata = (mode == NS_V2_LED_SATA) ? 1 : 0; 23811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_dat->cdev.brightness = 23911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot (mode == NS_V2_LED_OFF) ? LED_OFF : LED_FULL; 24011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 24111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot ret = led_classdev_register(&pdev->dev, &led_dat->cdev); 24211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (ret < 0) 24304195823aa16d648cd7f52abd2ea6df1b9aee53fSachin Kamat return ret; 24411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 24511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return 0; 24611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 24711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 248b8cd742acfd78a4689148fb80cf74bc26e7f1f3cArnd Bergmannstatic void delete_ns2_led(struct ns2_led_data *led_dat) 24911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 25011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot led_classdev_unregister(&led_dat->cdev); 25111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 25211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 25372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot#ifdef CONFIG_OF_GPIO 25472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot/* 25572052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot * Translate OpenFirmware node properties into platform_data. 25672052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot */ 257cf4af01221579a4e895f43dbfc47598fbfc5a731Linus Torvaldsstatic int 25872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinotns2_leds_get_of_pdata(struct device *dev, struct ns2_led_platform_data *pdata) 25972052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot{ 26072052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot struct device_node *np = dev->of_node; 26172052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot struct device_node *child; 26272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot struct ns2_led *leds; 26372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot int num_leds = 0; 26472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot int i = 0; 26572052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 26672052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot num_leds = of_get_child_count(np); 26772052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (!num_leds) 26872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot return -ENODEV; 26972052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 27072052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot leds = devm_kzalloc(dev, num_leds * sizeof(struct ns2_led), 27172052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot GFP_KERNEL); 27272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (!leds) 27372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot return -ENOMEM; 27472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 27572052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot for_each_child_of_node(np, child) { 27672052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot const char *string; 27772052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot int ret; 27872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 27972052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot ret = of_get_named_gpio(child, "cmd-gpio", 0); 28072052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (ret < 0) 28172052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot return ret; 28272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot leds[i].cmd = ret; 28372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot ret = of_get_named_gpio(child, "slow-gpio", 0); 28472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (ret < 0) 28572052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot return ret; 28672052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot leds[i].slow = ret; 28772052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot ret = of_property_read_string(child, "label", &string); 28872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot leds[i].name = (ret == 0) ? string : child->name; 28972052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot ret = of_property_read_string(child, "linux,default-trigger", 29072052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot &string); 29172052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (ret == 0) 29272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot leds[i].default_trigger = string; 29372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 29472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot i++; 29572052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot } 29672052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 29772052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot pdata->leds = leds; 29872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot pdata->num_leds = num_leds; 29972052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 30072052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot return 0; 30172052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot} 30272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 30372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinotstatic const struct of_device_id of_ns2_leds_match[] = { 30472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot { .compatible = "lacie,ns2-leds", }, 30572052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot {}, 30672052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot}; 30772052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot#endif /* CONFIG_OF_GPIO */ 30872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 3093de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinotstruct ns2_led_priv { 3103de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot int num_leds; 3113de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot struct ns2_led_data leds_data[]; 3123de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot}; 3133de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot 3143de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinotstatic inline int sizeof_ns2_led_priv(int num_leds) 3153de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot{ 3163de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot return sizeof(struct ns2_led_priv) + 3173de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot (sizeof(struct ns2_led_data) * num_leds); 3183de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot} 3193de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot 32098ea1ea20cb7090d5ae2003c23fc8a7f14fca4c7Bill Pembertonstatic int ns2_led_probe(struct platform_device *pdev) 32111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 32287aae1ea82f93f0f00cb955044ea1db3501cf233Jingoo Han struct ns2_led_platform_data *pdata = dev_get_platdata(&pdev->dev); 3233de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot struct ns2_led_priv *priv; 32411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int i; 32511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int ret; 32611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 32772052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot#ifdef CONFIG_OF_GPIO 32872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (!pdata) { 32972052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot pdata = devm_kzalloc(&pdev->dev, 33072052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot sizeof(struct ns2_led_platform_data), 33172052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot GFP_KERNEL); 33272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (!pdata) 33372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot return -ENOMEM; 33472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot 33572052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot ret = ns2_leds_get_of_pdata(&pdev->dev, pdata); 33672052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot if (ret) 33772052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot return ret; 33872052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot } 33972052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot#else 34011efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot if (!pdata) 34111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return -EINVAL; 34272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot#endif /* CONFIG_OF_GPIO */ 34311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 3443de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot priv = devm_kzalloc(&pdev->dev, 3453de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot sizeof_ns2_led_priv(pdata->num_leds), GFP_KERNEL); 3463de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot if (!priv) 34711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return -ENOMEM; 3483de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot priv->num_leds = pdata->num_leds; 34911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 3503de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot for (i = 0; i < priv->num_leds; i++) { 3513de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot ret = create_ns2_led(pdev, &priv->leds_data[i], 3523de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot &pdata->leds[i]); 353a209f7669870c461932515eba147b961692de37fBryan Wu if (ret < 0) { 354a209f7669870c461932515eba147b961692de37fBryan Wu for (i = i - 1; i >= 0; i--) 3553de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot delete_ns2_led(&priv->leds_data[i]); 356a209f7669870c461932515eba147b961692de37fBryan Wu return ret; 357a209f7669870c461932515eba147b961692de37fBryan Wu } 35811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot } 35911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 3603de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot platform_set_drvdata(pdev, priv); 36111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 36211efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return 0; 36311efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 36411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 365678e8a6be911dd8684b894687ae88ff3b0ae4659Bill Pembertonstatic int ns2_led_remove(struct platform_device *pdev) 36611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot{ 36711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot int i; 3683de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot struct ns2_led_priv *priv; 36911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 3703de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot priv = platform_get_drvdata(pdev); 37111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 3723de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot for (i = 0; i < priv->num_leds; i++) 3733de1929ba61df87a0561c4f1fb7161c401fe3d04Simon Guinot delete_ns2_led(&priv->leds_data[i]); 37411efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 37511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot return 0; 37611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot} 37711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 37811efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinotstatic struct platform_driver ns2_led_driver = { 37911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot .probe = ns2_led_probe, 380df07cf81268192e42c4cdf91f5f4bf9aaac1b2f0Bill Pemberton .remove = ns2_led_remove, 38111efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot .driver = { 38272052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot .name = "leds-ns2", 38372052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot .owner = THIS_MODULE, 38472052fcc10263817031dd96ea438c1f49eb39dd3Simon Guinot .of_match_table = of_match_ptr(of_ns2_leds_match), 38511efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot }, 38611efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot}; 38711efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 388892a8843fbef07a7f2ab62d5f7ff5c16ea0903b0Axel Linmodule_platform_driver(ns2_led_driver); 38911efe71f6564e59ba9acfc636ac6f423e059dc69Simon Guinot 39011efe71f6564e59ba9acfc636ac6f423e059dc69Simon GuinotMODULE_AUTHOR("Simon Guinot <sguinot@lacie.com>"); 39111efe71f6564e59ba9acfc636ac6f423e059dc69Simon GuinotMODULE_DESCRIPTION("Network Space v2 LED driver"); 39211efe71f6564e59ba9acfc636ac6f423e059dc69Simon GuinotMODULE_LICENSE("GPL"); 393892a8843fbef07a7f2ab62d5f7ff5c16ea0903b0Axel LinMODULE_ALIAS("platform:leds-ns2"); 394