From eb5a4422e448a8200ddaafef0cc16db3f45ec1f8 Mon Sep 17 00:00:00 2001 From: Linus Walleij Date: Fri, 28 May 2021 22:24:01 +0200 Subject: leds: max77693: Move driver to flash subdirectory We created a subdirectory for LED drivers that depend on CONFIG_LEDS_CLASS_FLASH, and this driver does so let's move it there. Signed-off-by: Linus Walleij Acked-by: Jacek Anaszewski Signed-off-by: Pavel Machek --- drivers/leds/Kconfig | 11 - drivers/leds/Makefile | 1 - drivers/leds/flash/Kconfig | 10 + drivers/leds/flash/Makefile | 1 + drivers/leds/flash/leds-max77693.c | 1059 ++++++++++++++++++++++++++++++++++++ drivers/leds/leds-max77693.c | 1059 ------------------------------------ 6 files changed, 1070 insertions(+), 1071 deletions(-) create mode 100644 drivers/leds/flash/leds-max77693.c delete mode 100644 drivers/leds/leds-max77693.c (limited to 'drivers/leds') diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig index cfa6b8194b6b..723de0d30039 100644 --- a/drivers/leds/Kconfig +++ b/drivers/leds/Kconfig @@ -680,17 +680,6 @@ config LEDS_MAX77650 help LEDs driver for MAX77650 family of PMICs from Maxim Integrated. -config LEDS_MAX77693 - tristate "LED support for MAX77693 Flash" - depends on LEDS_CLASS_FLASH - depends on V4L2_FLASH_LED_CLASS || !V4L2_FLASH_LED_CLASS - depends on MFD_MAX77693 - depends on OF - help - This option enables support for the flash part of the MAX77693 - multifunction device. It has build in control for two leds in flash - and torch mode. - config LEDS_MAX8997 tristate "LED support for MAX8997 PMIC" depends on LEDS_CLASS && MFD_MAX8997 diff --git a/drivers/leds/Makefile b/drivers/leds/Makefile index a3a6fda8ab99..6f4aa0e6e355 100644 --- a/drivers/leds/Makefile +++ b/drivers/leds/Makefile @@ -58,7 +58,6 @@ obj-$(CONFIG_LEDS_LP8788) += leds-lp8788.o obj-$(CONFIG_LEDS_LP8860) += leds-lp8860.o obj-$(CONFIG_LEDS_LT3593) += leds-lt3593.o obj-$(CONFIG_LEDS_MAX77650) += leds-max77650.o -obj-$(CONFIG_LEDS_MAX77693) += leds-max77693.o obj-$(CONFIG_LEDS_MAX8997) += leds-max8997.o obj-$(CONFIG_LEDS_MC13783) += leds-mc13783.o obj-$(CONFIG_LEDS_MENF21BMC) += leds-menf21bmc.o diff --git a/drivers/leds/flash/Kconfig b/drivers/leds/flash/Kconfig index 1126ad3954b6..6401af23947f 100644 --- a/drivers/leds/flash/Kconfig +++ b/drivers/leds/flash/Kconfig @@ -20,6 +20,16 @@ config LEDS_AS3645A controller. V4L2 flash API is provided as well if CONFIG_V4L2_FLASH_API is enabled. +config LEDS_MAX77693 + tristate "LED support for MAX77693 Flash" + depends on V4L2_FLASH_LED_CLASS || !V4L2_FLASH_LED_CLASS + depends on MFD_MAX77693 + depends on OF + help + This option enables support for the flash part of the MAX77693 + multifunction device. It has build in control for two leds in flash + and torch mode. + config LEDS_RT4505 tristate "LED support for RT4505 flashlight controller" depends on I2C && OF diff --git a/drivers/leds/flash/Makefile b/drivers/leds/flash/Makefile index 9bb2fccee047..c2a5e530261d 100644 --- a/drivers/leds/flash/Makefile +++ b/drivers/leds/flash/Makefile @@ -2,5 +2,6 @@ obj-$(CONFIG_LEDS_AAT1290) += leds-aat1290.o obj-$(CONFIG_LEDS_AS3645A) += leds-as3645a.o +obj-$(CONFIG_LEDS_MAX77693) += leds-max77693.o obj-$(CONFIG_LEDS_RT4505) += leds-rt4505.o obj-$(CONFIG_LEDS_RT8515) += leds-rt8515.o diff --git a/drivers/leds/flash/leds-max77693.c b/drivers/leds/flash/leds-max77693.c new file mode 100644 index 000000000000..5c1faeb55a31 --- /dev/null +++ b/drivers/leds/flash/leds-max77693.c @@ -0,0 +1,1059 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * LED Flash class driver for the flash cell of max77693 mfd. + * + * Copyright (C) 2015, Samsung Electronics Co., Ltd. + * + * Authors: Jacek Anaszewski + * Andrzej Hajda + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define MODE_OFF 0 +#define MODE_FLASH(a) (1 << (a)) +#define MODE_TORCH(a) (1 << (2 + (a))) +#define MODE_FLASH_EXTERNAL(a) (1 << (4 + (a))) + +#define MODE_FLASH_MASK (MODE_FLASH(FLED1) | MODE_FLASH(FLED2) | \ + MODE_FLASH_EXTERNAL(FLED1) | \ + MODE_FLASH_EXTERNAL(FLED2)) +#define MODE_TORCH_MASK (MODE_TORCH(FLED1) | MODE_TORCH(FLED2)) + +#define FLED1_IOUT (1 << 0) +#define FLED2_IOUT (1 << 1) + +enum max77693_fled { + FLED1, + FLED2, +}; + +enum max77693_led_mode { + FLASH, + TORCH, +}; + +struct max77693_led_config_data { + const char *label[2]; + u32 iout_torch_max[2]; + u32 iout_flash_max[2]; + u32 flash_timeout_max[2]; + u32 num_leds; + u32 boost_mode; + u32 boost_vout; + u32 low_vsys; +}; + +struct max77693_sub_led { + /* corresponding FLED output identifier */ + int fled_id; + /* corresponding LED Flash class device */ + struct led_classdev_flash fled_cdev; + /* V4L2 Flash device */ + struct v4l2_flash *v4l2_flash; + + /* brightness cache */ + unsigned int torch_brightness; + /* flash timeout cache */ + unsigned int flash_timeout; + /* flash faults that may have occurred */ + u32 flash_faults; +}; + +struct max77693_led_device { + /* parent mfd regmap */ + struct regmap *regmap; + /* platform device data */ + struct platform_device *pdev; + /* secures access to the device */ + struct mutex lock; + + /* sub led data */ + struct max77693_sub_led sub_leds[2]; + + /* maximum torch current values for FLED outputs */ + u32 iout_torch_max[2]; + /* maximum flash current values for FLED outputs */ + u32 iout_flash_max[2]; + + /* current flash timeout cache */ + unsigned int current_flash_timeout; + /* ITORCH register cache */ + u8 torch_iout_reg; + /* mode of fled outputs */ + unsigned int mode_flags; + /* recently strobed fled */ + int strobing_sub_led_id; + /* bitmask of FLED outputs use state (bit 0. - FLED1, bit 1. - FLED2) */ + u8 fled_mask; + /* FLED modes that can be set */ + u8 allowed_modes; + + /* arrangement of current outputs */ + bool iout_joint; +}; + +static u8 max77693_led_iout_to_reg(u32 ua) +{ + if (ua < FLASH_IOUT_MIN) + ua = FLASH_IOUT_MIN; + return (ua - FLASH_IOUT_MIN) / FLASH_IOUT_STEP; +} + +static u8 max77693_flash_timeout_to_reg(u32 us) +{ + return (us - FLASH_TIMEOUT_MIN) / FLASH_TIMEOUT_STEP; +} + +static inline struct max77693_sub_led *flcdev_to_sub_led( + struct led_classdev_flash *fled_cdev) +{ + return container_of(fled_cdev, struct max77693_sub_led, fled_cdev); +} + +static inline struct max77693_led_device *sub_led_to_led( + struct max77693_sub_led *sub_led) +{ + return container_of(sub_led, struct max77693_led_device, + sub_leds[sub_led->fled_id]); +} + +static inline u8 max77693_led_vsys_to_reg(u32 mv) +{ + return ((mv - MAX_FLASH1_VSYS_MIN) / MAX_FLASH1_VSYS_STEP) << 2; +} + +static inline u8 max77693_led_vout_to_reg(u32 mv) +{ + return (mv - FLASH_VOUT_MIN) / FLASH_VOUT_STEP + FLASH_VOUT_RMIN; +} + +static inline bool max77693_fled_used(struct max77693_led_device *led, + int fled_id) +{ + u8 fled_bit = (fled_id == FLED1) ? FLED1_IOUT : FLED2_IOUT; + + return led->fled_mask & fled_bit; +} + +static int max77693_set_mode_reg(struct max77693_led_device *led, u8 mode) +{ + struct regmap *rmap = led->regmap; + int ret, v = 0, i; + + for (i = FLED1; i <= FLED2; ++i) { + if (mode & MODE_TORCH(i)) + v |= FLASH_EN_ON << TORCH_EN_SHIFT(i); + + if (mode & MODE_FLASH(i)) { + v |= FLASH_EN_ON << FLASH_EN_SHIFT(i); + } else if (mode & MODE_FLASH_EXTERNAL(i)) { + v |= FLASH_EN_FLASH << FLASH_EN_SHIFT(i); + /* + * Enable hw triggering also for torch mode, as some + * camera sensors use torch led to fathom ambient light + * conditions before strobing the flash. + */ + v |= FLASH_EN_TORCH << TORCH_EN_SHIFT(i); + } + } + + /* Reset the register only prior setting flash modes */ + if (mode & ~(MODE_TORCH(FLED1) | MODE_TORCH(FLED2))) { + ret = regmap_write(rmap, MAX77693_LED_REG_FLASH_EN, 0); + if (ret < 0) + return ret; + } + + return regmap_write(rmap, MAX77693_LED_REG_FLASH_EN, v); +} + +static int max77693_add_mode(struct max77693_led_device *led, u8 mode) +{ + u8 new_mode_flags; + int i, ret; + + if (led->iout_joint) + /* Span the mode on FLED2 for joint iouts case */ + mode |= (mode << 1); + + /* + * FLASH_EXTERNAL mode activates FLASHEN and TORCHEN pins in the device. + * Corresponding register bit fields interfere with SW triggered modes, + * thus clear them to ensure proper device configuration. + */ + for (i = FLED1; i <= FLED2; ++i) + if (mode & MODE_FLASH_EXTERNAL(i)) + led->mode_flags &= (~MODE_TORCH(i) & ~MODE_FLASH(i)); + + new_mode_flags = mode | led->mode_flags; + new_mode_flags &= led->allowed_modes; + + if (new_mode_flags ^ led->mode_flags) + led->mode_flags = new_mode_flags; + else + return 0; + + ret = max77693_set_mode_reg(led, led->mode_flags); + if (ret < 0) + return ret; + + /* + * Clear flash mode flag after setting the mode to avoid spurious flash + * strobing on each subsequent torch mode setting. + */ + if (mode & MODE_FLASH_MASK) + led->mode_flags &= ~mode; + + return ret; +} + +static int max77693_clear_mode(struct max77693_led_device *led, + u8 mode) +{ + if (led->iout_joint) + /* Clear mode also on FLED2 for joint iouts case */ + mode |= (mode << 1); + + led->mode_flags &= ~mode; + + return max77693_set_mode_reg(led, led->mode_flags); +} + +static void max77693_add_allowed_modes(struct max77693_led_device *led, + int fled_id, enum max77693_led_mode mode) +{ + if (mode == FLASH) + led->allowed_modes |= (MODE_FLASH(fled_id) | + MODE_FLASH_EXTERNAL(fled_id)); + else + led->allowed_modes |= MODE_TORCH(fled_id); +} + +static void max77693_distribute_currents(struct max77693_led_device *led, + int fled_id, enum max77693_led_mode mode, + u32 micro_amp, u32 iout_max[2], u32 iout[2]) +{ + if (!led->iout_joint) { + iout[fled_id] = micro_amp; + max77693_add_allowed_modes(led, fled_id, mode); + return; + } + + iout[FLED1] = min(micro_amp, iout_max[FLED1]); + iout[FLED2] = micro_amp - iout[FLED1]; + + if (mode == FLASH) + led->allowed_modes &= ~MODE_FLASH_MASK; + else + led->allowed_modes &= ~MODE_TORCH_MASK; + + max77693_add_allowed_modes(led, FLED1, mode); + + if (iout[FLED2]) + max77693_add_allowed_modes(led, FLED2, mode); +} + +static int max77693_set_torch_current(struct max77693_led_device *led, + int fled_id, u32 micro_amp) +{ + struct regmap *rmap = led->regmap; + u8 iout1_reg = 0, iout2_reg = 0; + u32 iout[2]; + + max77693_distribute_currents(led, fled_id, TORCH, micro_amp, + led->iout_torch_max, iout); + + if (fled_id == FLED1 || led->iout_joint) { + iout1_reg = max77693_led_iout_to_reg(iout[FLED1]); + led->torch_iout_reg &= TORCH_IOUT_MASK(TORCH_IOUT2_SHIFT); + } + if (fled_id == FLED2 || led->iout_joint) { + iout2_reg = max77693_led_iout_to_reg(iout[FLED2]); + led->torch_iout_reg &= TORCH_IOUT_MASK(TORCH_IOUT1_SHIFT); + } + + led->torch_iout_reg |= ((iout1_reg << TORCH_IOUT1_SHIFT) | + (iout2_reg << TORCH_IOUT2_SHIFT)); + + return regmap_write(rmap, MAX77693_LED_REG_ITORCH, + led->torch_iout_reg); +} + +static int max77693_set_flash_current(struct max77693_led_device *led, + int fled_id, + u32 micro_amp) +{ + struct regmap *rmap = led->regmap; + u8 iout1_reg, iout2_reg; + u32 iout[2]; + int ret = -EINVAL; + + max77693_distribute_currents(led, fled_id, FLASH, micro_amp, + led->iout_flash_max, iout); + + if (fled_id == FLED1 || led->iout_joint) { + iout1_reg = max77693_led_iout_to_reg(iout[FLED1]); + ret = regmap_write(rmap, MAX77693_LED_REG_IFLASH1, + iout1_reg); + if (ret < 0) + return ret; + } + if (fled_id == FLED2 || led->iout_joint) { + iout2_reg = max77693_led_iout_to_reg(iout[FLED2]); + ret = regmap_write(rmap, MAX77693_LED_REG_IFLASH2, + iout2_reg); + } + + return ret; +} + +static int max77693_set_timeout(struct max77693_led_device *led, u32 microsec) +{ + struct regmap *rmap = led->regmap; + u8 v; + int ret; + + v = max77693_flash_timeout_to_reg(microsec) | FLASH_TMR_LEVEL; + + ret = regmap_write(rmap, MAX77693_LED_REG_FLASH_TIMER, v); + if (ret < 0) + return ret; + + led->current_flash_timeout = microsec; + + return 0; +} + +static int max77693_get_strobe_status(struct max77693_led_device *led, + bool *state) +{ + struct regmap *rmap = led->regmap; + unsigned int v; + int ret; + + ret = regmap_read(rmap, MAX77693_LED_REG_FLASH_STATUS, &v); + if (ret < 0) + return ret; + + *state = v & FLASH_STATUS_FLASH_ON; + + return ret; +} + +static int max77693_get_flash_faults(struct max77693_sub_led *sub_led) +{ + struct max77693_led_device *led = sub_led_to_led(sub_led); + struct regmap *rmap = led->regmap; + unsigned int v; + u8 fault_open_mask, fault_short_mask; + int ret; + + sub_led->flash_faults = 0; + + if (led->iout_joint) { + fault_open_mask = FLASH_INT_FLED1_OPEN | FLASH_INT_FLED2_OPEN; + fault_short_mask = FLASH_INT_FLED1_SHORT | + FLASH_INT_FLED2_SHORT; + } else { + fault_open_mask = (sub_led->fled_id == FLED1) ? + FLASH_INT_FLED1_OPEN : + FLASH_INT_FLED2_OPEN; + fault_short_mask = (sub_led->fled_id == FLED1) ? + FLASH_INT_FLED1_SHORT : + FLASH_INT_FLED2_SHORT; + } + + ret = regmap_read(rmap, MAX77693_LED_REG_FLASH_INT, &v); + if (ret < 0) + return ret; + + if (v & fault_open_mask) + sub_led->flash_faults |= LED_FAULT_OVER_VOLTAGE; + if (v & fault_short_mask) + sub_led->flash_faults |= LED_FAULT_SHORT_CIRCUIT; + if (v & FLASH_INT_OVER_CURRENT) + sub_led->flash_faults |= LED_FAULT_OVER_CURRENT; + + return 0; +} + +static int max77693_setup(struct max77693_led_device *led, + struct max77693_led_config_data *led_cfg) +{ + struct regmap *rmap = led->regmap; + int i, first_led, last_led, ret; + u32 max_flash_curr[2]; + u8 v; + + /* + * Initialize only flash current. Torch current doesn't + * require initialization as ITORCH register is written with + * new value each time brightness_set op is called. + */ + if (led->iout_joint) { + first_led = FLED1; + last_led = FLED1; + max_flash_curr[FLED1] = led_cfg->iout_flash_max[FLED1] + + led_cfg->iout_flash_max[FLED2]; + } else { + first_led = max77693_fled_used(led, FLED1) ? FLED1 : FLED2; + last_led = max77693_fled_used(led, FLED2) ? FLED2 : FLED1; + max_flash_curr[FLED1] = led_cfg->iout_flash_max[FLED1]; + max_flash_curr[FLED2] = led_cfg->iout_flash_max[FLED2]; + } + + for (i = first_led; i <= last_led; ++i) { + ret = max77693_set_flash_current(led, i, + max_flash_curr[i]); + if (ret < 0) + return ret; + } + + v = TORCH_TMR_NO_TIMER | MAX77693_LED_TRIG_TYPE_LEVEL; + ret = regmap_write(rmap, MAX77693_LED_REG_ITORCHTIMER, v); + if (ret < 0) + return ret; + + if (led_cfg->low_vsys > 0) + v = max77693_led_vsys_to_reg(led_cfg->low_vsys) | + MAX_FLASH1_MAX_FL_EN; + else + v = 0; + + ret = regmap_write(rmap, MAX77693_LED_REG_MAX_FLASH1, v); + if (ret < 0) + return ret; + ret = regmap_write(rmap, MAX77693_LED_REG_MAX_FLASH2, 0); + if (ret < 0) + return ret; + + if (led_cfg->boost_mode == MAX77693_LED_BOOST_FIXED) + v = FLASH_BOOST_FIXED; + else + v = led_cfg->boost_mode | led_cfg->boost_mode << 1; + + if (max77693_fled_used(led, FLED1) && max77693_fled_used(led, FLED2)) + v |= FLASH_BOOST_LEDNUM_2; + + ret = regmap_write(rmap, MAX77693_LED_REG_VOUT_CNTL, v); + if (ret < 0) + return ret; + + v = max77693_led_vout_to_reg(led_cfg->boost_vout); + ret = regmap_write(rmap, MAX77693_LED_REG_VOUT_FLASH1, v); + if (ret < 0) + return ret; + + return max77693_set_mode_reg(led, MODE_OFF); +} + +/* LED subsystem callbacks */ +static int max77693_led_brightness_set(struct led_classdev *led_cdev, + enum led_brightness value) +{ + struct led_classdev_flash *fled_cdev = lcdev_to_flcdev(led_cdev); + struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); + struct max77693_led_device *led = sub_led_to_led(sub_led); + int fled_id = sub_led->fled_id, ret; + + mutex_lock(&led->lock); + + if (value == 0) { + ret = max77693_clear_mode(led, MODE_TORCH(fled_id)); + if (ret < 0) + dev_dbg(&led->pdev->dev, + "Failed to clear torch mode (%d)\n", + ret); + goto unlock; + } + + ret = max77693_set_torch_current(led, fled_id, value * TORCH_IOUT_STEP); + if (ret < 0) { + dev_dbg(&led->pdev->dev, + "Failed to set torch current (%d)\n", + ret); + goto unlock; + } + + ret = max77693_add_mode(led, MODE_TORCH(fled_id)); + if (ret < 0) + dev_dbg(&led->pdev->dev, + "Failed to set torch mode (%d)\n", + ret); +unlock: + mutex_unlock(&led->lock); + + return ret; +} + +static int max77693_led_flash_brightness_set( + struct led_classdev_flash *fled_cdev, + u32 brightness) +{ + struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); + struct max77693_led_device *led = sub_led_to_led(sub_led); + int ret; + + mutex_lock(&led->lock); + ret = max77693_set_flash_current(led, sub_led->fled_id, brightness); + mutex_unlock(&led->lock); + + return ret; +} + +static int max77693_led_flash_strobe_set( + struct led_classdev_flash *fled_cdev, + bool state) +{ + struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); + struct max77693_led_device *led = sub_led_to_led(sub_led); + int fled_id = sub_led->fled_id; + int ret; + + mutex_lock(&led->lock); + + if (!state) { + ret = max77693_clear_mode(led, MODE_FLASH(fled_id)); + goto unlock; + } + + if (sub_led->flash_timeout != led->current_flash_timeout) { + ret = max77693_set_timeout(led, sub_led->flash_timeout); + if (ret < 0) + goto unlock; + } + + led->strobing_sub_led_id = fled_id; + + ret = max77693_add_mode(led, MODE_FLASH(fled_id)); + if (ret < 0) + goto unlock; + + ret = max77693_get_flash_faults(sub_led); + +unlock: + mutex_unlock(&led->lock); + return ret; +} + +static int max77693_led_flash_fault_get( + struct led_classdev_flash *fled_cdev, + u32 *fault) +{ + struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); + + *fault = sub_led->flash_faults; + + return 0; +} + +static int max77693_led_flash_strobe_get( + struct led_classdev_flash *fled_cdev, + bool *state) +{ + struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); + struct max77693_led_device *led = sub_led_to_led(sub_led); + int ret; + + if (!state) + return -EINVAL; + + mutex_lock(&led->lock); + + ret = max77693_get_strobe_status(led, state); + + *state = !!(*state && (led->strobing_sub_led_id == sub_led->fled_id)); + + mutex_unlock(&led->lock); + + return ret; +} + +static int max77693_led_flash_timeout_set( + struct led_classdev_flash *fled_cdev, + u32 timeout) +{ + struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); + struct max77693_led_device *led = sub_led_to_led(sub_led); + + mutex_lock(&led->lock); + sub_led->flash_timeout = timeout; + mutex_unlock(&led->lock); + + return 0; +} + +static int max77693_led_parse_dt(struct max77693_led_device *led, + struct max77693_led_config_data *cfg, + struct device_node **sub_nodes) +{ + struct device *dev = &led->pdev->dev; + struct max77693_sub_led *sub_leds = led->sub_leds; + struct device_node *node = dev_of_node(dev), *child_node; + struct property *prop; + u32 led_sources[2]; + int i, ret, fled_id; + + of_property_read_u32(node, "maxim,boost-mode", &cfg->boost_mode); + of_property_read_u32(node, "maxim,boost-mvout", &cfg->boost_vout); + of_property_read_u32(node, "maxim,mvsys-min", &cfg->low_vsys); + + for_each_available_child_of_node(node, child_node) { + prop = of_find_property(child_node, "led-sources", NULL); + if (prop) { + const __be32 *srcs = NULL; + + for (i = 0; i < ARRAY_SIZE(led_sources); ++i) { + srcs = of_prop_next_u32(prop, srcs, + &led_sources[i]); + if (!srcs) + break; + } + } else { + dev_err(dev, + "led-sources DT property missing\n"); + of_node_put(child_node); + return -EINVAL; + } + + if (i == 2) { + fled_id = FLED1; + led->fled_mask = FLED1_IOUT | FLED2_IOUT; + } else if (led_sources[0] == FLED1) { + fled_id = FLED1; + led->fled_mask |= FLED1_IOUT; + } else if (led_sources[0] == FLED2) { + fled_id = FLED2; + led->fled_mask |= FLED2_IOUT; + } else { + dev_err(dev, + "Wrong led-sources DT property value.\n"); + of_node_put(child_node); + return -EINVAL; + } + + if (sub_nodes[fled_id]) { + dev_err(dev, + "Conflicting \"led-sources\" DT properties\n"); + of_node_put(child_node); + return -EINVAL; + } + + sub_nodes[fled_id] = child_node; + sub_leds[fled_id].fled_id = fled_id; + + cfg->label[fled_id] = + of_get_property(child_node, "label", NULL) ? : + child_node->name; + + ret = of_property_read_u32(child_node, "led-max-microamp", + &cfg->iout_torch_max[fled_id]); + if (ret < 0) { + cfg->iout_torch_max[fled_id] = TORCH_IOUT_MIN; + dev_warn(dev, "led-max-microamp DT property missing\n"); + } + + ret = of_property_read_u32(child_node, "flash-max-microamp", + &cfg->iout_flash_max[fled_id]); + if (ret < 0) { + cfg->iout_flash_max[fled_id] = FLASH_IOUT_MIN; + dev_warn(dev, + "flash-max-microamp DT property missing\n"); + } + + ret = of_property_read_u32(child_node, "flash-max-timeout-us", + &cfg->flash_timeout_max[fled_id]); + if (ret < 0) { + cfg->flash_timeout_max[fled_id] = FLASH_TIMEOUT_MIN; + dev_warn(dev, + "flash-max-timeout-us DT property missing\n"); + } + + if (++cfg->num_leds == 2 || + (max77693_fled_used(led, FLED1) && + max77693_fled_used(led, FLED2))) { + of_node_put(child_node); + break; + } + } + + if (cfg->num_leds == 0) { + dev_err(dev, "No DT child node found for connected LED(s).\n"); + return -EINVAL; + } + + return 0; +} + +static void clamp_align(u32 *v, u32 min, u32 max, u32 step) +{ + *v = clamp_val(*v, min, max); + if (step > 1) + *v = (*v - min) / step * step + min; +} + +static void max77693_align_iout_current(struct max77693_led_device *led, + u32 *iout, u32 min, u32 max, u32 step) +{ + int i; + + if (led->iout_joint) { + if (iout[FLED1] > min) { + iout[FLED1] /= 2; + iout[FLED2] = iout[FLED1]; + } else { + iout[FLED1] = min; + iout[FLED2] = 0; + return; + } + } + + for (i = FLED1; i <= FLED2; ++i) + if (max77693_fled_used(led, i)) + clamp_align(&iout[i], min, max, step); + else + iout[i] = 0; +} + +static void max77693_led_validate_configuration(struct max77693_led_device *led, + struct max77693_led_config_data *cfg) +{ + u32 flash_iout_max = cfg->boost_mode ? FLASH_IOUT_MAX_2LEDS : + FLASH_IOUT_MAX_1LED; + int i; + + if (cfg->num_leds == 1 && + max77693_fled_used(led, FLED1) && max77693_fled_used(led, FLED2)) + led->iout_joint = true; + + cfg->boost_mode = clamp_val(cfg->boost_mode, MAX77693_LED_BOOST_NONE, + MAX77693_LED_BOOST_FIXED); + + /* Boost must be enabled if both current outputs are used */ + if ((cfg->boost_mode == MAX77693_LED_BOOST_NONE) && led->iout_joint) + cfg->boost_mode = MAX77693_LED_BOOST_FIXED; + + max77693_align_iout_current(led, cfg->iout_torch_max, + TORCH_IOUT_MIN, TORCH_IOUT_MAX, TORCH_IOUT_STEP); + + max77693_align_iout_current(led, cfg->iout_flash_max, + FLASH_IOUT_MIN, flash_iout_max, FLASH_IOUT_STEP); + + for (i = 0; i < ARRAY_SIZE(cfg->flash_timeout_max); ++i) + clamp_align(&cfg->flash_timeout_max[i], FLASH_TIMEOUT_MIN, + FLASH_TIMEOUT_MAX, FLASH_TIMEOUT_STEP); + + clamp_align(&cfg->boost_vout, FLASH_VOUT_MIN, FLASH_VOUT_MAX, + FLASH_VOUT_STEP); + + if (cfg->low_vsys) + clamp_align(&cfg->low_vsys, MAX_FLASH1_VSYS_MIN, + MAX_FLASH1_VSYS_MAX, MAX_FLASH1_VSYS_STEP); +} + +static int max77693_led_get_configuration(struct max77693_led_device *led, + struct max77693_led_config_data *cfg, + struct device_node **sub_nodes) +{ + int ret; + + ret = max77693_led_parse_dt(led, cfg, sub_nodes); + if (ret < 0) + return ret; + + max77693_led_validate_configuration(led, cfg); + + memcpy(led->iout_torch_max, cfg->iout_torch_max, + sizeof(led->iout_torch_max)); + memcpy(led->iout_flash_max, cfg->iout_flash_max, + sizeof(led->iout_flash_max)); + + return 0; +} + +static const struct led_flash_ops flash_ops = { + .flash_brightness_set = max77693_led_flash_brightness_set, + .strobe_set = max77693_led_flash_strobe_set, + .strobe_get = max77693_led_flash_strobe_get, + .timeout_set = max77693_led_flash_timeout_set, + .fault_get = max77693_led_flash_fault_get, +}; + +static void max77693_init_flash_settings(struct max77693_sub_led *sub_led, + struct max77693_led_config_data *led_cfg) +{ + struct led_classdev_flash *fled_cdev = &sub_led->fled_cdev; + struct max77693_led_device *led = sub_led_to_led(sub_led); + int fled_id = sub_led->fled_id; + struct led_flash_setting *setting; + + /* Init flash intensity setting */ + setting = &fled_cdev->brightness; + setting->min = FLASH_IOUT_MIN; + setting->max = led->iout_joint ? + led_cfg->iout_flash_max[FLED1] + + led_cfg->iout_flash_max[FLED2] : + led_cfg->iout_flash_max[fled_id]; + setting->step = FLASH_IOUT_STEP; + setting->val = setting->max; + + /* Init flash timeout setting */ + setting = &fled_cdev->timeout; + setting->min = FLASH_TIMEOUT_MIN; + setting->max = led_cfg->flash_timeout_max[fled_id]; + setting->step = FLASH_TIMEOUT_STEP; + setting->val = setting->max; +} + +#if IS_ENABLED(CONFIG_V4L2_FLASH_LED_CLASS) + +static int max77693_led_external_strobe_set( + struct v4l2_flash *v4l2_flash, + bool enable) +{ + struct max77693_sub_led *sub_led = + flcdev_to_sub_led(v4l2_flash->fled_cdev); + struct max77693_led_device *led = sub_led_to_led(sub_led); + int fled_id = sub_led->fled_id; + int ret; + + mutex_lock(&led->lock); + + if (enable) + ret = max77693_add_mode(led, MODE_FLASH_EXTERNAL(fled_id)); + else + ret = max77693_clear_mode(led, MODE_FLASH_EXTERNAL(fled_id)); + + mutex_unlock(&led->lock); + + return ret; +} + +static void max77693_init_v4l2_flash_config(struct max77693_sub_led *sub_led, + struct max77693_led_config_data *led_cfg, + struct v4l2_flash_config *v4l2_sd_cfg) +{ + struct max77693_led_device *led = sub_led_to_led(sub_led); + struct device *dev = &led->pdev->dev; + struct max77693_dev *iodev = dev_get_drvdata(dev->parent); + struct i2c_client *i2c = iodev->i2c; + struct led_flash_setting *s; + + snprintf(v4l2_sd_cfg->dev_name, sizeof(v4l2_sd_cfg->dev_name), + "%s %d-%04x", sub_led->fled_cdev.led_cdev.name, + i2c_adapter_id(i2c->adapter), i2c->addr); + + s = &v4l2_sd_cfg->intensity; + s->min = TORCH_IOUT_MIN; + s->max = sub_led->fled_cdev.led_cdev.max_brightness * TORCH_IOUT_STEP; + s->step = TORCH_IOUT_STEP; + s->val = s->max; + + /* Init flash faults config */ + v4l2_sd_cfg->flash_faults = LED_FAULT_OVER_VOLTAGE | + LED_FAULT_SHORT_CIRCUIT | + LED_FAULT_OVER_CURRENT; + + v4l2_sd_cfg->has_external_strobe = true; +} + +static const struct v4l2_flash_ops v4l2_flash_ops = { + .external_strobe_set = max77693_led_external_strobe_set, +}; +#else +static inline void max77693_init_v4l2_flash_config( + struct max77693_sub_led *sub_led, + struct max77693_led_config_data *led_cfg, + struct v4l2_flash_config *v4l2_sd_cfg) +{ +} +static const struct v4l2_flash_ops v4l2_flash_ops; +#endif + +static void max77693_init_fled_cdev(struct max77693_sub_led *sub_led, + struct max77693_led_config_data *led_cfg) +{ + struct max77693_led_device *led = sub_led_to_led(sub_led); + int fled_id = sub_led->fled_id; + struct led_classdev_flash *fled_cdev; + struct led_classdev *led_cdev; + + /* Initialize LED Flash class device */ + fled_cdev = &sub_led->fled_cdev; + fled_cdev->ops = &flash_ops; + led_cdev = &fled_cdev->led_cdev; + + led_cdev->name = led_cfg->label[fled_id]; + + led_cdev->brightness_set_blocking = max77693_led_brightness_set; + led_cdev->max_brightness = (led->iout_joint ? + led_cfg->iout_torch_max[FLED1] + + led_cfg->iout_torch_max[FLED2] : + led_cfg->iout_torch_max[fled_id]) / + TORCH_IOUT_STEP; + led_cdev->flags |= LED_DEV_CAP_FLASH; + + max77693_init_flash_settings(sub_led, led_cfg); + + /* Init flash timeout cache */ + sub_led->flash_timeout = fled_cdev->timeout.val; +} + +static int max77693_register_led(struct max77693_sub_led *sub_led, + struct max77693_led_config_data *led_cfg, + struct device_node *sub_node) +{ + struct max77693_led_device *led = sub_led_to_led(sub_led); + struct led_classdev_flash *fled_cdev = &sub_led->fled_cdev; + struct device *dev = &led->pdev->dev; + struct v4l2_flash_config v4l2_sd_cfg = {}; + int ret; + + /* Register in the LED subsystem */ + ret = led_classdev_flash_register(dev, fled_cdev); + if (ret < 0) + return ret; + + max77693_init_v4l2_flash_config(sub_led, led_cfg, &v4l2_sd_cfg); + + /* Register in the V4L2 subsystem. */ + sub_led->v4l2_flash = v4l2_flash_init(dev, of_fwnode_handle(sub_node), + fled_cdev, &v4l2_flash_ops, + &v4l2_sd_cfg); + if (IS_ERR(sub_led->v4l2_flash)) { + ret = PTR_ERR(sub_led->v4l2_flash); + goto err_v4l2_flash_init; + } + + return 0; + +err_v4l2_flash_init: + led_classdev_flash_unregister(fled_cdev); + return ret; +} + +static int max77693_led_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct max77693_dev *iodev = dev_get_drvdata(dev->parent); + struct max77693_led_device *led; + struct max77693_sub_led *sub_leds; + struct device_node *sub_nodes[2] = {}; + struct max77693_led_config_data led_cfg = {}; + int init_fled_cdev[2], i, ret; + + led = devm_kzalloc(dev, sizeof(*led), GFP_KERNEL); + if (!led) + return -ENOMEM; + + led->pdev = pdev; + led->regmap = iodev->regmap; + led->allowed_modes = MODE_FLASH_MASK; + sub_leds = led->sub_leds; + + platform_set_drvdata(pdev, led); + ret = max77693_led_get_configuration(led, &led_cfg, sub_nodes); + if (ret < 0) + return ret; + + ret = max77693_setup(led, &led_cfg); + if (ret < 0) + return ret; + + mutex_init(&led->lock); + + init_fled_cdev[FLED1] = + led->iout_joint || max77693_fled_used(led, FLED1); + init_fled_cdev[FLED2] = + !led->iout_joint && max77693_fled_used(led, FLED2); + + for (i = FLED1; i <= FLED2; ++i) { + if (!init_fled_cdev[i]) + continue; + + /* Initialize LED Flash class device */ + max77693_init_fled_cdev(&sub_leds[i], &led_cfg); + + /* + * Register LED Flash class device and corresponding + * V4L2 Flash device. + */ + ret = max77693_register_led(&sub_leds[i], &led_cfg, + sub_nodes[i]); + if (ret < 0) { + /* + * At this moment FLED1 might have been already + * registered and it needs to be released. + */ + if (i == FLED2) + goto err_register_led2; + else + goto err_register_led1; + } + } + + return 0; + +err_register_led2: + /* It is possible than only FLED2 was to be registered */ + if (!init_fled_cdev[FLED1]) + goto err_register_led1; + v4l2_flash_release(sub_leds[FLED1].v4l2_flash); + led_classdev_flash_unregister(&sub_leds[FLED1].fled_cdev); +err_register_led1: + mutex_destroy(&led->lock); + + return ret; +} + +static int max77693_led_remove(struct platform_device *pdev) +{ + struct max77693_led_device *led = platform_get_drvdata(pdev); + struct max77693_sub_led *sub_leds = led->sub_leds; + + if (led->iout_joint || max77693_fled_used(led, FLED1)) { + v4l2_flash_release(sub_leds[FLED1].v4l2_flash); + led_classdev_flash_unregister(&sub_leds[FLED1].fled_cdev); + } + + if (!led->iout_joint && max77693_fled_used(led, FLED2)) { + v4l2_flash_release(sub_leds[FLED2].v4l2_flash); + led_classdev_flash_unregister(&sub_leds[FLED2].fled_cdev); + } + + mutex_destroy(&led->lock); + + return 0; +} + +static const struct of_device_id max77693_led_dt_match[] = { + { .compatible = "maxim,max77693-led" }, + {}, +}; +MODULE_DEVICE_TABLE(of, max77693_led_dt_match); + +static struct platform_driver max77693_led_driver = { + .probe = max77693_led_probe, + .remove = max77693_led_remove, + .driver = { + .name = "max77693-led", + .of_match_table = max77693_led_dt_match, + }, +}; + +module_platform_driver(max77693_led_driver); + +MODULE_AUTHOR("Jacek Anaszewski "); +MODULE_AUTHOR("Andrzej Hajda "); +MODULE_DESCRIPTION("Maxim MAX77693 led flash driver"); +MODULE_LICENSE("GPL v2"); diff --git a/drivers/leds/leds-max77693.c b/drivers/leds/leds-max77693.c deleted file mode 100644 index 5c1faeb55a31..000000000000 --- a/drivers/leds/leds-max77693.c +++ /dev/null @@ -1,1059 +0,0 @@ -// SPDX-License-Identifier: GPL-2.0-only -/* - * LED Flash class driver for the flash cell of max77693 mfd. - * - * Copyright (C) 2015, Samsung Electronics Co., Ltd. - * - * Authors: Jacek Anaszewski - * Andrzej Hajda - */ - -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#define MODE_OFF 0 -#define MODE_FLASH(a) (1 << (a)) -#define MODE_TORCH(a) (1 << (2 + (a))) -#define MODE_FLASH_EXTERNAL(a) (1 << (4 + (a))) - -#define MODE_FLASH_MASK (MODE_FLASH(FLED1) | MODE_FLASH(FLED2) | \ - MODE_FLASH_EXTERNAL(FLED1) | \ - MODE_FLASH_EXTERNAL(FLED2)) -#define MODE_TORCH_MASK (MODE_TORCH(FLED1) | MODE_TORCH(FLED2)) - -#define FLED1_IOUT (1 << 0) -#define FLED2_IOUT (1 << 1) - -enum max77693_fled { - FLED1, - FLED2, -}; - -enum max77693_led_mode { - FLASH, - TORCH, -}; - -struct max77693_led_config_data { - const char *label[2]; - u32 iout_torch_max[2]; - u32 iout_flash_max[2]; - u32 flash_timeout_max[2]; - u32 num_leds; - u32 boost_mode; - u32 boost_vout; - u32 low_vsys; -}; - -struct max77693_sub_led { - /* corresponding FLED output identifier */ - int fled_id; - /* corresponding LED Flash class device */ - struct led_classdev_flash fled_cdev; - /* V4L2 Flash device */ - struct v4l2_flash *v4l2_flash; - - /* brightness cache */ - unsigned int torch_brightness; - /* flash timeout cache */ - unsigned int flash_timeout; - /* flash faults that may have occurred */ - u32 flash_faults; -}; - -struct max77693_led_device { - /* parent mfd regmap */ - struct regmap *regmap; - /* platform device data */ - struct platform_device *pdev; - /* secures access to the device */ - struct mutex lock; - - /* sub led data */ - struct max77693_sub_led sub_leds[2]; - - /* maximum torch current values for FLED outputs */ - u32 iout_torch_max[2]; - /* maximum flash current values for FLED outputs */ - u32 iout_flash_max[2]; - - /* current flash timeout cache */ - unsigned int current_flash_timeout; - /* ITORCH register cache */ - u8 torch_iout_reg; - /* mode of fled outputs */ - unsigned int mode_flags; - /* recently strobed fled */ - int strobing_sub_led_id; - /* bitmask of FLED outputs use state (bit 0. - FLED1, bit 1. - FLED2) */ - u8 fled_mask; - /* FLED modes that can be set */ - u8 allowed_modes; - - /* arrangement of current outputs */ - bool iout_joint; -}; - -static u8 max77693_led_iout_to_reg(u32 ua) -{ - if (ua < FLASH_IOUT_MIN) - ua = FLASH_IOUT_MIN; - return (ua - FLASH_IOUT_MIN) / FLASH_IOUT_STEP; -} - -static u8 max77693_flash_timeout_to_reg(u32 us) -{ - return (us - FLASH_TIMEOUT_MIN) / FLASH_TIMEOUT_STEP; -} - -static inline struct max77693_sub_led *flcdev_to_sub_led( - struct led_classdev_flash *fled_cdev) -{ - return container_of(fled_cdev, struct max77693_sub_led, fled_cdev); -} - -static inline struct max77693_led_device *sub_led_to_led( - struct max77693_sub_led *sub_led) -{ - return container_of(sub_led, struct max77693_led_device, - sub_leds[sub_led->fled_id]); -} - -static inline u8 max77693_led_vsys_to_reg(u32 mv) -{ - return ((mv - MAX_FLASH1_VSYS_MIN) / MAX_FLASH1_VSYS_STEP) << 2; -} - -static inline u8 max77693_led_vout_to_reg(u32 mv) -{ - return (mv - FLASH_VOUT_MIN) / FLASH_VOUT_STEP + FLASH_VOUT_RMIN; -} - -static inline bool max77693_fled_used(struct max77693_led_device *led, - int fled_id) -{ - u8 fled_bit = (fled_id == FLED1) ? FLED1_IOUT : FLED2_IOUT; - - return led->fled_mask & fled_bit; -} - -static int max77693_set_mode_reg(struct max77693_led_device *led, u8 mode) -{ - struct regmap *rmap = led->regmap; - int ret, v = 0, i; - - for (i = FLED1; i <= FLED2; ++i) { - if (mode & MODE_TORCH(i)) - v |= FLASH_EN_ON << TORCH_EN_SHIFT(i); - - if (mode & MODE_FLASH(i)) { - v |= FLASH_EN_ON << FLASH_EN_SHIFT(i); - } else if (mode & MODE_FLASH_EXTERNAL(i)) { - v |= FLASH_EN_FLASH << FLASH_EN_SHIFT(i); - /* - * Enable hw triggering also for torch mode, as some - * camera sensors use torch led to fathom ambient light - * conditions before strobing the flash. - */ - v |= FLASH_EN_TORCH << TORCH_EN_SHIFT(i); - } - } - - /* Reset the register only prior setting flash modes */ - if (mode & ~(MODE_TORCH(FLED1) | MODE_TORCH(FLED2))) { - ret = regmap_write(rmap, MAX77693_LED_REG_FLASH_EN, 0); - if (ret < 0) - return ret; - } - - return regmap_write(rmap, MAX77693_LED_REG_FLASH_EN, v); -} - -static int max77693_add_mode(struct max77693_led_device *led, u8 mode) -{ - u8 new_mode_flags; - int i, ret; - - if (led->iout_joint) - /* Span the mode on FLED2 for joint iouts case */ - mode |= (mode << 1); - - /* - * FLASH_EXTERNAL mode activates FLASHEN and TORCHEN pins in the device. - * Corresponding register bit fields interfere with SW triggered modes, - * thus clear them to ensure proper device configuration. - */ - for (i = FLED1; i <= FLED2; ++i) - if (mode & MODE_FLASH_EXTERNAL(i)) - led->mode_flags &= (~MODE_TORCH(i) & ~MODE_FLASH(i)); - - new_mode_flags = mode | led->mode_flags; - new_mode_flags &= led->allowed_modes; - - if (new_mode_flags ^ led->mode_flags) - led->mode_flags = new_mode_flags; - else - return 0; - - ret = max77693_set_mode_reg(led, led->mode_flags); - if (ret < 0) - return ret; - - /* - * Clear flash mode flag after setting the mode to avoid spurious flash - * strobing on each subsequent torch mode setting. - */ - if (mode & MODE_FLASH_MASK) - led->mode_flags &= ~mode; - - return ret; -} - -static int max77693_clear_mode(struct max77693_led_device *led, - u8 mode) -{ - if (led->iout_joint) - /* Clear mode also on FLED2 for joint iouts case */ - mode |= (mode << 1); - - led->mode_flags &= ~mode; - - return max77693_set_mode_reg(led, led->mode_flags); -} - -static void max77693_add_allowed_modes(struct max77693_led_device *led, - int fled_id, enum max77693_led_mode mode) -{ - if (mode == FLASH) - led->allowed_modes |= (MODE_FLASH(fled_id) | - MODE_FLASH_EXTERNAL(fled_id)); - else - led->allowed_modes |= MODE_TORCH(fled_id); -} - -static void max77693_distribute_currents(struct max77693_led_device *led, - int fled_id, enum max77693_led_mode mode, - u32 micro_amp, u32 iout_max[2], u32 iout[2]) -{ - if (!led->iout_joint) { - iout[fled_id] = micro_amp; - max77693_add_allowed_modes(led, fled_id, mode); - return; - } - - iout[FLED1] = min(micro_amp, iout_max[FLED1]); - iout[FLED2] = micro_amp - iout[FLED1]; - - if (mode == FLASH) - led->allowed_modes &= ~MODE_FLASH_MASK; - else - led->allowed_modes &= ~MODE_TORCH_MASK; - - max77693_add_allowed_modes(led, FLED1, mode); - - if (iout[FLED2]) - max77693_add_allowed_modes(led, FLED2, mode); -} - -static int max77693_set_torch_current(struct max77693_led_device *led, - int fled_id, u32 micro_amp) -{ - struct regmap *rmap = led->regmap; - u8 iout1_reg = 0, iout2_reg = 0; - u32 iout[2]; - - max77693_distribute_currents(led, fled_id, TORCH, micro_amp, - led->iout_torch_max, iout); - - if (fled_id == FLED1 || led->iout_joint) { - iout1_reg = max77693_led_iout_to_reg(iout[FLED1]); - led->torch_iout_reg &= TORCH_IOUT_MASK(TORCH_IOUT2_SHIFT); - } - if (fled_id == FLED2 || led->iout_joint) { - iout2_reg = max77693_led_iout_to_reg(iout[FLED2]); - led->torch_iout_reg &= TORCH_IOUT_MASK(TORCH_IOUT1_SHIFT); - } - - led->torch_iout_reg |= ((iout1_reg << TORCH_IOUT1_SHIFT) | - (iout2_reg << TORCH_IOUT2_SHIFT)); - - return regmap_write(rmap, MAX77693_LED_REG_ITORCH, - led->torch_iout_reg); -} - -static int max77693_set_flash_current(struct max77693_led_device *led, - int fled_id, - u32 micro_amp) -{ - struct regmap *rmap = led->regmap; - u8 iout1_reg, iout2_reg; - u32 iout[2]; - int ret = -EINVAL; - - max77693_distribute_currents(led, fled_id, FLASH, micro_amp, - led->iout_flash_max, iout); - - if (fled_id == FLED1 || led->iout_joint) { - iout1_reg = max77693_led_iout_to_reg(iout[FLED1]); - ret = regmap_write(rmap, MAX77693_LED_REG_IFLASH1, - iout1_reg); - if (ret < 0) - return ret; - } - if (fled_id == FLED2 || led->iout_joint) { - iout2_reg = max77693_led_iout_to_reg(iout[FLED2]); - ret = regmap_write(rmap, MAX77693_LED_REG_IFLASH2, - iout2_reg); - } - - return ret; -} - -static int max77693_set_timeout(struct max77693_led_device *led, u32 microsec) -{ - struct regmap *rmap = led->regmap; - u8 v; - int ret; - - v = max77693_flash_timeout_to_reg(microsec) | FLASH_TMR_LEVEL; - - ret = regmap_write(rmap, MAX77693_LED_REG_FLASH_TIMER, v); - if (ret < 0) - return ret; - - led->current_flash_timeout = microsec; - - return 0; -} - -static int max77693_get_strobe_status(struct max77693_led_device *led, - bool *state) -{ - struct regmap *rmap = led->regmap; - unsigned int v; - int ret; - - ret = regmap_read(rmap, MAX77693_LED_REG_FLASH_STATUS, &v); - if (ret < 0) - return ret; - - *state = v & FLASH_STATUS_FLASH_ON; - - return ret; -} - -static int max77693_get_flash_faults(struct max77693_sub_led *sub_led) -{ - struct max77693_led_device *led = sub_led_to_led(sub_led); - struct regmap *rmap = led->regmap; - unsigned int v; - u8 fault_open_mask, fault_short_mask; - int ret; - - sub_led->flash_faults = 0; - - if (led->iout_joint) { - fault_open_mask = FLASH_INT_FLED1_OPEN | FLASH_INT_FLED2_OPEN; - fault_short_mask = FLASH_INT_FLED1_SHORT | - FLASH_INT_FLED2_SHORT; - } else { - fault_open_mask = (sub_led->fled_id == FLED1) ? - FLASH_INT_FLED1_OPEN : - FLASH_INT_FLED2_OPEN; - fault_short_mask = (sub_led->fled_id == FLED1) ? - FLASH_INT_FLED1_SHORT : - FLASH_INT_FLED2_SHORT; - } - - ret = regmap_read(rmap, MAX77693_LED_REG_FLASH_INT, &v); - if (ret < 0) - return ret; - - if (v & fault_open_mask) - sub_led->flash_faults |= LED_FAULT_OVER_VOLTAGE; - if (v & fault_short_mask) - sub_led->flash_faults |= LED_FAULT_SHORT_CIRCUIT; - if (v & FLASH_INT_OVER_CURRENT) - sub_led->flash_faults |= LED_FAULT_OVER_CURRENT; - - return 0; -} - -static int max77693_setup(struct max77693_led_device *led, - struct max77693_led_config_data *led_cfg) -{ - struct regmap *rmap = led->regmap; - int i, first_led, last_led, ret; - u32 max_flash_curr[2]; - u8 v; - - /* - * Initialize only flash current. Torch current doesn't - * require initialization as ITORCH register is written with - * new value each time brightness_set op is called. - */ - if (led->iout_joint) { - first_led = FLED1; - last_led = FLED1; - max_flash_curr[FLED1] = led_cfg->iout_flash_max[FLED1] + - led_cfg->iout_flash_max[FLED2]; - } else { - first_led = max77693_fled_used(led, FLED1) ? FLED1 : FLED2; - last_led = max77693_fled_used(led, FLED2) ? FLED2 : FLED1; - max_flash_curr[FLED1] = led_cfg->iout_flash_max[FLED1]; - max_flash_curr[FLED2] = led_cfg->iout_flash_max[FLED2]; - } - - for (i = first_led; i <= last_led; ++i) { - ret = max77693_set_flash_current(led, i, - max_flash_curr[i]); - if (ret < 0) - return ret; - } - - v = TORCH_TMR_NO_TIMER | MAX77693_LED_TRIG_TYPE_LEVEL; - ret = regmap_write(rmap, MAX77693_LED_REG_ITORCHTIMER, v); - if (ret < 0) - return ret; - - if (led_cfg->low_vsys > 0) - v = max77693_led_vsys_to_reg(led_cfg->low_vsys) | - MAX_FLASH1_MAX_FL_EN; - else - v = 0; - - ret = regmap_write(rmap, MAX77693_LED_REG_MAX_FLASH1, v); - if (ret < 0) - return ret; - ret = regmap_write(rmap, MAX77693_LED_REG_MAX_FLASH2, 0); - if (ret < 0) - return ret; - - if (led_cfg->boost_mode == MAX77693_LED_BOOST_FIXED) - v = FLASH_BOOST_FIXED; - else - v = led_cfg->boost_mode | led_cfg->boost_mode << 1; - - if (max77693_fled_used(led, FLED1) && max77693_fled_used(led, FLED2)) - v |= FLASH_BOOST_LEDNUM_2; - - ret = regmap_write(rmap, MAX77693_LED_REG_VOUT_CNTL, v); - if (ret < 0) - return ret; - - v = max77693_led_vout_to_reg(led_cfg->boost_vout); - ret = regmap_write(rmap, MAX77693_LED_REG_VOUT_FLASH1, v); - if (ret < 0) - return ret; - - return max77693_set_mode_reg(led, MODE_OFF); -} - -/* LED subsystem callbacks */ -static int max77693_led_brightness_set(struct led_classdev *led_cdev, - enum led_brightness value) -{ - struct led_classdev_flash *fled_cdev = lcdev_to_flcdev(led_cdev); - struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); - struct max77693_led_device *led = sub_led_to_led(sub_led); - int fled_id = sub_led->fled_id, ret; - - mutex_lock(&led->lock); - - if (value == 0) { - ret = max77693_clear_mode(led, MODE_TORCH(fled_id)); - if (ret < 0) - dev_dbg(&led->pdev->dev, - "Failed to clear torch mode (%d)\n", - ret); - goto unlock; - } - - ret = max77693_set_torch_current(led, fled_id, value * TORCH_IOUT_STEP); - if (ret < 0) { - dev_dbg(&led->pdev->dev, - "Failed to set torch current (%d)\n", - ret); - goto unlock; - } - - ret = max77693_add_mode(led, MODE_TORCH(fled_id)); - if (ret < 0) - dev_dbg(&led->pdev->dev, - "Failed to set torch mode (%d)\n", - ret); -unlock: - mutex_unlock(&led->lock); - - return ret; -} - -static int max77693_led_flash_brightness_set( - struct led_classdev_flash *fled_cdev, - u32 brightness) -{ - struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); - struct max77693_led_device *led = sub_led_to_led(sub_led); - int ret; - - mutex_lock(&led->lock); - ret = max77693_set_flash_current(led, sub_led->fled_id, brightness); - mutex_unlock(&led->lock); - - return ret; -} - -static int max77693_led_flash_strobe_set( - struct led_classdev_flash *fled_cdev, - bool state) -{ - struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); - struct max77693_led_device *led = sub_led_to_led(sub_led); - int fled_id = sub_led->fled_id; - int ret; - - mutex_lock(&led->lock); - - if (!state) { - ret = max77693_clear_mode(led, MODE_FLASH(fled_id)); - goto unlock; - } - - if (sub_led->flash_timeout != led->current_flash_timeout) { - ret = max77693_set_timeout(led, sub_led->flash_timeout); - if (ret < 0) - goto unlock; - } - - led->strobing_sub_led_id = fled_id; - - ret = max77693_add_mode(led, MODE_FLASH(fled_id)); - if (ret < 0) - goto unlock; - - ret = max77693_get_flash_faults(sub_led); - -unlock: - mutex_unlock(&led->lock); - return ret; -} - -static int max77693_led_flash_fault_get( - struct led_classdev_flash *fled_cdev, - u32 *fault) -{ - struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); - - *fault = sub_led->flash_faults; - - return 0; -} - -static int max77693_led_flash_strobe_get( - struct led_classdev_flash *fled_cdev, - bool *state) -{ - struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); - struct max77693_led_device *led = sub_led_to_led(sub_led); - int ret; - - if (!state) - return -EINVAL; - - mutex_lock(&led->lock); - - ret = max77693_get_strobe_status(led, state); - - *state = !!(*state && (led->strobing_sub_led_id == sub_led->fled_id)); - - mutex_unlock(&led->lock); - - return ret; -} - -static int max77693_led_flash_timeout_set( - struct led_classdev_flash *fled_cdev, - u32 timeout) -{ - struct max77693_sub_led *sub_led = flcdev_to_sub_led(fled_cdev); - struct max77693_led_device *led = sub_led_to_led(sub_led); - - mutex_lock(&led->lock); - sub_led->flash_timeout = timeout; - mutex_unlock(&led->lock); - - return 0; -} - -static int max77693_led_parse_dt(struct max77693_led_device *led, - struct max77693_led_config_data *cfg, - struct device_node **sub_nodes) -{ - struct device *dev = &led->pdev->dev; - struct max77693_sub_led *sub_leds = led->sub_leds; - struct device_node *node = dev_of_node(dev), *child_node; - struct property *prop; - u32 led_sources[2]; - int i, ret, fled_id; - - of_property_read_u32(node, "maxim,boost-mode", &cfg->boost_mode); - of_property_read_u32(node, "maxim,boost-mvout", &cfg->boost_vout); - of_property_read_u32(node, "maxim,mvsys-min", &cfg->low_vsys); - - for_each_available_child_of_node(node, child_node) { - prop = of_find_property(child_node, "led-sources", NULL); - if (prop) { - const __be32 *srcs = NULL; - - for (i = 0; i < ARRAY_SIZE(led_sources); ++i) { - srcs = of_prop_next_u32(prop, srcs, - &led_sources[i]); - if (!srcs) - break; - } - } else { - dev_err(dev, - "led-sources DT property missing\n"); - of_node_put(child_node); - return -EINVAL; - } - - if (i == 2) { - fled_id = FLED1; - led->fled_mask = FLED1_IOUT | FLED2_IOUT; - } else if (led_sources[0] == FLED1) { - fled_id = FLED1; - led->fled_mask |= FLED1_IOUT; - } else if (led_sources[0] == FLED2) { - fled_id = FLED2; - led->fled_mask |= FLED2_IOUT; - } else { - dev_err(dev, - "Wrong led-sources DT property value.\n"); - of_node_put(child_node); - return -EINVAL; - } - - if (sub_nodes[fled_id]) { - dev_err(dev, - "Conflicting \"led-sources\" DT properties\n"); - of_node_put(child_node); - return -EINVAL; - } - - sub_nodes[fled_id] = child_node; - sub_leds[fled_id].fled_id = fled_id; - - cfg->label[fled_id] = - of_get_property(child_node, "label", NULL) ? : - child_node->name; - - ret = of_property_read_u32(child_node, "led-max-microamp", - &cfg->iout_torch_max[fled_id]); - if (ret < 0) { - cfg->iout_torch_max[fled_id] = TORCH_IOUT_MIN; - dev_warn(dev, "led-max-microamp DT property missing\n"); - } - - ret = of_property_read_u32(child_node, "flash-max-microamp", - &cfg->iout_flash_max[fled_id]); - if (ret < 0) { - cfg->iout_flash_max[fled_id] = FLASH_IOUT_MIN; - dev_warn(dev, - "flash-max-microamp DT property missing\n"); - } - - ret = of_property_read_u32(child_node, "flash-max-timeout-us", - &cfg->flash_timeout_max[fled_id]); - if (ret < 0) { - cfg->flash_timeout_max[fled_id] = FLASH_TIMEOUT_MIN; - dev_warn(dev, - "flash-max-timeout-us DT property missing\n"); - } - - if (++cfg->num_leds == 2 || - (max77693_fled_used(led, FLED1) && - max77693_fled_used(led, FLED2))) { - of_node_put(child_node); - break; - } - } - - if (cfg->num_leds == 0) { - dev_err(dev, "No DT child node found for connected LED(s).\n"); - return -EINVAL; - } - - return 0; -} - -static void clamp_align(u32 *v, u32 min, u32 max, u32 step) -{ - *v = clamp_val(*v, min, max); - if (step > 1) - *v = (*v - min) / step * step + min; -} - -static void max77693_align_iout_current(struct max77693_led_device *led, - u32 *iout, u32 min, u32 max, u32 step) -{ - int i; - - if (led->iout_joint) { - if (iout[FLED1] > min) { - iout[FLED1] /= 2; - iout[FLED2] = iout[FLED1]; - } else { - iout[FLED1] = min; - iout[FLED2] = 0; - return; - } - } - - for (i = FLED1; i <= FLED2; ++i) - if (max77693_fled_used(led, i)) - clamp_align(&iout[i], min, max, step); - else - iout[i] = 0; -} - -static void max77693_led_validate_configuration(struct max77693_led_device *led, - struct max77693_led_config_data *cfg) -{ - u32 flash_iout_max = cfg->boost_mode ? FLASH_IOUT_MAX_2LEDS : - FLASH_IOUT_MAX_1LED; - int i; - - if (cfg->num_leds == 1 && - max77693_fled_used(led, FLED1) && max77693_fled_used(led, FLED2)) - led->iout_joint = true; - - cfg->boost_mode = clamp_val(cfg->boost_mode, MAX77693_LED_BOOST_NONE, - MAX77693_LED_BOOST_FIXED); - - /* Boost must be enabled if both current outputs are used */ - if ((cfg->boost_mode == MAX77693_LED_BOOST_NONE) && led->iout_joint) - cfg->boost_mode = MAX77693_LED_BOOST_FIXED; - - max77693_align_iout_current(led, cfg->iout_torch_max, - TORCH_IOUT_MIN, TORCH_IOUT_MAX, TORCH_IOUT_STEP); - - max77693_align_iout_current(led, cfg->iout_flash_max, - FLASH_IOUT_MIN, flash_iout_max, FLASH_IOUT_STEP); - - for (i = 0; i < ARRAY_SIZE(cfg->flash_timeout_max); ++i) - clamp_align(&cfg->flash_timeout_max[i], FLASH_TIMEOUT_MIN, - FLASH_TIMEOUT_MAX, FLASH_TIMEOUT_STEP); - - clamp_align(&cfg->boost_vout, FLASH_VOUT_MIN, FLASH_VOUT_MAX, - FLASH_VOUT_STEP); - - if (cfg->low_vsys) - clamp_align(&cfg->low_vsys, MAX_FLASH1_VSYS_MIN, - MAX_FLASH1_VSYS_MAX, MAX_FLASH1_VSYS_STEP); -} - -static int max77693_led_get_configuration(struct max77693_led_device *led, - struct max77693_led_config_data *cfg, - struct device_node **sub_nodes) -{ - int ret; - - ret = max77693_led_parse_dt(led, cfg, sub_nodes); - if (ret < 0) - return ret; - - max77693_led_validate_configuration(led, cfg); - - memcpy(led->iout_torch_max, cfg->iout_torch_max, - sizeof(led->iout_torch_max)); - memcpy(led->iout_flash_max, cfg->iout_flash_max, - sizeof(led->iout_flash_max)); - - return 0; -} - -static const struct led_flash_ops flash_ops = { - .flash_brightness_set = max77693_led_flash_brightness_set, - .strobe_set = max77693_led_flash_strobe_set, - .strobe_get = max77693_led_flash_strobe_get, - .timeout_set = max77693_led_flash_timeout_set, - .fault_get = max77693_led_flash_fault_get, -}; - -static void max77693_init_flash_settings(struct max77693_sub_led *sub_led, - struct max77693_led_config_data *led_cfg) -{ - struct led_classdev_flash *fled_cdev = &sub_led->fled_cdev; - struct max77693_led_device *led = sub_led_to_led(sub_led); - int fled_id = sub_led->fled_id; - struct led_flash_setting *setting; - - /* Init flash intensity setting */ - setting = &fled_cdev->brightness; - setting->min = FLASH_IOUT_MIN; - setting->max = led->iout_joint ? - led_cfg->iout_flash_max[FLED1] + - led_cfg->iout_flash_max[FLED2] : - led_cfg->iout_flash_max[fled_id]; - setting->step = FLASH_IOUT_STEP; - setting->val = setting->max; - - /* Init flash timeout setting */ - setting = &fled_cdev->timeout; - setting->min = FLASH_TIMEOUT_MIN; - setting->max = led_cfg->flash_timeout_max[fled_id]; - setting->step = FLASH_TIMEOUT_STEP; - setting->val = setting->max; -} - -#if IS_ENABLED(CONFIG_V4L2_FLASH_LED_CLASS) - -static int max77693_led_external_strobe_set( - struct v4l2_flash *v4l2_flash, - bool enable) -{ - struct max77693_sub_led *sub_led = - flcdev_to_sub_led(v4l2_flash->fled_cdev); - struct max77693_led_device *led = sub_led_to_led(sub_led); - int fled_id = sub_led->fled_id; - int ret; - - mutex_lock(&led->lock); - - if (enable) - ret = max77693_add_mode(led, MODE_FLASH_EXTERNAL(fled_id)); - else - ret = max77693_clear_mode(led, MODE_FLASH_EXTERNAL(fled_id)); - - mutex_unlock(&led->lock); - - return ret; -} - -static void max77693_init_v4l2_flash_config(struct max77693_sub_led *sub_led, - struct max77693_led_config_data *led_cfg, - struct v4l2_flash_config *v4l2_sd_cfg) -{ - struct max77693_led_device *led = sub_led_to_led(sub_led); - struct device *dev = &led->pdev->dev; - struct max77693_dev *iodev = dev_get_drvdata(dev->parent); - struct i2c_client *i2c = iodev->i2c; - struct led_flash_setting *s; - - snprintf(v4l2_sd_cfg->dev_name, sizeof(v4l2_sd_cfg->dev_name), - "%s %d-%04x", sub_led->fled_cdev.led_cdev.name, - i2c_adapter_id(i2c->adapter), i2c->addr); - - s = &v4l2_sd_cfg->intensity; - s->min = TORCH_IOUT_MIN; - s->max = sub_led->fled_cdev.led_cdev.max_brightness * TORCH_IOUT_STEP; - s->step = TORCH_IOUT_STEP; - s->val = s->max; - - /* Init flash faults config */ - v4l2_sd_cfg->flash_faults = LED_FAULT_OVER_VOLTAGE | - LED_FAULT_SHORT_CIRCUIT | - LED_FAULT_OVER_CURRENT; - - v4l2_sd_cfg->has_external_strobe = true; -} - -static const struct v4l2_flash_ops v4l2_flash_ops = { - .external_strobe_set = max77693_led_external_strobe_set, -}; -#else -static inline void max77693_init_v4l2_flash_config( - struct max77693_sub_led *sub_led, - struct max77693_led_config_data *led_cfg, - struct v4l2_flash_config *v4l2_sd_cfg) -{ -} -static const struct v4l2_flash_ops v4l2_flash_ops; -#endif - -static void max77693_init_fled_cdev(struct max77693_sub_led *sub_led, - struct max77693_led_config_data *led_cfg) -{ - struct max77693_led_device *led = sub_led_to_led(sub_led); - int fled_id = sub_led->fled_id; - struct led_classdev_flash *fled_cdev; - struct led_classdev *led_cdev; - - /* Initialize LED Flash class device */ - fled_cdev = &sub_led->fled_cdev; - fled_cdev->ops = &flash_ops; - led_cdev = &fled_cdev->led_cdev; - - led_cdev->name = led_cfg->label[fled_id]; - - led_cdev->brightness_set_blocking = max77693_led_brightness_set; - led_cdev->max_brightness = (led->iout_joint ? - led_cfg->iout_torch_max[FLED1] + - led_cfg->iout_torch_max[FLED2] : - led_cfg->iout_torch_max[fled_id]) / - TORCH_IOUT_STEP; - led_cdev->flags |= LED_DEV_CAP_FLASH; - - max77693_init_flash_settings(sub_led, led_cfg); - - /* Init flash timeout cache */ - sub_led->flash_timeout = fled_cdev->timeout.val; -} - -static int max77693_register_led(struct max77693_sub_led *sub_led, - struct max77693_led_config_data *led_cfg, - struct device_node *sub_node) -{ - struct max77693_led_device *led = sub_led_to_led(sub_led); - struct led_classdev_flash *fled_cdev = &sub_led->fled_cdev; - struct device *dev = &led->pdev->dev; - struct v4l2_flash_config v4l2_sd_cfg = {}; - int ret; - - /* Register in the LED subsystem */ - ret = led_classdev_flash_register(dev, fled_cdev); - if (ret < 0) - return ret; - - max77693_init_v4l2_flash_config(sub_led, led_cfg, &v4l2_sd_cfg); - - /* Register in the V4L2 subsystem. */ - sub_led->v4l2_flash = v4l2_flash_init(dev, of_fwnode_handle(sub_node), - fled_cdev, &v4l2_flash_ops, - &v4l2_sd_cfg); - if (IS_ERR(sub_led->v4l2_flash)) { - ret = PTR_ERR(sub_led->v4l2_flash); - goto err_v4l2_flash_init; - } - - return 0; - -err_v4l2_flash_init: - led_classdev_flash_unregister(fled_cdev); - return ret; -} - -static int max77693_led_probe(struct platform_device *pdev) -{ - struct device *dev = &pdev->dev; - struct max77693_dev *iodev = dev_get_drvdata(dev->parent); - struct max77693_led_device *led; - struct max77693_sub_led *sub_leds; - struct device_node *sub_nodes[2] = {}; - struct max77693_led_config_data led_cfg = {}; - int init_fled_cdev[2], i, ret; - - led = devm_kzalloc(dev, sizeof(*led), GFP_KERNEL); - if (!led) - return -ENOMEM; - - led->pdev = pdev; - led->regmap = iodev->regmap; - led->allowed_modes = MODE_FLASH_MASK; - sub_leds = led->sub_leds; - - platform_set_drvdata(pdev, led); - ret = max77693_led_get_configuration(led, &led_cfg, sub_nodes); - if (ret < 0) - return ret; - - ret = max77693_setup(led, &led_cfg); - if (ret < 0) - return ret; - - mutex_init(&led->lock); - - init_fled_cdev[FLED1] = - led->iout_joint || max77693_fled_used(led, FLED1); - init_fled_cdev[FLED2] = - !led->iout_joint && max77693_fled_used(led, FLED2); - - for (i = FLED1; i <= FLED2; ++i) { - if (!init_fled_cdev[i]) - continue; - - /* Initialize LED Flash class device */ - max77693_init_fled_cdev(&sub_leds[i], &led_cfg); - - /* - * Register LED Flash class device and corresponding - * V4L2 Flash device. - */ - ret = max77693_register_led(&sub_leds[i], &led_cfg, - sub_nodes[i]); - if (ret < 0) { - /* - * At this moment FLED1 might have been already - * registered and it needs to be released. - */ - if (i == FLED2) - goto err_register_led2; - else - goto err_register_led1; - } - } - - return 0; - -err_register_led2: - /* It is possible than only FLED2 was to be registered */ - if (!init_fled_cdev[FLED1]) - goto err_register_led1; - v4l2_flash_release(sub_leds[FLED1].v4l2_flash); - led_classdev_flash_unregister(&sub_leds[FLED1].fled_cdev); -err_register_led1: - mutex_destroy(&led->lock); - - return ret; -} - -static int max77693_led_remove(struct platform_device *pdev) -{ - struct max77693_led_device *led = platform_get_drvdata(pdev); - struct max77693_sub_led *sub_leds = led->sub_leds; - - if (led->iout_joint || max77693_fled_used(led, FLED1)) { - v4l2_flash_release(sub_leds[FLED1].v4l2_flash); - led_classdev_flash_unregister(&sub_leds[FLED1].fled_cdev); - } - - if (!led->iout_joint && max77693_fled_used(led, FLED2)) { - v4l2_flash_release(sub_leds[FLED2].v4l2_flash); - led_classdev_flash_unregister(&sub_leds[FLED2].fled_cdev); - } - - mutex_destroy(&led->lock); - - return 0; -} - -static const struct of_device_id max77693_led_dt_match[] = { - { .compatible = "maxim,max77693-led" }, - {}, -}; -MODULE_DEVICE_TABLE(of, max77693_led_dt_match); - -static struct platform_driver max77693_led_driver = { - .probe = max77693_led_probe, - .remove = max77693_led_remove, - .driver = { - .name = "max77693-led", - .of_match_table = max77693_led_dt_match, - }, -}; - -module_platform_driver(max77693_led_driver); - -MODULE_AUTHOR("Jacek Anaszewski "); -MODULE_AUTHOR("Andrzej Hajda "); -MODULE_DESCRIPTION("Maxim MAX77693 led flash driver"); -MODULE_LICENSE("GPL v2"); -- cgit v1.2.3