1 From ecbd9c87f073f097d9fe56390353e64e963e866a Mon Sep 17 00:00:00 2001
2 From: John Crispin <john@phrozen.org>
3 Date: Tue, 6 Mar 2018 10:03:03 +0100
4 Subject: [PATCH 03/27] leds: add reset-controller based driver
6 Signed-off-by: John Crispin <john@phrozen.org>
8 drivers/leds/Kconfig | 11 ++++
9 drivers/leds/Makefile | 1 +
10 drivers/leds/leds-reset.c | 137 ++++++++++++++++++++++++++++++++++++++++++++++
11 3 files changed, 149 insertions(+)
12 create mode 100644 drivers/leds/leds-reset.c
14 Index: linux-4.14.32/drivers/leds/Kconfig
15 ===================================================================
16 --- linux-4.14.32.orig/drivers/leds/Kconfig
17 +++ linux-4.14.32/drivers/leds/Kconfig
18 @@ -696,6 +696,17 @@ config LEDS_NIC78BX
19 To compile this driver as a module, choose M here: the module
20 will be called leds-nic78bx.
23 + tristate "LED support for reset-controller API"
24 + depends on LEDS_CLASS
25 + depends on RESET_CONTROLLER
27 + This option enables support for LEDs connected to pins driven by reset
28 + controllers. Yes, DNI actual built HW like that.
30 + To compile this driver as a module, choose M here: the module
31 + will be called leds-reset.
33 comment "LED Triggers"
34 source "drivers/leds/trigger/Kconfig"
36 Index: linux-4.14.32/drivers/leds/leds-reset.c
37 ===================================================================
39 +++ linux-4.14.32/drivers/leds/leds-reset.c
42 + * Copyright (C) 2018 John Crispin <john@phrozen.org>
44 + * This program is free software; you can redistribute it and/or modify
45 + * it under the terms of the GNU General Public License version 2 as
46 + * published by the Free Software Foundation.
49 +#include <linux/err.h>
50 +#include <linux/reset.h>
51 +#include <linux/kernel.h>
52 +#include <linux/leds.h>
53 +#include <linux/module.h>
54 +#include <linux/of.h>
55 +#include <linux/platform_device.h>
56 +#include <linux/reset.h>
58 +struct reset_led_data {
59 + struct led_classdev cdev;
60 + struct reset_control *rst;
63 +static inline struct reset_led_data *
64 + cdev_to_reset_led_data(struct led_classdev *led_cdev)
66 + return container_of(led_cdev, struct reset_led_data, cdev);
69 +static void reset_led_set(struct led_classdev *led_cdev,
70 + enum led_brightness value)
72 + struct reset_led_data *led_dat = cdev_to_reset_led_data(led_cdev);
74 + if (value == LED_OFF)
75 + reset_control_assert(led_dat->rst);
77 + reset_control_deassert(led_dat->rst);
80 +struct reset_leds_priv {
82 + struct reset_led_data leds[];
85 +static inline int sizeof_reset_leds_priv(int num_leds)
87 + return sizeof(struct reset_leds_priv) +
88 + (sizeof(struct reset_led_data) * num_leds);
91 +static struct reset_leds_priv *reset_leds_create(struct platform_device *pdev)
93 + struct device *dev = &pdev->dev;
94 + struct fwnode_handle *child;
95 + struct reset_leds_priv *priv;
98 + count = device_get_child_node_count(dev);
100 + return ERR_PTR(-ENODEV);
102 + priv = devm_kzalloc(dev, sizeof_reset_leds_priv(count), GFP_KERNEL);
104 + return ERR_PTR(-ENOMEM);
106 + device_for_each_child_node(dev, child) {
107 + struct reset_led_data *led = &priv->leds[priv->num_leds];
108 + struct device_node *np = to_of_node(child);
110 + ret = fwnode_property_read_string(child, "label", &led->cdev.name);
111 + if (!led->cdev.name) {
112 + fwnode_handle_put(child);
113 + return ERR_PTR(-EINVAL);
115 + led->rst = __of_reset_control_get(np, NULL, 0, 0, 0);
116 + if (IS_ERR(led->rst))
117 + return ERR_PTR(-EINVAL);
119 + led->cdev.brightness_set = reset_led_set;
120 + ret = devm_of_led_classdev_register(&pdev->dev, np, &led->cdev);
122 + return ERR_PTR(ret);
123 + led->cdev.dev->of_node = np;
130 +static const struct of_device_id of_reset_leds_match[] = {
131 + { .compatible = "reset-leds", },
135 +MODULE_DEVICE_TABLE(of, of_reset_leds_match);
137 +static int reset_led_probe(struct platform_device *pdev)
139 + struct reset_leds_priv *priv;
141 + priv = reset_leds_create(pdev);
143 + return PTR_ERR(priv);
145 + platform_set_drvdata(pdev, priv);
150 +static void reset_led_shutdown(struct platform_device *pdev)
152 + struct reset_leds_priv *priv = platform_get_drvdata(pdev);
155 + for (i = 0; i < priv->num_leds; i++) {
156 + struct reset_led_data *led = &priv->leds[i];
158 + if (!(led->cdev.flags & LED_RETAIN_AT_SHUTDOWN))
159 + reset_led_set(&led->cdev, LED_OFF);
163 +static struct platform_driver reset_led_driver = {
164 + .probe = reset_led_probe,
165 + .shutdown = reset_led_shutdown,
167 + .name = "leds-reset",
168 + .of_match_table = of_reset_leds_match,
172 +module_platform_driver(reset_led_driver);
174 +MODULE_AUTHOR("John Crispin <john@phrozen.org>");
175 +MODULE_DESCRIPTION("reset controller LED driver");
176 +MODULE_LICENSE("GPL");
177 +MODULE_ALIAS("platform:leds-reset");
178 Index: linux-4.14.32/drivers/leds/Makefile
179 ===================================================================
180 --- linux-4.14.32.orig/drivers/leds/Makefile
181 +++ linux-4.14.32/drivers/leds/Makefile
182 @@ -73,6 +73,7 @@ obj-$(CONFIG_LEDS_PM8058) += leds-pm805
183 obj-$(CONFIG_LEDS_MLXCPLD) += leds-mlxcpld.o
184 obj-$(CONFIG_LEDS_NIC78BX) += leds-nic78bx.o
185 obj-$(CONFIG_LEDS_MT6323) += leds-mt6323.o
186 +obj-$(CONFIG_LEDS_RESET) += leds-reset.o
189 obj-$(CONFIG_LEDS_DAC124S085) += leds-dac124s085.o