Hi Gene,

On 11/18/20 11:47 AM, Gene Chen wrote:
From: Gene Chen <gene_c...@richtek.com>

Add MT6360 LED driver include 2-channel Flash LED with torch/strobe mode,
3-channel RGB LED support Register/Flash/Breath Mode, and 1-channel for
moonlight LED.

Signed-off-by: Gene Chen <gene_c...@richtek.com>
---
  drivers/leds/Kconfig       |  13 +
  drivers/leds/Makefile      |   1 +
  drivers/leds/leds-mt6360.c | 808 +++++++++++++++++++++++++++++++++++++++++++++
  3 files changed, 822 insertions(+)
  create mode 100644 drivers/leds/leds-mt6360.c

diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig
index 1c181df..4f533bc 100644
--- a/drivers/leds/Kconfig
+++ b/drivers/leds/Kconfig
@@ -271,6 +271,19 @@ config LEDS_MT6323
          This option enables support for on-chip LED drivers found on
          Mediatek MT6323 PMIC.
+config LEDS_MT6360
+       tristate "LED Support for Mediatek MT6360 PMIC"
+       depends on LEDS_CLASS && OF
+       depends on LEDS_CLASS_FLASH || !LEDS_CLASS_FLASH
+       depends on LEDS_CLASS_MULTICOLOR || !LEDS_CLASS_MULTICOLOR
+       depends on V4L2_FLASH_LED_CLASS || !V4L2_FLASH_LED_CLASS
+       depends on MFD_MT6360
+       help
+         This option enables support for dual Flash LED drivers found on
+         Mediatek MT6360 PMIC.
+         Independent current sources supply for each flash LED support torch
+         and strobe mode.
+
  config LEDS_S3C24XX
        tristate "LED Support for Samsung S3C24XX GPIO LEDs"
        depends on LEDS_CLASS
diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile
index c2c7d7a..5596427 100644
--- a/drivers/leds/Makefile
+++ b/drivers/leds/Makefile
@@ -66,6 +66,7 @@ obj-$(CONFIG_LEDS_MIKROTIK_RB532)     += leds-rb532.o
  obj-$(CONFIG_LEDS_MLXCPLD)            += leds-mlxcpld.o
  obj-$(CONFIG_LEDS_MLXREG)             += leds-mlxreg.o
  obj-$(CONFIG_LEDS_MT6323)             += leds-mt6323.o
+obj-$(CONFIG_LEDS_MT6360)              += leds-mt6360.o
  obj-$(CONFIG_LEDS_NET48XX)            += leds-net48xx.o
  obj-$(CONFIG_LEDS_NETXBIG)            += leds-netxbig.o
  obj-$(CONFIG_LEDS_NIC78BX)            += leds-nic78bx.o
diff --git a/drivers/leds/leds-mt6360.c b/drivers/leds/leds-mt6360.c
new file mode 100644
index 0000000..8432901
--- /dev/null
+++ b/drivers/leds/leds-mt6360.c
@@ -0,0 +1,808 @@
+// SPDX-License-Identifier: GPL-2.0-only
+
[...]
+static int mt6360_fault_get(struct led_classdev_flash *fl_cdev, u32 *fault)
+{
+       struct mt6360_led *led = container_of(fl_cdev, struct mt6360_led, 
flash);
+       struct mt6360_priv *priv = led->priv;
+       u16 fled_stat;
+       unsigned int chg_stat, strobe_timeout_mask, fled_short_mask;
+       u32 rfault = 0;
+       int ret;

You need mutex here as well because you're making two readouts and
you have to assure atomicity of this operation.

+       ret = regmap_read(priv->regmap, MT6360_REG_CHGSTAT2, &chg_stat);
+       if (ret)
+               return ret;
+
+       ret = regmap_raw_read(priv->regmap, MT6360_REG_FLEDSTAT1, &fled_stat, 
sizeof(fled_stat));
+       if (ret)
+               return ret;
+
+       if (led->led_no == MT6360_LED_FLASH1) {
+               strobe_timeout_mask = MT6360_FLED1STRBTO_MASK;
+               fled_short_mask = MT6360_FLED1SHORT_MASK;
+       } else {
+               strobe_timeout_mask = MT6360_FLED2STRBTO_MASK;
+               fled_short_mask = MT6360_FLED2SHORT_MASK;
+       }
+
+       if (chg_stat & MT6360_FLEDCHGVINOVP_MASK)
+               rfault |= LED_FAULT_INPUT_VOLTAGE;
+
+       if (fled_stat & strobe_timeout_mask)
+               rfault |= LED_FAULT_TIMEOUT;
+
+       if (fled_stat & fled_short_mask)
+               rfault |= LED_FAULT_SHORT_CIRCUIT;
+
+       if (fled_stat & MT6360_FLEDLVF_MASK)
+               rfault |= LED_FAULT_UNDER_VOLTAGE;
+
+       *fault = rfault;
+       return 0;
+}
+
[...]

--
Best regards,
Jacek Anaszewski

Reply via email to