target/linux/ath79/patches-4.14/0003-leds-add-reset-controller-based-driver.patch

   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
   5
   6 Signed-off-by: John Crispin <john@phrozen.org>
   7 ---
   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
  13
  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.
  21
  22 +config LEDS_RESET
  23 +       tristate "LED support for reset-controller API"
  24 +       depends on LEDS_CLASS
  25 +       depends on RESET_CONTROLLER
  26 +       help
  27 +         This option enables support for LEDs connected to pins driven by reset
  28 +         controllers. Yes, DNI actual built HW like that.
  29 +
  30 +         To compile this driver as a module, choose M here: the module
  31 +         will be called leds-reset.
  32 +
  33  comment "LED Triggers"
  34  source "drivers/leds/trigger/Kconfig"
  35
  36 Index: linux-4.14.32/drivers/leds/leds-reset.c
  37 ===================================================================
  38 --- /dev/null
  39 +++ linux-4.14.32/drivers/leds/leds-reset.c
  40 @@ -0,0 +1,137 @@
  41 +/*
  42 + * Copyright (C) 2018 John Crispin <john@phrozen.org>
  43 + *
  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.
  47 + *
  48 + */
  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>
  57 +
  58 +struct reset_led_data {
  59 +       struct led_classdev cdev;
  60 +       struct reset_control *rst;
  61 +};
  62 +
  63 +static inline struct reset_led_data *
  64 +                       cdev_to_reset_led_data(struct led_classdev *led_cdev)
  65 +{
  66 +       return container_of(led_cdev, struct reset_led_data, cdev);
  67 +}
  68 +
  69 +static void reset_led_set(struct led_classdev *led_cdev,
  70 +       enum led_brightness value)
  71 +{
  72 +       struct reset_led_data *led_dat = cdev_to_reset_led_data(led_cdev);
  73 +
  74 +       if (value == LED_OFF)
  75 +               reset_control_assert(led_dat->rst);
  76 +       else
  77 +               reset_control_deassert(led_dat->rst);
  78 +}
  79 +
  80 +struct reset_leds_priv {
  81 +       int num_leds;
  82 +       struct reset_led_data leds[];
  83 +};
  84 +
  85 +static inline int sizeof_reset_leds_priv(int num_leds)
  86 +{
  87 +       return sizeof(struct reset_leds_priv) +
  88 +               (sizeof(struct reset_led_data) * num_leds);
  89 +}
  90 +
  91 +static struct reset_leds_priv *reset_leds_create(struct platform_device *pdev)
  92 +{
  93 +       struct device *dev = &pdev->dev;
  94 +       struct fwnode_handle *child;
  95 +       struct reset_leds_priv *priv;
  96 +       int count, ret;
  97 +
  98 +       count = device_get_child_node_count(dev);
  99 +       if (!count)
 100 +               return ERR_PTR(-ENODEV);
 101 +
 102 +       priv = devm_kzalloc(dev, sizeof_reset_leds_priv(count), GFP_KERNEL);
 103 +       if (!priv)
 104 +               return ERR_PTR(-ENOMEM);
 105 +
 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);
 109 +
 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);
 114 +               }
 115 +               led->rst = __of_reset_control_get(np, NULL, 0, 0, 0);
 116 +               if (IS_ERR(led->rst))
 117 +                       return ERR_PTR(-EINVAL);
 118 +
 119 +               led->cdev.brightness_set = reset_led_set;
 120 +               ret = devm_of_led_classdev_register(&pdev->dev, np, &led->cdev);
 121 +               if (ret < 0)
 122 +                       return ERR_PTR(ret);
 123 +               led->cdev.dev->of_node = np;
 124 +               priv->num_leds++;
 125 +       }
 126 +
 127 +       return priv;
 128 +}
 129 +
 130 +static const struct of_device_id of_reset_leds_match[] = {
 131 +       { .compatible = "reset-leds", },
 132 +       {},
 133 +};
 134 +
 135 +MODULE_DEVICE_TABLE(of, of_reset_leds_match);
 136 +
 137 +static int reset_led_probe(struct platform_device *pdev)
 138 +{
 139 +       struct reset_leds_priv *priv;
 140 +
 141 +       priv = reset_leds_create(pdev);
 142 +       if (IS_ERR(priv))
 143 +               return PTR_ERR(priv);
 144 +
 145 +       platform_set_drvdata(pdev, priv);
 146 +
 147 +       return 0;
 148 +}
 149 +
 150 +static void reset_led_shutdown(struct platform_device *pdev)
 151 +{
 152 +       struct reset_leds_priv *priv = platform_get_drvdata(pdev);
 153 +       int i;
 154 +
 155 +       for (i = 0; i < priv->num_leds; i++) {
 156 +               struct reset_led_data *led = &priv->leds[i];
 157 +
 158 +               if (!(led->cdev.flags & LED_RETAIN_AT_SHUTDOWN))
 159 +                       reset_led_set(&led->cdev, LED_OFF);
 160 +       }
 161 +}
 162 +
 163 +static struct platform_driver reset_led_driver = {
 164 +       .probe          = reset_led_probe,
 165 +       .shutdown       = reset_led_shutdown,
 166 +       .driver         = {
 167 +               .name   = "leds-reset",
 168 +               .of_match_table = of_reset_leds_match,
 169 +       },
 170 +};
 171 +
 172 +module_platform_driver(reset_led_driver);
 173 +
 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
 187
 188  # LED SPI Drivers
 189  obj-$(CONFIG_LEDS_DAC124S085)          += leds-dac124s085.o