From: ChiaEn Wu <[email protected]>
This patch series add MediaTek MT6370 PMIC support. The MT6370 is a
highly-integrated smart power management IC, which includes a single
cell Li-Ion/Li-Polymer switching battery charger, a USB
Type-C & Power Delivery (PD) controller, dual Flash LED current sources,
a RGB LED driver, a backlight WLED driver, a display bias driver and a
general LDO for portable devices.
In this series of patches, we based on Andy Shevchenko's mfd patch used to
adjust the Makefile order.
(https://lore.kernel.org/all/[email protected]/)
Among with this, we took some changes for MT6370 and refined the MT6370 device
tree files to comply with DT specifications.
"[PATCH v5 06/13] dt-bindings: mfd: Add MediaTek MT6370" depends on previous
DT binding patches, so before applying this patch, please apply other DT
patches first. Thanks!
Thank you,
ChiaEn Wu
---
Changes in v5:
- In patch 07/13:
- Add the comma in the last REGMAP_IRQ_REG_LINE(),
DEFINE_RES_IRQ_NAMED() and MFD_CELL_RES()
- Add the prefix in the first parameter of all mfd_cell
- Move enum and struct mt6370_info to mt6370.h
- Remove struct device *dev in struct mt6370_info
- Revise the description of Kconfig help text
- Revise MODULE_DESCRIPTION()
- In patch 08/13:
- Add comma for the last index of mt6370_reg_init.
- Use dev_err_probe to decrease LOC.
- Use 'dev' variable to make probe function more clean.
- Refine kconfig text.
- Remove both 'else' in set_vbus callback.
- Remove comma for of_device_id if the assigned member is only one.
- In patch 09/13:
- Replace using snprintf() with sysfs_emit() in mt6370_adc_read_label()
- Remove macro ADC_CONV_TIME_US
- Revise all variable ordering
- Revise the description of Kconfig help text
- Revise MODULE_DESCRIPTION()
- In patch 10/13:
- Replace unsigned int type of pwr_rdy with bool in
mt6370_chg_set_online()
- Remove redundant 'else' in mt6370_chg_field_get()
- Revise 'if-else' in mt6370_chg_field_set()
- Revise 'if' condition in mt6370_chg_enable_irq()
- Revise all text 'otg' --> 'OTG'
- Revise MT6370_MIVR_IBUS_TH_100_MA --> MT6370_MIVR_IBUS_TH_100_mA
- Revise the description of Kconfig help text
- In patch 12/13:
- Refine descriptions.
- Refine the macro name.
- Refine the bracket and blanks.
- In patch 13/13:
- Add missed <mod_devicetable.h>
- Add struct device *dev in probe() to make code cleaning
- Remove useless including header file <gpio/driver.h>, <of.h>
- Remove useless variable uasage in mt6370_init_backlight_properties()
- Remove redundant checking enable_gpio in mt6370_bl_update_status()
- Remove redundant parentheses in mt6370_bl_get_brightness()
- Revise the description of Kconfig help text
- Revise the calculation of hys_th_steps
Changes in v4:
- In patch 02/13:
- Add minItems of "io-channel-names"
- Replace text "Mediatek" with "MediaTek"
- In patch 06/13:
- Roll back all "$ref: " to v2 patch style (using "/schemas/...")
- In patch 07/13:
- Replace text "Mediatek" with "MediaTek" in Kconfig
- Replace "first break and then return" with "return directly"
in "mt6370_check_vendor_info()"
- Add module name related description in Kconfig helptext
- Add Copyright in the source code
- Add header file "mt6370.h" for all "#define IRQ"
- Adjust Makefile order of MT6370
- Refine "bank_idx" and "bank_addr" in
"mt6375_regmap_read()" / "mt6375_regmap_write()"
- Refine redundant "else if" in "mt6370_regmap_read()"
- In patch 08/13:
- Replace text "Mediatek" with "MediaTek" in Kconfig
- Replace "first ret=regulator_(dis/en)able and then return"
with "return directly" in "mt6370_tcpc_set_vbus()"
- Replace header file <linux/of.h> with <linux/mod_devicetable.h>
- Add Copyright in the source code
- Add module name related description in Kconfig helptext
- Remove header file <linux/of.h>
- Refine all probe error by using dev_err_probe()
- In patch 09/13:
- Replace text "Mediatek" with "MediaTek"
- Replace all "first dev_err() and then return" with
"return dev_err_probe()"
- Add Copyright in the source code
- Add module name related description in Kconfig
- Add unit suffix of macro "ADC_CONV_POLLING_TIME"
- Add new macro "ADC_CONV_TIME_MS"
- Adjust the position of include file <mediatek,mt6370_adc.h>
- Adjust the postions between <linux/module.h> and
<linux/mod_devicetable.h>
- Fix some incorrect characters
- In patch 10/13:
- Replace text "Mediatek" with "MediaTek" in Kconfig and
MODULE_DESCRIPTION()
- Replace "mt6370_chg_val_to_reg" and "mt6370_chg_reg_to_val"
with "linear_range" API
- Replace "first break and then return" with "return directly"
in all cases of get/set power_supply_property
- Replace all "first dev_err() and then return" with "return
dev_err_probe()"
- Replace all "return IS_ERR(priv->rdev) ? PTR_ERR(priv->rdev) : 0"
with "PTR_ERR_OR_ZERO()"
- Replace "priv->dev->of_node" with "dev_of_node()"
- Add Copyright in the source code
- Add module name related description in Kconfig helptext
- Add proper unit of "MT6370_MIVR_IBUS_TH"
- Add error check in "mt6370_chg_get_status"
- Remove including <mediatek,mt6370_adc.h> header file
- Remove redundant comma of every enum terminator line
- Remove unwanted blank lines
- Remove the useless label (toggle_cfo_exit:)
- Remove using atomic
- Remove using of_match_ptr()
- Fix some incorrect characters
- Fix updating wrong bits when using ena_gpiod of OTG regulator
- Adjust the probe order in probe()
- In patch 11/13:
- Replace text "Mediatek" with "MediaTek" in Kconfig
- Replace text "const" with "constant" in Kconfig
- Add Copyright in the source code
- In patch 12/13:
- Replace text "Mediatek" with "MediaTek" in Kconfig
- Add Copyright in the source code
- In patch 13/13:
- Replace text "Mediatek" with "MediaTek" in Kconfig
- Add Copyright in the source code
- Revise the comment of "PWM HYS STEPS"
Changes in v3:
- Remove ADC ABI file, which is added in v2 Patch 7
- In patch 02/14:
- Add items and remove maxItems of io-channels
- Add io-channel-names and describe each item
- Add "unevaluatedProperties: false" in "usb-otg-vbus-regulator"
- Rename "enable-gpio" to "enable-gpios" in "usb-otg-vbus-regulator"
- In patch 03/14:
- Use leds-class-multicolor.yaml instead of common.yaml.
- Split multi-led and led node.
- Add subdevice "led" in "multi-led".
- In patch 04/14:
- Remove the description of enum.
- In patch 05/14:
- Rename "mediatek,bled-pwm-hys-input-threshold-steps" to
"mediatek,bled-pwm-hys-input-th-steps"
- Refine "bled-pwm-hys-input-th-steps", "bled-ovp-microvolt",
"bled-ocp-microamp" enum values
- In patch 06/14:
- Use " in entire patchset
- Refine ADC description
- Rename "enable-gpio" to "enable-gpios" in "regualtor"
- In patch 07/14:
- Refine Kconfig help text
- Refine error message of unknown vendor ID in
mt6370_check_vendor_info()
- Refine return value handling of mt6370_regmap_read()
- Refine all probe error by using dev_err_probe()
- Refine "bank_idx" and "bank_addr" in mt6370_regmap_read() and
mt6370_regmap_write()
- Add "#define VENID*" and drop the comments in
mt6370_check_vendor_info()
- Drop "MFD" in MODULE_DESCRIPTION()
- In patch 09/14:
- Refine Kconfig help text
- In patch 10/14:
- Refine Kconfig help text
- Refine all channel value in read_scale()
a. current: uA --> mA
b. voltage: uV --> mV
c. temperature: degrees Celsius --> milli degrees Celsius
- Add "default:" condition of switch statement in read_scale() and read_raw()
- Add error message for reading ADC register failed
- Add the comment for adc_lock
- Add <linux/mod_devicetable.h> header file for struct of_device_id
- Replace "adc" text with "ADC" in all of the error messages
- In patch 12/14:
- Refine the grammer of the Kconfig.
- Change reg mode to the const current mode.
- In patch 14/14:
- Refine bool properties parsing (pwm-enable, ovp-shutdown, ocp-shutdown) in DT
parsing function
- Refine u32 and u8 properties parsing (pwm-hys-input-th-steps, ovp-microvolt,
ocp-microamp), from using register value to using actual value
- Refine error string of "channle-use" parsing failed
- Refine Kconfig help text
Changes in v2:
- In patch 01/15:
- Add "unevaluatedProperties: false".
- Delete "DT bindings".
- Refine the description to fit in 80 columns.
- Skip the connector description.
- In patch 02/15:
- Refine items description of interrupt-name
- Rename "usb-otg-vbus" to "usb-otg-vbus-regulator"
- Add constraint properties for ADC
- In patch 03/15:
- Skip not useful description of "^(multi-)?led@[0-3]$"
and reg.
- Due to the dependency, remove the mention of mfd
document directory.
- Delete Soft-start property. In design aspect, we think
soft-restart should always be enabled, our new chip
has deleted the related setting register , also, we don’t
allow user adjust this parameter in this chip.
- Refine the commit message.
- In patch 04/15:
- Skip not useful description of "^led@[0-1]$" and reg.
- Add apace after '#'.
- Refine the commit message.
- In patch 05/15:
- Remove "binding documentation" in subject title
- Refine description of mt6370 backlight binding
document
- Refine properties name(bled-pwm-hys-input-bit,
bled-ovp-microvolt, bled-ocp-microamp) and their
description
- In patch 06/15:
- Refine ADC and Regulator descriptions
- Refine include header usage in example
- Refine node name to generic node name("pmic@34")
- Refine led example indentation
- Refine license of mediatek,mt6370_adc.h
- Rename the dts example from IRQ define to number.
- Remove mediatek,mt6370.h
- In patch 07/15:
- Add ABI documentation for mt6370 non-standard ADC
sysfs interfaces.
- In patch 08/15:
- Add all IRQ define into mt6370.c.
- Refine include header usage
- In patch 09/15:
- No changes.
- In patch 10/15:
- Use 'gpiod_get_from_of_node' to replace
'fwnode_gpiod_get_index'.
- In patch 11/15:
- Refine Kconfig mt6370 help text
- Refine mask&shift to FIELD_PREP()
- Refine mutex lock name ("lock" -> "adc_lock")
- Refine mt6370_adc_read_scale()
- Refine mt6370_adc_read_offset()
- Refine mt6370_channel_labels[] by using enum to index
chan spec
- Refine MT6370_ADC_CHAN()
- Refine indio_dev->name
- Remove useless include header files
- In patch 12/15:
- Refine mt6370_chg_otg_rdesc.of_match
("mt6370,otg-vbus" -> "usb-otg-vbus-regulator") to match
DT binding
- In patch 13/15:
- Refine Kconfig description.
- Remove include "linux/of.h" and use
"linux/mod_devicetable.h".
- Place a comma for the last element of the const
unsigned int array.
- Add a comment line for the mutex 'lock'.
- In probe function, use 'dev_err_probe' in some
judgement to reduce the LOC.
- Refine include header usage.
BIT/GENMASK -> linux/bits.h
FIELD_GET -> linux/bitfield.h
- In patch 14/15:
- Add blank line.
- Replace container_of() with to_mt6370_led() .
- Refine description of ramping.
- Refine the mt6370_init_common_properties function.
- Refine the probe return.
- In patch 15/15:
- Refine MT6370 help text in Kconfig
- Refine DT Parse function
- Remove useless enum
- Add comment for 6372 backward compatible in
bl_update_status() and
check_vendor_info()
- Using dev_err_probe(); insteads dev_err()&return; in
the probe()
Alice Chen (2):
dt-bindings: leds: Add MediaTek MT6370 flashlight
leds: flashlight: mt6370: Add MediaTek MT6370 flashlight support
ChiYuan Huang (7):
dt-bindings: usb: Add MediaTek MT6370 TCPC
dt-bindings: leds: mt6370: Add MediaTek MT6370 current sink type LED
indicator
dt-bindings: backlight: Add MediaTek MT6370 backlight
dt-bindings: mfd: Add MediaTek MT6370
mfd: mt6370: Add MediaTek MT6370 support
usb: typec: tcpci_mt6370: Add Mediatek MT6370 tcpci driver
leds: mt6370: Add MediaTek MT6370 current sink type LED Indicator
support
ChiaEn Wu (4):
dt-bindings: power: supply: Add MediaTek MT6370 Charger
iio: adc: mt6370: Add MediaTek MT6370 support
power: supply: mt6370: Add MediaTek MT6370 charger driver
video: backlight: mt6370: Add MediaTek MT6370 support
.../leds/backlight/mediatek,mt6370-backlight.yaml | 92 ++
.../bindings/leds/mediatek,mt6370-flashlight.yaml | 41 +
.../bindings/leds/mediatek,mt6370-indicator.yaml | 77 ++
.../devicetree/bindings/mfd/mediatek,mt6370.yaml | 280 ++++++
.../power/supply/mediatek,mt6370-charger.yaml | 88 ++
.../bindings/usb/mediatek,mt6370-tcpc.yaml | 36 +
drivers/iio/adc/Kconfig | 12 +
drivers/iio/adc/Makefile | 1 +
drivers/iio/adc/mt6370-adc.c | 273 +++++
drivers/leds/Kconfig | 14 +
drivers/leds/Makefile | 1 +
drivers/leds/flash/Kconfig | 12 +
drivers/leds/flash/Makefile | 1 +
drivers/leds/flash/leds-mt6370-flash.c | 661 ++++++++++++
drivers/leds/leds-mt6370.c | 994 ++++++++++++++++++
drivers/mfd/Kconfig | 16 +
drivers/mfd/Makefile | 1 +
drivers/mfd/mt6370.c | 281 ++++++
drivers/mfd/mt6370.h | 99 ++
drivers/power/supply/Kconfig | 14 +
drivers/power/supply/Makefile | 1 +
drivers/power/supply/mt6370-charger.c | 1062 ++++++++++++++++++++
drivers/usb/typec/tcpm/Kconfig | 11 +
drivers/usb/typec/tcpm/Makefile | 1 +
drivers/usb/typec/tcpm/tcpci_mt6370.c | 207 ++++
drivers/video/backlight/Kconfig | 12 +
drivers/video/backlight/Makefile | 1 +
drivers/video/backlight/mt6370-backlight.c | 339 +++++++
include/dt-bindings/iio/adc/mediatek,mt6370_adc.h | 18 +
29 files changed, 4646 insertions(+)
create mode 100644 Documentation/devicetree/bindings/leds/backlight/mediatek,mt6370-backlight.yaml
create mode 100644 Documentation/devicetree/bindings/leds/mediatek,mt6370-flashlight.yaml
create mode 100644 Documentation/devicetree/bindings/leds/mediatek,mt6370-indicator.yaml
create mode 100644 Documentation/devicetree/bindings/mfd/mediatek,mt6370.yaml
create mode 100644 Documentation/devicetree/bindings/power/supply/mediatek,mt6370-charger.yaml
create mode 100644 Documentation/devicetree/bindings/usb/mediatek,mt6370-tcpc.yaml
create mode 100644 drivers/iio/adc/mt6370-adc.c
create mode 100644 drivers/leds/flash/leds-mt6370-flash.c
create mode 100644 drivers/leds/leds-mt6370.c
create mode 100644 drivers/mfd/mt6370.c
create mode 100644 drivers/mfd/mt6370.h
create mode 100644 drivers/power/supply/mt6370-charger.c
create mode 100644 drivers/usb/typec/tcpm/tcpci_mt6370.c
create mode 100644 drivers/video/backlight/mt6370-backlight.c
create mode 100644 include/dt-bindings/iio/adc/mediatek,mt6370_adc.h
--
2.7.4
From: ChiYuan Huang <[email protected]>
The MediaTek MT6370 is a highly-integrated smart power management IC,
which includes a single cell Li-Ion/Li-Polymer switching battery
charger, a USB Type-C & Power Delivery (PD) controller, dual
Flash LED current sources, a RGB LED driver, a backlight WLED driver,
a display bias driver and a general LDO for portable devices.
In MediaTek MT6370, there are four channel current-sink RGB LEDs that
support hardware pattern for constant current, PWM, and breath mode.
Isink4 channel can also be used as a CHG_VIN power good indicator.
Signed-off-by: ChiYuan Huang <[email protected]>
---
drivers/leds/Kconfig | 14 +
drivers/leds/Makefile | 1 +
drivers/leds/leds-mt6370.c | 994 +++++++++++++++++++++++++++++++++++++++++++++
3 files changed, 1009 insertions(+)
create mode 100644 drivers/leds/leds-mt6370.c
diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig
index a49979f..71bacb5 100644
--- a/drivers/leds/Kconfig
+++ b/drivers/leds/Kconfig
@@ -244,6 +244,20 @@ config LEDS_MT6323
This option enables support for on-chip LED drivers found on
Mediatek MT6323 PMIC.
+config LEDS_MT6370_RGB
+ tristate "LED Support for MediaTek MT6370 PMIC"
+ depends on LEDS_CLASS
+ depends on MFD_MT6370
+ select LINEAR_RANGE
+ help
+ Say Y here to enable support for MT6370_RGB LED device.
+ In MT6370, there are four channel current-sink LED drivers that
+ support hardware pattern for constant current, PWM, and breath mode.
+ Isink4 channel can also be used as a CHG_VIN power good indicator.
+
+ This driver can also be built as a module. If so the module
+ will be called "leds-mt6370.ko".
+
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 4fd2f92..557be42 100644
--- a/drivers/leds/Makefile
+++ b/drivers/leds/Makefile
@@ -62,6 +62,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_MT6370_RGB) += leds-mt6370.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-mt6370.c b/drivers/leds/leds-mt6370.c
new file mode 100644
index 0000000..1038232
--- /dev/null
+++ b/drivers/leds/leds-mt6370.c
@@ -0,0 +1,994 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (C) 2022 Richtek Technology Corp.
+ *
+ * Author: Alice Chen <[email protected]>
+ */
+
+#include <linux/bitops.h>
+#include <linux/kernel.h>
+#include <linux/led-class-multicolor.h>
+#include <linux/linear_range.h>
+#include <linux/mod_devicetable.h>
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/platform_device.h>
+#include <linux/property.h>
+#include <linux/regmap.h>
+
+enum {
+ MT6370_LED_ISNK1 = 0,
+ MT6370_LED_ISNK2,
+ MT6370_LED_ISNK3,
+ MT6370_LED_ISNK4,
+ MT6370_MAX_LEDS
+};
+
+enum mt6370_led_mode {
+ MT6370_LED_PWM_MODE = 0,
+ MT6370_LED_BREATH_MODE,
+ MT6370_LED_REG_MODE,
+ MT6370_LED_MAX_MODE
+};
+
+enum mt6370_led_field {
+ F_RGB_EN = 0,
+ F_CHGIND_EN,
+ F_LED1_CURR,
+ F_LED2_CURR,
+ F_LED3_CURR,
+ F_LED4_CURR,
+ F_LED1_MODE,
+ F_LED2_MODE,
+ F_LED3_MODE,
+ F_LED4_MODE,
+ F_LED1_DUTY,
+ F_LED2_DUTY,
+ F_LED3_DUTY,
+ F_LED4_DUTY,
+ F_LED1_FREQ,
+ F_LED2_FREQ,
+ F_LED3_FREQ,
+ F_LED4_FREQ,
+ F_MAX_FIELDS
+};
+
+enum mt6370_led_ranges {
+ R_LED123_CURR = 0,
+ R_LED4_CURR,
+ R_LED_TRFON,
+ R_LED_TOFF,
+ R_MAX_RANGES,
+};
+
+enum mt6370_pattern {
+ P_LED_TR1 = 0,
+ P_LED_TR2,
+ P_LED_TF1,
+ P_LED_TF2,
+ P_LED_TON,
+ P_LED_TOFF,
+ P_MAX_PATTERNS
+};
+
+#define MT6370_REG_DEV_INFO 0x100
+#define MT6370_REG_RGB1_DIM 0x182
+#define MT6370_REG_RGB2_DIM 0x183
+#define MT6370_REG_RGB3_DIM 0x184
+#define MT6370_REG_RGB_EN 0x185
+#define MT6370_REG_RGB1_ISNK 0x186
+#define MT6370_REG_RGB2_ISNK 0x187
+#define MT6370_REG_RGB3_ISNK 0x188
+#define MT6370_REG_RGB1_TR 0x189
+#define MT6370_REG_RGB_CHRIND_DIM 0x192
+#define MT6370_REG_RGB_CHRIND_CTRL 0x193
+#define MT6370_REG_RGB_CHRIND_TR 0x194
+
+#define MT6372_REG_RGB_EN 0x182
+#define MT6372_REG_RGB1_ISNK 0x183
+#define MT6372_REG_RGB2_ISNK 0x184
+#define MT6372_REG_RGB3_ISNK 0x185
+#define MT6372_REG_RGB4_ISNK 0x186
+#define MT6372_REG_RGB1_DIM 0x187
+#define MT6372_REG_RGB2_DIM 0x188
+#define MT6372_REG_RGB3_DIM 0x189
+#define MT6372_REG_RGB4_DIM 0x18A
+#define MT6372_REG_RGB12_FREQ 0x18B
+#define MT6372_REG_RGB34_FREQ 0x18C
+#define MT6372_REG_RGB1_TR 0x18D
+
+#define MT6370_VENID_MASK GENMASK(7, 4)
+#define MT6370_CHEN_BIT(id) BIT(MT6370_LED_ISNK4 - id)
+#define MT6370_VIRTUAL_MULTICOLOR 5
+#define MC_CHANNEL_NUM 3
+#define MT6370_PWM_DUTY 31
+#define MT6372_PMW_DUTY 255
+
+#define STATE_OFF 0
+#define STATE_KEEP 1
+#define STATE_ON 2
+
+struct mt6370_led {
+ union {
+ struct led_classdev isink;
+ struct led_classdev_mc mc;
+ };
+ struct mt6370_priv *priv;
+ u32 default_state;
+ u32 index;
+};
+
+struct mt6370_priv {
+ /* Per LED access lock */
+ struct mutex lock;
+ struct device *dev;
+ struct regmap *regmap;
+ struct regmap_field *fields[F_MAX_FIELDS];
+ const struct reg_field *reg_fields;
+ const struct linear_range *ranges;
+ struct reg_cfg *reg_cfgs;
+ unsigned int leds_count;
+ unsigned int leds_active;
+ bool is_mt6372;
+ struct mt6370_led leds[];
+};
+
+static const struct reg_field common_reg_fields[F_MAX_FIELDS] = {
+ [F_RGB_EN] = REG_FIELD(MT6370_REG_RGB_EN, 4, 7),
+ [F_CHGIND_EN] = REG_FIELD(MT6370_REG_RGB_CHRIND_DIM, 7, 7),
+ [F_LED1_CURR] = REG_FIELD(MT6370_REG_RGB1_ISNK, 0, 2),
+ [F_LED2_CURR] = REG_FIELD(MT6370_REG_RGB2_ISNK, 0, 2),
+ [F_LED3_CURR] = REG_FIELD(MT6370_REG_RGB3_ISNK, 0, 2),
+ [F_LED4_CURR] = REG_FIELD(MT6370_REG_RGB_CHRIND_CTRL, 0, 1),
+ [F_LED1_MODE] = REG_FIELD(MT6370_REG_RGB1_DIM, 5, 6),
+ [F_LED2_MODE] = REG_FIELD(MT6370_REG_RGB2_DIM, 5, 6),
+ [F_LED3_MODE] = REG_FIELD(MT6370_REG_RGB3_DIM, 5, 6),
+ [F_LED4_MODE] = REG_FIELD(MT6370_REG_RGB_CHRIND_DIM, 5, 6),
+ [F_LED1_DUTY] = REG_FIELD(MT6370_REG_RGB1_DIM, 0, 4),
+ [F_LED2_DUTY] = REG_FIELD(MT6370_REG_RGB2_DIM, 0, 4),
+ [F_LED3_DUTY] = REG_FIELD(MT6370_REG_RGB3_DIM, 0, 4),
+ [F_LED4_DUTY] = REG_FIELD(MT6370_REG_RGB_CHRIND_DIM, 0, 4),
+ [F_LED1_FREQ] = REG_FIELD(MT6370_REG_RGB1_ISNK, 3, 5),
+ [F_LED2_FREQ] = REG_FIELD(MT6370_REG_RGB2_ISNK, 3, 5),
+ [F_LED3_FREQ] = REG_FIELD(MT6370_REG_RGB3_ISNK, 3, 5),
+ [F_LED4_FREQ] = REG_FIELD(MT6370_REG_RGB_CHRIND_CTRL, 2, 4)
+};
+
+static const struct reg_field mt6372_reg_fields[F_MAX_FIELDS] = {
+ [F_RGB_EN] = REG_FIELD(MT6372_REG_RGB_EN, 4, 7),
+ [F_CHGIND_EN] = REG_FIELD(MT6372_REG_RGB_EN, 3, 3),
+ [F_LED1_CURR] = REG_FIELD(MT6372_REG_RGB1_ISNK, 0, 3),
+ [F_LED2_CURR] = REG_FIELD(MT6372_REG_RGB2_ISNK, 0, 3),
+ [F_LED3_CURR] = REG_FIELD(MT6372_REG_RGB3_ISNK, 0, 3),
+ [F_LED4_CURR] = REG_FIELD(MT6372_REG_RGB4_ISNK, 0, 3),
+ [F_LED1_MODE] = REG_FIELD(MT6372_REG_RGB1_ISNK, 6, 7),
+ [F_LED2_MODE] = REG_FIELD(MT6372_REG_RGB2_ISNK, 6, 7),
+ [F_LED3_MODE] = REG_FIELD(MT6372_REG_RGB3_ISNK, 6, 7),
+ [F_LED4_MODE] = REG_FIELD(MT6372_REG_RGB4_ISNK, 6, 7),
+ [F_LED1_DUTY] = REG_FIELD(MT6372_REG_RGB1_DIM, 0, 7),
+ [F_LED2_DUTY] = REG_FIELD(MT6372_REG_RGB2_DIM, 0, 7),
+ [F_LED3_DUTY] = REG_FIELD(MT6372_REG_RGB3_DIM, 0, 7),
+ [F_LED4_DUTY] = REG_FIELD(MT6372_REG_RGB4_DIM, 0, 7),
+ [F_LED1_FREQ] = REG_FIELD(MT6372_REG_RGB12_FREQ, 5, 7),
+ [F_LED2_FREQ] = REG_FIELD(MT6372_REG_RGB12_FREQ, 2, 4),
+ [F_LED3_FREQ] = REG_FIELD(MT6372_REG_RGB34_FREQ, 5, 7),
+ [F_LED4_FREQ] = REG_FIELD(MT6372_REG_RGB34_FREQ, 2, 4)
+};
+
+/* Current unit: microamp, time unit: millisecond */
+static const struct linear_range common_led_ranges[R_MAX_RANGES] = {
+ [R_LED123_CURR] = { 4000, 1, 6, 4000 },
+ [R_LED4_CURR] = { 2000, 1, 3, 2000 },
+ [R_LED_TRFON] = { 125, 0, 15, 200 },
+ [R_LED_TOFF] = { 250, 0, 15, 400 }
+};
+
+static const struct linear_range mt6372_led_ranges[R_MAX_RANGES] = {
+ [R_LED123_CURR] = { 2000, 1, 14, 2000 },
+ [R_LED4_CURR] = { 2000, 1, 14, 2000 },
+ [R_LED_TRFON] = { 125, 0, 15, 250 },
+ [R_LED_TOFF] = { 250, 0, 15, 500 }
+};
+
+static enum mt6370_led_field mt6370_get_led_current_field(unsigned int led_no)
+{
+ switch (led_no) {
+ case MT6370_LED_ISNK1:
+ return F_LED1_CURR;
+ case MT6370_LED_ISNK2:
+ return F_LED2_CURR;
+ case MT6370_LED_ISNK3:
+ return F_LED3_CURR;
+ default:
+ return F_LED4_CURR;
+ }
+}
+
+static int mt6370_set_led_brightness(struct mt6370_priv *priv,
+ unsigned int led_no, unsigned int level)
+{
+ enum mt6370_led_field sel_field;
+
+ sel_field = mt6370_get_led_current_field(led_no);
+
+ return regmap_field_write(priv->fields[sel_field], level);
+}
+
+static int mt6370_get_led_brightness(struct mt6370_priv *priv,
+ unsigned int led_no, unsigned int *level)
+{
+ enum mt6370_led_field sel_field;
+
+ sel_field = mt6370_get_led_current_field(led_no);
+
+ return regmap_field_read(priv->fields[sel_field], level);
+}
+
+static int mt6370_set_led_duty(struct mt6370_priv *priv, unsigned int led_no,
+ unsigned int ton, unsigned int toff)
+{
+ enum mt6370_led_field sel_field;
+ unsigned int divisor, ratio;
+
+ divisor = priv->is_mt6372 ? MT6372_PMW_DUTY : MT6370_PWM_DUTY;
+ ratio = ton * divisor / (ton + toff);
+
+ switch (led_no) {
+ case MT6370_LED_ISNK1:
+ sel_field = F_LED1_DUTY;
+ break;
+ case MT6370_LED_ISNK2:
+ sel_field = F_LED2_DUTY;
+ break;
+ case MT6370_LED_ISNK3:
+ sel_field = F_LED3_DUTY;
+ break;
+ default:
+ sel_field = F_LED4_DUTY;
+ }
+
+ return regmap_field_write(priv->fields[sel_field], ratio);
+}
+
+static const unsigned int common_tfreqs[] = {
+ 10000, 5000, 2000, 1000, 500, 200, 5, 1,
+};
+
+static const unsigned int mt6372_tfreqs[] = {
+ 8000, 4000, 2000, 1000, 500, 250, 8, 4,
+};
+
+static int mt6370_set_led_freq(struct mt6370_priv *priv, unsigned int led_no,
+ unsigned int ton, unsigned int toff)
+{
+ enum mt6370_led_field sel_field;
+ const unsigned int *tfreq;
+ unsigned int tfreq_len, tsum;
+ int i;
+
+ if (priv->is_mt6372) {
+ tfreq = mt6372_tfreqs;
+ tfreq_len = ARRAY_SIZE(mt6372_tfreqs);
+ } else {
+ tfreq = common_tfreqs;
+ tfreq_len = ARRAY_SIZE(common_tfreqs);
+ }
+
+ tsum = ton + toff;
+
+ if (tsum > tfreq[0] || tsum < tfreq[tfreq_len - 1])
+ return -EOPNOTSUPP;
+
+ for (i = 0; i < tfreq_len; i++) {
+ if (tsum >= tfreq[i])
+ break;
+ }
+
+ switch (led_no) {
+ case MT6370_LED_ISNK1:
+ sel_field = F_LED1_FREQ;
+ break;
+ case MT6370_LED_ISNK2:
+ sel_field = F_LED2_FREQ;
+ break;
+ case MT6370_LED_ISNK3:
+ sel_field = F_LED3_FREQ;
+ break;
+ default:
+ sel_field = F_LED4_FREQ;
+ }
+
+ return regmap_field_write(priv->fields[sel_field], i);
+}
+
+static void mt6370_get_breath_reg_base(struct mt6370_priv *priv,
+ unsigned int led_no, unsigned int *base)
+{
+ if (priv->is_mt6372) {
+ *base = MT6372_REG_RGB1_TR + led_no * 3;
+ return;
+ }
+
+ switch (led_no) {
+ case MT6370_LED_ISNK1:
+ case MT6370_LED_ISNK2:
+ case MT6370_LED_ISNK3:
+ *base = MT6370_REG_RGB1_TR + led_no * 3;
+ break;
+ default:
+ *base = MT6370_REG_RGB_CHRIND_TR;
+ }
+}
+
+static int mt6370_gen_breath_pattern(struct mt6370_priv *priv,
+ struct led_pattern *pattern, u32 len,
+ u8 *pattern_val, u32 val_len)
+{
+ enum mt6370_led_ranges sel_range;
+ struct led_pattern *curr;
+ unsigned int sel;
+ u8 val[P_MAX_PATTERNS / 2] = {0};
+ int i;
+
+ if (len < P_MAX_PATTERNS && val_len < P_MAX_PATTERNS / 2)
+ return -EINVAL;
+
+ /*
+ * Pattern list
+ * tr1: byte 0, b'[7: 4]
+ * tr2: byte 0, b'[3: 0]
+ * tf1: byte 1, b'[7: 4]
+ * tf2: byte 1, b'[3: 0]
+ * ton: byte 2, b'[7: 4]
+ * toff: byte 2, b'[3: 0]
+ */
+ for (i = 0; i < P_MAX_PATTERNS; i++) {
+ curr = pattern + i;
+
+ sel_range = i == P_LED_TOFF ? R_LED_TOFF : R_LED_TRFON;
+
+ linear_range_get_selector_within(priv->ranges + sel_range,
+ curr->delta_t, &sel);
+
+ val[i / 2] |= sel << (4 * ((i + 1) % 2));
+ }
+
+ memcpy(pattern_val, val, 3);
+ return 0;
+}
+
+static int mt6370_set_led_mode(struct mt6370_priv *priv, unsigned int led_no,
+ enum mt6370_led_mode mode)
+{
+ enum mt6370_led_field sel_field;
+
+ switch (led_no) {
+ case MT6370_LED_ISNK1:
+ sel_field = F_LED1_MODE;
+ break;
+ case MT6370_LED_ISNK2:
+ sel_field = F_LED2_MODE;
+ break;
+ case MT6370_LED_ISNK3:
+ sel_field = F_LED3_MODE;
+ break;
+ default:
+ sel_field = F_LED4_MODE;
+ }
+
+ return regmap_field_write(priv->fields[sel_field], mode);
+}
+
+static int mt6370_mc_brightness_set(struct led_classdev *lcdev,
+ enum led_brightness level)
+{
+ struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
+ struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
+ struct mt6370_priv *priv = led->priv;
+ struct mc_subled *subled;
+ unsigned int enable, disable;
+ int i, ret;
+
+ mutex_lock(&priv->lock);
+
+ led_mc_calc_color_components(mccdev, level);
+
+ ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
+ if (ret)
+ goto out;
+
+ disable = enable;
+
+ for (i = 0; i < mccdev->num_colors; i++) {
+ u32 brightness;
+
+ subled = mccdev->subled_info + i;
+ brightness = min(subled->brightness, lcdev->max_brightness);
+ disable &= ~MT6370_CHEN_BIT(subled->channel);
+
+ if (level == LED_OFF) {
+ enable &= ~MT6370_CHEN_BIT(subled->channel);
+
+ ret = mt6370_set_led_mode(priv, subled->channel,
+ MT6370_LED_REG_MODE);
+ if (ret)
+ goto out;
+
+ continue;
+ }
+
+ if (brightness == LED_OFF) {
+ enable &= ~MT6370_CHEN_BIT(subled->channel);
+ continue;
+ }
+
+ enable |= MT6370_CHEN_BIT(subled->channel);
+
+ ret = mt6370_set_led_brightness(priv, subled->channel,
+ brightness);
+ if (ret)
+ goto out;
+ }
+
+ ret = regmap_field_write(priv->fields[F_RGB_EN], disable);
+ if (ret)
+ goto out;
+
+ ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
+
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static int mt6370_mc_blink_set(struct led_classdev *lcdev,
+ unsigned long *delay_on,
+ unsigned long *delay_off)
+{
+ struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
+ struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
+ struct mt6370_priv *priv = led->priv;
+ struct mc_subled *subled;
+ unsigned int enable, disable;
+ int i, ret;
+
+ mutex_lock(&priv->lock);
+
+ if (!*delay_on && !*delay_off)
+ *delay_on = *delay_off = 500;
+
+ ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
+ if (ret)
+ goto out;
+
+ disable = enable;
+
+ for (i = 0; i < mccdev->num_colors; i++) {
+ subled = mccdev->subled_info + i;
+
+ disable &= ~MT6370_CHEN_BIT(subled->channel);
+
+ ret = mt6370_set_led_duty(priv, subled->channel, *delay_on,
+ *delay_off);
+ if (ret)
+ goto out;
+
+ ret = mt6370_set_led_freq(priv, subled->channel, *delay_on,
+ *delay_off);
+ if (ret)
+ goto out;
+
+ ret = mt6370_set_led_mode(priv, subled->channel,
+ MT6370_LED_PWM_MODE);
+ if (ret)
+ goto out;
+ }
+
+ /* Toggle to make pattern timing the same */
+ ret = regmap_field_write(priv->fields[F_RGB_EN], disable);
+ if (ret)
+ goto out;
+
+ ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
+
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static int mt6370_mc_pattern_set(struct led_classdev *lcdev,
+ struct led_pattern *pattern, u32 len, int repeat)
+{
+ struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
+ struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
+ struct mt6370_priv *priv = led->priv;
+ struct mc_subled *subled;
+ unsigned int reg_base, enable, disable;
+ u8 params[P_MAX_PATTERNS / 2];
+ int i, ret;
+
+ mutex_lock(&priv->lock);
+
+ ret = mt6370_gen_breath_pattern(priv, pattern, len, params,
+ sizeof(params));
+ if (ret)
+ goto out;
+
+ ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
+ if (ret)
+ goto out;
+
+ disable = enable;
+
+ for (i = 0; i < mccdev->num_colors; i++) {
+ subled = mccdev->subled_info + i;
+
+ mt6370_get_breath_reg_base(priv, subled->channel, ®_base);
+ disable &= ~MT6370_CHEN_BIT(subled->channel);
+
+ ret = regmap_raw_write(priv->regmap, reg_base, params,
+ sizeof(params));
+ if (ret)
+ goto out;
+
+ ret = mt6370_set_led_mode(priv, subled->channel,
+ MT6370_LED_BREATH_MODE);
+ if (ret)
+ goto out;
+ }
+
+ /* Toggle to make pattern timing be the same */
+ ret = regmap_field_write(priv->fields[F_RGB_EN], disable);
+ if (ret)
+ goto out;
+
+ ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
+
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static inline int mt6370_mc_pattern_clear(struct led_classdev *lcdev)
+{
+ struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
+ struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
+ struct mt6370_priv *priv = led->priv;
+ struct mc_subled *subled;
+ int i, ret = 0;
+
+ mutex_lock(&led->priv->lock);
+
+ for (i = 0; i < mccdev->num_colors; i++) {
+ subled = mccdev->subled_info + i;
+
+ ret = mt6370_set_led_mode(priv, subled->channel,
+ MT6370_LED_REG_MODE);
+ if (ret)
+ break;
+ }
+
+ mutex_unlock(&led->priv->lock);
+
+ return ret;
+}
+
+static int mt6370_isnk_brightness_set(struct led_classdev *lcdev,
+ enum led_brightness level)
+{
+ struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
+ struct mt6370_priv *priv = led->priv;
+ unsigned int enable;
+ int ret;
+
+ mutex_lock(&priv->lock);
+
+ ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
+ if (ret)
+ goto out;
+
+ if (level == LED_OFF) {
+ enable &= ~MT6370_CHEN_BIT(led->index);
+
+ ret = mt6370_set_led_mode(priv, led->index,
+ MT6370_LED_REG_MODE);
+ if (ret)
+ goto out;
+
+ ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
+ } else {
+ enable |= MT6370_CHEN_BIT(led->index);
+
+ ret = mt6370_set_led_brightness(priv, led->index, level);
+ if (ret)
+ goto out;
+
+ ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
+ }
+
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static int mt6370_isnk_blink_set(struct led_classdev *lcdev,
+ unsigned long *delay_on,
+ unsigned long *delay_off)
+{
+ struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
+ struct mt6370_priv *priv = led->priv;
+ int ret;
+
+ mutex_lock(&priv->lock);
+
+ if (!*delay_on && !*delay_off)
+ *delay_on = *delay_off = 500;
+
+ ret = mt6370_set_led_duty(priv, led->index, *delay_on, *delay_off);
+ if (ret)
+ goto out;
+
+ ret = mt6370_set_led_freq(priv, led->index, *delay_on, *delay_off);
+ if (ret)
+ goto out;
+
+ ret = mt6370_set_led_mode(priv, led->index, MT6370_LED_PWM_MODE);
+
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static int mt6370_isnk_pattern_set(struct led_classdev *lcdev,
+ struct led_pattern *pattern, u32 len,
+ int repeat)
+{
+ struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
+ struct mt6370_priv *priv = led->priv;
+ unsigned int reg_base;
+ u8 params[P_MAX_PATTERNS / 2];
+ int ret;
+
+ mutex_lock(&priv->lock);
+
+ ret = mt6370_gen_breath_pattern(priv, pattern, len, params,
+ sizeof(params));
+ if (ret)
+ goto out;
+
+ mt6370_get_breath_reg_base(priv, led->index, ®_base);
+
+ ret = regmap_raw_write(priv->regmap, reg_base, params, sizeof(params));
+ if (ret)
+ goto out;
+
+ ret = mt6370_set_led_mode(priv, led->index, MT6370_LED_BREATH_MODE);
+
+out:
+ mutex_unlock(&priv->lock);
+
+ return ret;
+}
+
+static inline int mt6370_isnk_pattern_clear(struct led_classdev *lcdev)
+{
+ struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
+ struct mt6370_priv *priv = led->priv;
+ int ret;
+
+ mutex_lock(&led->priv->lock);
+ ret = mt6370_set_led_mode(priv, led->index, MT6370_LED_REG_MODE);
+ mutex_unlock(&led->priv->lock);
+
+ return ret;
+}
+
+static int mt6370_init_led_properties(struct mt6370_led *led,
+ struct led_init_data *init_data)
+{
+ struct mt6370_priv *priv = led->priv;
+ struct led_classdev *lcdev;
+ struct fwnode_handle *child;
+ enum mt6370_led_ranges sel_range;
+ u32 max_uA, max_level;
+ const char * const states[] = { "off", "keep", "on" };
+ const char *stat_str;
+ int ret;
+
+ if (led->index == MT6370_VIRTUAL_MULTICOLOR) {
+ struct mc_subled *sub_led;
+ u32 num_color = 0;
+
+ sub_led = devm_kzalloc(priv->dev,
+ sizeof(*sub_led) * MC_CHANNEL_NUM,
+ GFP_KERNEL);
+ if (!sub_led)
+ return -ENOMEM;
+
+ fwnode_for_each_child_node(init_data->fwnode, child) {
+ u32 reg, color;
+
+ ret = fwnode_property_read_u32(child, "reg", ®);
+ if (ret || reg > MT6370_LED_ISNK3 ||
+ priv->leds_active & BIT(reg))
+ return -EINVAL;
+
+ ret = fwnode_property_read_u32(child, "color", &color);
+ if (ret) {
+ dev_err(priv->dev,
+ "led %d, no color specified\n",
+ led->index);
+ return ret;
+ }
+
+ priv->leds_active |= BIT(reg);
+ sub_led[num_color].color_index = color;
+ sub_led[num_color].channel = reg;
+ num_color++;
+ }
+
+ if (num_color < 2) {
+ dev_err(priv->dev,
+ "Multicolor must include 2 or more led channel\n");
+ return -EINVAL;
+ }
+
+ led->mc.num_colors = num_color;
+ led->mc.subled_info = sub_led;
+
+ lcdev = &led->mc.led_cdev;
+ lcdev->brightness_set_blocking = mt6370_mc_brightness_set;
+ lcdev->blink_set = mt6370_mc_blink_set;
+ lcdev->pattern_set = mt6370_mc_pattern_set;
+ lcdev->pattern_clear = mt6370_mc_pattern_clear;
+ } else {
+ lcdev = &led->isink;
+ lcdev->brightness_set_blocking = mt6370_isnk_brightness_set;
+ lcdev->blink_set = mt6370_isnk_blink_set;
+ lcdev->pattern_set = mt6370_isnk_pattern_set;
+ lcdev->pattern_clear = mt6370_isnk_pattern_clear;
+ }
+
+ ret = fwnode_property_read_u32(init_data->fwnode, "led-max-microamp",
+ &max_uA);
+ if (ret) {
+ dev_warn(priv->dev,
+ "Not specified led-max-microamp, config to the minimum\n");
+ max_uA = 0;
+ }
+
+ if (led->index == MT6370_LED_ISNK4)
+ sel_range = R_LED4_CURR;
+ else
+ sel_range = R_LED123_CURR;
+
+ linear_range_get_selector_within(priv->ranges + sel_range, max_uA,
+ &max_level);
+
+ lcdev->max_brightness = max_level;
+
+ fwnode_property_read_string(init_data->fwnode, "linux,default-trigger",
+ &lcdev->default_trigger);
+
+ if (!fwnode_property_read_string(init_data->fwnode, "default-state",
+ &stat_str)) {
+ ret = match_string(states, ARRAY_SIZE(states), stat_str);
+ if (ret < 0)
+ ret = STATE_OFF;
+
+ led->default_state = ret;
+ }
+
+ return 0;
+}
+
+static int mt6370_isnk_init_default_state(struct mt6370_led *led)
+{
+ struct mt6370_priv *priv = led->priv;
+ unsigned int enable, level;
+ int ret;
+
+ ret = mt6370_get_led_brightness(priv, led->index, &level);
+ if (ret)
+ return ret;
+
+ ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
+ if (ret)
+ return ret;
+
+ if (!(enable & MT6370_CHEN_BIT(led->index)))
+ level = LED_OFF;
+
+ switch (led->default_state) {
+ case STATE_ON:
+ led->isink.brightness = led->isink.max_brightness;
+ break;
+ case STATE_KEEP:
+ led->isink.brightness = min(level, led->isink.max_brightness);
+ break;
+ default:
+ led->isink.brightness = LED_OFF;
+ }
+
+ return mt6370_isnk_brightness_set(&led->isink, led->isink.brightness);
+}
+
+static int mt6370_led_register(struct device *parent, struct mt6370_led *led,
+ struct led_init_data *init_data)
+{
+ struct mt6370_priv *priv = led->priv;
+ int ret;
+
+ if (led->index == MT6370_VIRTUAL_MULTICOLOR) {
+ ret = mt6370_mc_brightness_set(&led->mc.led_cdev, LED_OFF);
+ if (ret) {
+ dev_err(parent, "Couldn't set multicolor brightness\n");
+ return ret;
+ }
+
+ ret = devm_led_classdev_multicolor_register_ext(parent,
+ &led->mc,
+ init_data);
+ if (ret) {
+ dev_err(parent, "Couldn't register multicolor\n");
+ return ret;
+ }
+ } else {
+ if (led->index == MT6370_LED_ISNK4) {
+ ret = regmap_field_write(priv->fields[F_CHGIND_EN], 1);
+ if (ret) {
+ dev_err(parent, "Failed to set CHRIND to SW\n");
+ return ret;
+ }
+ }
+
+ ret = mt6370_isnk_init_default_state(led);
+ if (ret) {
+ dev_err(parent, "Failed to init %d isnk state\n",
+ led->index);
+ return ret;
+ }
+
+ ret = devm_led_classdev_register_ext(parent, &led->isink,
+ init_data);
+ if (ret) {
+ dev_err(parent, "Couldn't register isink %d\n",
+ led->index);
+ return ret;
+ }
+ }
+
+ return 0;
+}
+
+static int mt6370_check_vendor_info(struct mt6370_priv *priv)
+{
+ unsigned int devinfo, vid;
+ int ret;
+
+ ret = regmap_read(priv->regmap, MT6370_REG_DEV_INFO, &devinfo);
+ if (ret)
+ return ret;
+
+ vid = FIELD_GET(MT6370_VENID_MASK, devinfo);
+ if (vid == 0x9 || vid == 0xb) {
+ priv->reg_fields = mt6372_reg_fields;
+ priv->ranges = mt6372_led_ranges;
+ priv->is_mt6372 = true;
+ } else {
+ priv->reg_fields = common_reg_fields;
+ priv->ranges = common_led_ranges;
+ }
+
+ return 0;
+}
+
+static int mt6370_leds_probe(struct platform_device *pdev)
+{
+ struct mt6370_priv *priv;
+ struct fwnode_handle *child;
+ size_t count;
+ int i = 0, ret;
+
+ count = device_get_child_node_count(&pdev->dev);
+ if (!count || count > MT6370_MAX_LEDS) {
+ dev_err(&pdev->dev,
+ "No child node or node count over max led number %zu\n",
+ count);
+ return -EINVAL;
+ }
+
+ priv = devm_kzalloc(&pdev->dev,
+ struct_size(priv, leds, count), GFP_KERNEL);
+ if (!priv)
+ return -ENOMEM;
+
+ priv->leds_count = count;
+ priv->dev = &pdev->dev;
+ mutex_init(&priv->lock);
+
+ priv->regmap = dev_get_regmap(pdev->dev.parent, NULL);
+ if (!priv->regmap)
+ return dev_err_probe(&pdev->dev, -ENODEV,
+ "Failed to get parent regmap\n");
+
+ ret = mt6370_check_vendor_info(priv);
+ if (ret) {
+ dev_err(&pdev->dev, "Failed to check vendor info (%d)\n", ret);
+ return ret;
+ }
+
+ ret = devm_regmap_field_bulk_alloc(&pdev->dev, priv->regmap,
+ priv->fields, priv->reg_fields,
+ F_MAX_FIELDS);
+ if (ret)
+ return dev_err_probe(&pdev->dev, ret,
+ "Failed to allocate regmap field\n");
+
+ device_for_each_child_node(&pdev->dev, child) {
+ struct mt6370_led *led = priv->leds + i++;
+ struct led_init_data init_data = { .fwnode = child, };
+ u32 reg, color;
+
+ ret = fwnode_property_read_u32(child, "reg", ®);
+ if (ret)
+ return dev_err_probe(&pdev->dev, ret,
+ "Failed to parse reg property\n");
+
+ if (reg >= MT6370_MAX_LEDS)
+ return dev_err_probe(&pdev->dev, -EINVAL,
+ "Error reg property number\n");
+
+ ret = fwnode_property_read_u32(child, "color", &color);
+ if (ret) {
+ dev_err(&pdev->dev, "Failed to parse color property\n");
+ return ret;
+ }
+
+ if (color == LED_COLOR_ID_RGB || color == LED_COLOR_ID_MULTI)
+ reg = MT6370_VIRTUAL_MULTICOLOR;
+
+ if (priv->leds_active & BIT(reg))
+ return dev_err_probe(&pdev->dev, -EINVAL,
+ "Duplicat reg property\n");
+
+ priv->leds_active |= BIT(reg);
+
+ led->index = reg;
+ led->priv = priv;
+
+ ret = mt6370_init_led_properties(led, &init_data);
+ if (ret)
+ return ret;
+
+ ret = mt6370_led_register(&pdev->dev, led, &init_data);
+ if (ret)
+ return ret;
+ }
+
+ return 0;
+}
+
+static const struct of_device_id mt6370_rgbled_device_table[] = {
+ { .compatible = "mediatek,mt6370-indicator", },
+ {}
+};
+MODULE_DEVICE_TABLE(of, mt6370_rgbled_device_table);
+
+static struct platform_driver mt6370_rgbled_driver = {
+ .driver = {
+ .name = "mt6370-indicator",
+ .of_match_table = mt6370_rgbled_device_table,
+ },
+ .probe = mt6370_leds_probe,
+};
+module_platform_driver(mt6370_rgbled_driver);
+
+MODULE_AUTHOR("Alice Chen <[email protected]>");
+MODULE_DESCRIPTION("MediaTek MT6370 RGB Led Driver");
+MODULE_LICENSE("GPL v2");
--
2.7.4
From: ChiaEn Wu <[email protected]>
MediaTek MT6370 is a SubPMIC consisting of a single cell battery charger
with ADC monitoring, RGB LEDs, dual channel flashlight, WLED backlight
driver, display bias voltage supply, one general purpose LDO, and the
USB Type-C & PD controller complies with the latest USB Type-C and PD
standards.
This adds MediaTek MT6370 Charger driver support. The charger module
of MT6370 supports High-Accuracy Voltage/Current Regulation,
Average Input Current Regulation, Battery Temperature Sensing,
Over-Temperature Protection, DPDM Detection for BC1.2.
Signed-off-by: ChiaEn Wu <[email protected]>
---
v5
- Replace unsigned int type of pwr_rdy with bool in
mt6370_chg_set_online()
- Remove redundant 'else' in mt6370_chg_field_get()
- Revise 'if-else' in mt6370_chg_field_set()
- Revise 'if' condition in mt6370_chg_enable_irq()
- Revise all text 'otg' --> 'OTG'
- Revise MT6370_MIVR_IBUS_TH_100_MA --> MT6370_MIVR_IBUS_TH_100_mA
- Revise the description of Kconfig help text
---
drivers/power/supply/Kconfig | 14 +
drivers/power/supply/Makefile | 1 +
drivers/power/supply/mt6370-charger.c | 1062 +++++++++++++++++++++++++++++++++
3 files changed, 1077 insertions(+)
create mode 100644 drivers/power/supply/mt6370-charger.c
diff --git a/drivers/power/supply/Kconfig b/drivers/power/supply/Kconfig
index 1aa8323..591deb8 100644
--- a/drivers/power/supply/Kconfig
+++ b/drivers/power/supply/Kconfig
@@ -619,6 +619,20 @@ config CHARGER_MT6360
Average Input Current Regulation, Battery Temperature Sensing,
Over-Temperature Protection, DPDM Detection for BC1.2.
+config CHARGER_MT6370
+ tristate "MediaTek MT6370 Charger Driver"
+ depends on MFD_MT6370
+ depends on REGULATOR
+ select LINEAR_RANGES
+ help
+ Say Y here to enable MT6370 Charger Part.
+ The device supports High-Accuracy Voltage/Current Regulation,
+ Average Input Current Regulation, Battery Temperature Sensing,
+ Over-Temperature Protection, DPDM Detection for BC1.2.
+
+ This driver can also be built as a module. If so, the module
+ will be called "mt6370-charger".
+
config CHARGER_QCOM_SMBB
tristate "Qualcomm Switch-Mode Battery Charger and Boost"
depends on MFD_SPMI_PMIC || COMPILE_TEST
diff --git a/drivers/power/supply/Makefile b/drivers/power/supply/Makefile
index 7f02f36..8c95276 100644
--- a/drivers/power/supply/Makefile
+++ b/drivers/power/supply/Makefile
@@ -82,6 +82,7 @@ obj-$(CONFIG_CHARGER_MAX8997) += max8997_charger.o
obj-$(CONFIG_CHARGER_MAX8998) += max8998_charger.o
obj-$(CONFIG_CHARGER_MP2629) += mp2629_charger.o
obj-$(CONFIG_CHARGER_MT6360) += mt6360_charger.o
+obj-$(CONFIG_CHARGER_MT6370) += mt6370-charger.o
obj-$(CONFIG_CHARGER_QCOM_SMBB) += qcom_smbb.o
obj-$(CONFIG_CHARGER_BQ2415X) += bq2415x_charger.o
obj-$(CONFIG_CHARGER_BQ24190) += bq24190_charger.o
diff --git a/drivers/power/supply/mt6370-charger.c b/drivers/power/supply/mt6370-charger.c
new file mode 100644
index 0000000..76a8c91
--- /dev/null
+++ b/drivers/power/supply/mt6370-charger.c
@@ -0,0 +1,1062 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (C) 2022 Richtek Technology Corp.
+ *
+ * Author: ChiaEn Wu <[email protected]>
+ */
+
+#include <linux/bitfield.h>
+#include <linux/bits.h>
+#include <linux/gpio/consumer.h>
+#include <linux/iio/consumer.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/linear_range.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+#include <linux/power_supply.h>
+#include <linux/regmap.h>
+#include <linux/regulator/driver.h>
+#include <linux/workqueue.h>
+
+#define MT6370_REG_CHG_CTRL1 0x111
+#define MT6370_REG_CHG_CTRL2 0x112
+#define MT6370_REG_CHG_CTRL3 0x113
+#define MT6370_REG_CHG_CTRL4 0x114
+#define MT6370_REG_CHG_CTRL5 0x115
+#define MT6370_REG_CHG_CTRL6 0x116
+#define MT6370_REG_CHG_CTRL7 0x117
+#define MT6370_REG_CHG_CTRL8 0x118
+#define MT6370_REG_CHG_CTRL9 0x119
+#define MT6370_REG_CHG_CTRL10 0x11A
+#define MT6370_REG_DEVICE_TYPE 0x122
+#define MT6370_REG_USB_STATUS1 0x127
+#define MT6370_REG_CHG_STAT 0x14A
+#define MT6370_REG_FLED_EN 0x17E
+#define MT6370_REG_CHG_STAT1 0X1D0
+#define MT6370_REG_OVPCTRL_STAT 0x1D8
+
+#define MT6370_VOBST_MASK GENMASK(7, 2)
+#define MT6370_OTG_PIN_EN_MASK BIT(1)
+#define MT6370_OPA_MODE_MASK BIT(0)
+#define MT6370_OTG_OC_MASK GENMASK(2, 0)
+
+#define MT6370_MIVR_IBUS_TH_100_mA 100000
+#define MT6370_ADC_CHAN_IBUS 5
+#define MT6370_ADC_CHAN_MAX 9
+
+enum mt6370_chg_reg_field {
+ /* MT6370_REG_CHG_CTRL2 */
+ F_IINLMTSEL, F_CFO_EN, F_CHG_EN,
+ /* MT6370_REG_CHG_CTRL3 */
+ F_IAICR, F_AICR_EN, F_ILIM_EN,
+ /* MT6370_REG_CHG_CTRL4 */
+ F_VOREG,
+ /* MT6370_REG_CHG_CTRL6 */
+ F_VMIVR,
+ /* MT6370_REG_CHG_CTRL7 */
+ F_ICHG,
+ /* MT6370_REG_CHG_CTRL8 */
+ F_IPREC,
+ /* MT6370_REG_CHG_CTRL9 */
+ F_IEOC,
+ /* MT6370_REG_DEVICE_TYPE */
+ F_USBCHGEN,
+ /* MT6370_REG_USB_STATUS1 */
+ F_USB_STAT, F_CHGDET,
+ /* MT6370_REG_CHG_STAT */
+ F_CHG_STAT, F_BOOST_STAT, F_VBAT_LVL,
+ /* MT6370_REG_FLED_EN */
+ F_FL_STROBE,
+ /* MT6370_REG_CHG_STAT1 */
+ F_CHG_MIVR_STAT,
+ /* MT6370_REG_OVPCTRL_STAT */
+ F_UVP_D_STAT,
+ F_MAX
+};
+
+struct mt6370_priv {
+ struct device *dev;
+ struct iio_channel *iio_adcs;
+ struct mutex attach_lock;
+ struct power_supply *psy;
+ struct power_supply_desc *psy_desc;
+ struct regmap *regmap;
+ struct regmap_field *rmap_fields[F_MAX];
+ struct regulator_dev *rdev;
+ struct workqueue_struct *wq;
+ struct work_struct bc12_work;
+ struct delayed_work mivr_dwork;
+ int attach;
+ int psy_usb_type;
+ bool pwr_rdy;
+};
+
+enum mt6370_usb_status {
+ MT6370_USB_STAT_NO_VBUS = 0,
+ MT6370_USB_STAT_VBUS_FLOW_IS_UNDER_GOING,
+ MT6370_USB_STAT_SDP,
+ MT6370_USB_STAT_SDP_NSTD,
+ MT6370_USB_STAT_DCP,
+ MT6370_USB_STAT_CDP,
+ MT6370_USB_STAT_MAX
+};
+
+struct mt6370_chg_field {
+ const char *name;
+ const struct linear_range *range;
+ struct reg_field field;
+};
+
+enum {
+ MT6370_RANGE_F_IAICR = 0,
+ MT6370_RANGE_F_VOREG,
+ MT6370_RANGE_F_VMIVR,
+ MT6370_RANGE_F_ICHG,
+ MT6370_RANGE_F_IPREC,
+ MT6370_RANGE_F_IEOC,
+ MT6370_RANGE_F_MAX
+};
+
+#define MT6370_CHG_LINEAR_RANGE(_rfd, _min, _min_sel, _max_sel, _step) \
+[_rfd] = { \
+ .min = _min, \
+ .min_sel = _min_sel, \
+ .max_sel = _max_sel, \
+ .step = _step, \
+}
+
+/* unit: mA or mV */
+static const struct linear_range mt6370_chg_ranges[MT6370_RANGE_F_MAX] = {
+ MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_IAICR, 100, 0x0, 0x3F, 50),
+ MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_VOREG, 3900, 0x0, 0x51, 10),
+ MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_VMIVR, 3900, 0x0, 0x5F, 100),
+ MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_ICHG, 900, 0x08, 0x31, 100),
+ MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_IPREC, 100, 0x0, 0x0F, 50),
+ MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_IEOC, 100, 0x0, 0x0F, 50),
+};
+
+#define MT6370_CHG_FIELD(_fd, _reg, _lsb, _msb) \
+[_fd] = { \
+ .name = #_fd, \
+ .range = NULL, \
+ .field = REG_FIELD(_reg, _lsb, _msb), \
+}
+
+#define MT6370_CHG_FIELD_RANGE(_fd, _reg, _lsb, _msb) \
+[_fd] = { \
+ .name = #_fd, \
+ .range = &mt6370_chg_ranges[MT6370_RANGE_##_fd], \
+ .field = REG_FIELD(_reg, _lsb, _msb), \
+}
+
+static const struct mt6370_chg_field mt6370_chg_fields[F_MAX] = {
+ MT6370_CHG_FIELD(F_IINLMTSEL, MT6370_REG_CHG_CTRL2, 2, 3),
+ MT6370_CHG_FIELD(F_CFO_EN, MT6370_REG_CHG_CTRL2, 1, 1),
+ MT6370_CHG_FIELD(F_CHG_EN, MT6370_REG_CHG_CTRL2, 0, 0),
+ MT6370_CHG_FIELD_RANGE(F_IAICR, MT6370_REG_CHG_CTRL3, 2, 7),
+ MT6370_CHG_FIELD(F_AICR_EN, MT6370_REG_CHG_CTRL3, 1, 1),
+ MT6370_CHG_FIELD(F_ILIM_EN, MT6370_REG_CHG_CTRL3, 0, 0),
+ MT6370_CHG_FIELD_RANGE(F_VOREG, MT6370_REG_CHG_CTRL4, 1, 7),
+ MT6370_CHG_FIELD_RANGE(F_VMIVR, MT6370_REG_CHG_CTRL6, 1, 7),
+ MT6370_CHG_FIELD_RANGE(F_ICHG, MT6370_REG_CHG_CTRL7, 2, 7),
+ MT6370_CHG_FIELD_RANGE(F_IPREC, MT6370_REG_CHG_CTRL8, 0, 3),
+ MT6370_CHG_FIELD_RANGE(F_IEOC, MT6370_REG_CHG_CTRL9, 4, 7),
+ MT6370_CHG_FIELD(F_USBCHGEN, MT6370_REG_DEVICE_TYPE, 7, 7),
+ MT6370_CHG_FIELD(F_USB_STAT, MT6370_REG_USB_STATUS1, 4, 6),
+ MT6370_CHG_FIELD(F_CHGDET, MT6370_REG_USB_STATUS1, 3, 3),
+ MT6370_CHG_FIELD(F_CHG_STAT, MT6370_REG_CHG_STAT, 6, 7),
+ MT6370_CHG_FIELD(F_BOOST_STAT, MT6370_REG_CHG_STAT, 3, 3),
+ MT6370_CHG_FIELD(F_VBAT_LVL, MT6370_REG_CHG_STAT, 5, 5),
+ MT6370_CHG_FIELD(F_FL_STROBE, MT6370_REG_FLED_EN, 2, 2),
+ MT6370_CHG_FIELD(F_CHG_MIVR_STAT, MT6370_REG_CHG_STAT1, 6, 6),
+ MT6370_CHG_FIELD(F_UVP_D_STAT, MT6370_REG_OVPCTRL_STAT, 4, 4),
+};
+
+static inline int mt6370_chg_field_get(struct mt6370_priv *priv,
+ enum mt6370_chg_reg_field fd,
+ unsigned int *val)
+{
+ int ret;
+ unsigned int reg_val;
+
+ ret = regmap_field_read(priv->rmap_fields[fd], ®_val);
+ if (ret < 0)
+ return ret;
+
+ if (mt6370_chg_fields[fd].range)
+ return linear_range_get_value(mt6370_chg_fields[fd].range,
+ reg_val, val);
+
+ *val = reg_val;
+ return 0;
+}
+
+static inline int mt6370_chg_field_set(struct mt6370_priv *priv,
+ enum mt6370_chg_reg_field fd,
+ unsigned int val)
+{
+ int ret;
+ bool f;
+ const struct linear_range *r;
+
+ if (mt6370_chg_fields[fd].range) {
+ r = mt6370_chg_fields[fd].range;
+
+ if (fd == F_VMIVR) {
+ ret = linear_range_get_selector_high(r, val, &val, &f);
+ if (!ret)
+ val = r->max_sel;
+ } else {
+ linear_range_get_selector_within(r, val, &val);
+ }
+ }
+
+ return regmap_field_write(priv->rmap_fields[fd], val);
+}
+
+enum {
+ MT6370_CHG_STAT_READY = 0,
+ MT6370_CHG_STAT_CHARGE_IN_PROGRESS,
+ MT6370_CHG_STAT_DONE,
+ MT6370_CHG_STAT_FAULT,
+ MT6370_CHG_STAT_MAX
+};
+
+enum {
+ MT6370_ATTACH_STAT_DETACH = 0,
+ MT6370_ATTACH_STAT_ATTACH_BC12_NOT_DONE,
+ MT6370_ATTACH_STAT_ATTACH_BC12_DONE,
+ MT6370_ATTACH_STAT_ATTACH_MAX
+};
+
+static int mt6370_chg_otg_of_parse_cb(struct device_node *of,
+ const struct regulator_desc *rdesc,
+ struct regulator_config *rcfg)
+{
+ struct mt6370_priv *priv = rcfg->driver_data;
+
+ rcfg->ena_gpiod = fwnode_gpiod_get_index(of_fwnode_handle(of),
+ "enable", 0, GPIOD_OUT_LOW |
+ GPIOD_FLAGS_BIT_NONEXCLUSIVE,
+ rdesc->name);
+ if (IS_ERR(rcfg->ena_gpiod)) {
+ rcfg->ena_gpiod = NULL;
+ return 0;
+ }
+
+ return regmap_update_bits(priv->regmap, MT6370_REG_CHG_CTRL1,
+ MT6370_OTG_PIN_EN_MASK,
+ MT6370_OTG_PIN_EN_MASK);
+}
+
+static void mt6370_chg_bc12_work_func(struct work_struct *work)
+{
+ struct mt6370_priv *priv = container_of(work, struct mt6370_priv,
+ bc12_work);
+ int ret;
+ bool rpt_psy = false;
+ unsigned int attach, usb_stat;
+
+ mutex_lock(&priv->attach_lock);
+ attach = priv->attach;
+
+ switch (attach) {
+ case MT6370_ATTACH_STAT_DETACH:
+ usb_stat = 0;
+ break;
+ case MT6370_ATTACH_STAT_ATTACH_BC12_DONE:
+ ret = mt6370_chg_field_get(priv, F_USB_STAT, &usb_stat);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to get USB status\n");
+ goto bc12_work_func_out;
+ }
+ break;
+ case MT6370_ATTACH_STAT_ATTACH_BC12_NOT_DONE:
+ ret = mt6370_chg_field_set(priv, F_USBCHGEN, attach);
+ if (ret < 0)
+ dev_err(priv->dev, "Failed to enable USB CHG EN\n");
+ goto bc12_work_func_out;
+ default:
+ dev_err(priv->dev, "Invalid attach state\n");
+ goto bc12_work_func_out;
+ }
+
+ rpt_psy = true;
+
+ switch (usb_stat) {
+ case MT6370_USB_STAT_SDP:
+ priv->psy_desc->type = POWER_SUPPLY_TYPE_USB;
+ priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_SDP;
+ break;
+ case MT6370_USB_STAT_SDP_NSTD:
+ priv->psy_desc->type = POWER_SUPPLY_TYPE_USB;
+ priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_DCP;
+ break;
+ case MT6370_USB_STAT_DCP:
+ priv->psy_desc->type = POWER_SUPPLY_TYPE_USB_DCP;
+ priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_DCP;
+ break;
+ case MT6370_USB_STAT_CDP:
+ priv->psy_desc->type = POWER_SUPPLY_TYPE_USB_CDP;
+ priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_CDP;
+ break;
+ case MT6370_USB_STAT_NO_VBUS:
+ case MT6370_USB_STAT_VBUS_FLOW_IS_UNDER_GOING:
+ default:
+ priv->psy_desc->type = POWER_SUPPLY_TYPE_USB;
+ priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_UNKNOWN;
+ break;
+ }
+
+bc12_work_func_out:
+ mutex_unlock(&priv->attach_lock);
+
+ if (rpt_psy)
+ power_supply_changed(priv->psy);
+}
+
+static inline void mt6370_chg_enable_irq(struct mt6370_priv *priv,
+ const char *irq_name, bool en)
+{
+ int irq_num;
+ struct platform_device *pdev = to_platform_device(priv->dev);
+
+ irq_num = platform_get_irq_byname(pdev, irq_name);
+ if (irq_num < 0)
+ return;
+
+ if (en)
+ enable_irq(irq_num);
+ else
+ disable_irq_nosync(irq_num);
+}
+
+static int mt6370_chg_toggle_cfo(struct mt6370_priv *priv)
+{
+ int ret;
+ unsigned int fl_strobe;
+
+ /* check if flash led in strobe mode */
+ ret = mt6370_chg_field_get(priv, F_FL_STROBE, &fl_strobe);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to get FL_STROBE_EN\n");
+ return ret;
+ }
+
+ if (fl_strobe) {
+ dev_err(priv->dev, "Flash led is still in strobe mode\n");
+ return ret;
+ }
+
+ /* cfo off */
+ ret = mt6370_chg_field_set(priv, F_CFO_EN, 0);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to disable CFO_EN\n");
+ return ret;
+ }
+
+ /* cfo on */
+ ret = mt6370_chg_field_set(priv, F_CFO_EN, 1);
+ if (ret < 0)
+ dev_err(priv->dev, "Failed to enable CFO_EN\n");
+
+ return ret;
+}
+
+static int mt6370_chg_read_adc_chan(struct mt6370_priv *priv, unsigned int chan,
+ int *val)
+{
+ int ret;
+
+ if (chan >= MT6370_ADC_CHAN_MAX)
+ return -EINVAL;
+
+ ret = iio_read_channel_processed(&priv->iio_adcs[chan], val);
+ if (ret)
+ dev_err(priv->dev, "Failed to read ADC\n");
+
+ return ret;
+}
+
+static void mt6370_chg_mivr_dwork_func(struct work_struct *work)
+{
+ struct mt6370_priv *priv = container_of(work, struct mt6370_priv,
+ mivr_dwork.work);
+ int ret;
+ unsigned int mivr_stat, ibus;
+
+ ret = mt6370_chg_field_get(priv, F_CHG_MIVR_STAT, &mivr_stat);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to get mivr state\n");
+ goto mivr_handler_out;
+ }
+
+ if (!mivr_stat)
+ goto mivr_handler_out;
+
+ ret = mt6370_chg_read_adc_chan(priv, MT6370_ADC_CHAN_IBUS, &ibus);
+ if (ret) {
+ dev_err(priv->dev, "Failed to get ibus\n");
+ goto mivr_handler_out;
+ }
+
+ if (ibus < MT6370_MIVR_IBUS_TH_100_mA) {
+ ret = mt6370_chg_toggle_cfo(priv);
+ if (ret)
+ dev_err(priv->dev, "Failed to toggle cfo\n");
+ }
+
+mivr_handler_out:
+ mt6370_chg_enable_irq(priv, "mivr", true);
+ pm_relax(priv->dev);
+}
+
+static void mt6370_chg_pwr_rdy_check(struct mt6370_priv *priv)
+{
+ int ret;
+ unsigned int pwr_rdy, otg_en;
+ union power_supply_propval val;
+
+ /* Check in OTG mode or not */
+ ret = mt6370_chg_field_get(priv, F_BOOST_STAT, &otg_en);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to get OTG state\n");
+ return;
+ }
+
+ if (otg_en)
+ return;
+
+ ret = mt6370_chg_field_get(priv, F_UVP_D_STAT, &pwr_rdy);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to get pwr_rdy state reg\n");
+ return;
+ }
+
+ val.intval = !pwr_rdy;
+
+ ret = power_supply_set_property(priv->psy, POWER_SUPPLY_PROP_ONLINE,
+ &val);
+ if (ret < 0)
+ dev_err(priv->dev, "Failed to start attach/detach flow\n");
+}
+
+static int mt6370_chg_get_online(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ mutex_lock(&priv->attach_lock);
+ val->intval = !!priv->attach;
+ mutex_unlock(&priv->attach_lock);
+
+ return 0;
+}
+
+static int mt6370_chg_get_status(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ int ret;
+ unsigned int chg_stat;
+ union power_supply_propval online;
+
+ ret = power_supply_get_property(priv->psy, POWER_SUPPLY_PROP_ONLINE,
+ &online);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to get online status\n");
+ return ret;
+ }
+
+ if (!online.intval) {
+ val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
+ return 0;
+ }
+
+ ret = mt6370_chg_field_get(priv, F_CHG_STAT, &chg_stat);
+ if (ret < 0)
+ return ret;
+
+ switch (chg_stat) {
+ case MT6370_CHG_STAT_READY:
+ case MT6370_CHG_STAT_FAULT:
+ val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
+ return ret;
+ case MT6370_CHG_STAT_CHARGE_IN_PROGRESS:
+ val->intval = POWER_SUPPLY_STATUS_CHARGING;
+ return ret;
+ case MT6370_CHG_STAT_DONE:
+ val->intval = POWER_SUPPLY_STATUS_FULL;
+ return ret;
+ default:
+ val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
+ return ret;
+ }
+}
+
+static int mt6370_chg_get_charge_type(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ int type, ret;
+ unsigned int chg_stat, vbat_lvl;
+
+ ret = mt6370_chg_field_get(priv, F_CHG_STAT, &chg_stat);
+ if (ret < 0)
+ return ret;
+
+ ret = mt6370_chg_field_get(priv, F_VBAT_LVL, &vbat_lvl);
+ if (ret < 0)
+ return ret;
+
+ switch (chg_stat) {
+ case MT6370_CHG_STAT_CHARGE_IN_PROGRESS:
+ if (vbat_lvl)
+ type = POWER_SUPPLY_CHARGE_TYPE_FAST;
+ else
+ type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
+ break;
+ case MT6370_CHG_STAT_READY:
+ case MT6370_CHG_STAT_DONE:
+ case MT6370_CHG_STAT_FAULT:
+ default:
+ type = POWER_SUPPLY_CHARGE_TYPE_NONE;
+ break;
+ }
+
+ val->intval = type;
+
+ return 0;
+}
+
+static int mt6370_chg_get_ichg(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ return mt6370_chg_field_get(priv, F_ICHG, &val->intval);
+}
+
+static int mt6370_chg_get_max_ichg(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ val->intval = linear_range_get_max_value(
+ &mt6370_chg_ranges[MT6370_RANGE_F_ICHG]);
+ return 0;
+}
+
+static int mt6370_chg_get_cv(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ return mt6370_chg_field_get(priv, F_VOREG, &val->intval);
+}
+
+static int mt6370_chg_get_max_cv(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ val->intval = linear_range_get_max_value(
+ &mt6370_chg_ranges[MT6370_RANGE_F_VOREG]);
+ return 0;
+}
+
+static int mt6370_chg_get_aicr(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ return mt6370_chg_field_get(priv, F_IAICR, &val->intval);
+}
+
+static int mt6370_chg_get_mivr(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ return mt6370_chg_field_get(priv, F_VMIVR, &val->intval);
+}
+
+static int mt6370_chg_get_iprechg(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ return mt6370_chg_field_get(priv, F_IPREC, &val->intval);
+}
+
+static int mt6370_chg_get_ieoc(struct mt6370_priv *priv,
+ union power_supply_propval *val)
+{
+ return mt6370_chg_field_get(priv, F_IEOC, &val->intval);
+}
+
+static int mt6370_chg_set_online(struct mt6370_priv *priv,
+ const union power_supply_propval *val)
+{
+ bool pwr_rdy = !!val->intval;
+
+ mutex_lock(&priv->attach_lock);
+ if (pwr_rdy == !!priv->attach) {
+ dev_err(priv->dev, "pwr_rdy is same(%d)\n", pwr_rdy);
+ mutex_unlock(&priv->attach_lock);
+ return 0;
+ }
+
+ priv->attach = pwr_rdy;
+ mutex_unlock(&priv->attach_lock);
+
+ if (!queue_work(priv->wq, &priv->bc12_work))
+ dev_err(priv->dev, "bc12 work has already queued\n");
+
+ return 0;
+}
+
+static int mt6370_chg_set_ichg(struct mt6370_priv *priv,
+ const union power_supply_propval *val)
+{
+ return mt6370_chg_field_set(priv, F_ICHG, val->intval);
+}
+
+static int mt6370_chg_set_cv(struct mt6370_priv *priv,
+ const union power_supply_propval *val)
+{
+ return mt6370_chg_field_set(priv, F_VOREG, val->intval);
+}
+
+static int mt6370_chg_set_aicr(struct mt6370_priv *priv,
+ const union power_supply_propval *val)
+{
+ return mt6370_chg_field_set(priv, F_IAICR, val->intval);
+}
+
+static int mt6370_chg_set_mivr(struct mt6370_priv *priv,
+ const union power_supply_propval *val)
+{
+ return mt6370_chg_field_set(priv, F_VMIVR, val->intval);
+}
+
+static int mt6370_chg_set_iprechg(struct mt6370_priv *priv,
+ const union power_supply_propval *val)
+{
+ return mt6370_chg_field_set(priv, F_IPREC, val->intval);
+}
+
+static int mt6370_chg_set_ieoc(struct mt6370_priv *priv,
+ const union power_supply_propval *val)
+{
+ return mt6370_chg_field_set(priv, F_IEOC, val->intval);
+}
+
+static int mt6370_chg_get_property(struct power_supply *psy,
+ enum power_supply_property psp,
+ union power_supply_propval *val)
+{
+ struct mt6370_priv *priv = power_supply_get_drvdata(psy);
+
+ switch (psp) {
+ case POWER_SUPPLY_PROP_ONLINE:
+ return mt6370_chg_get_online(priv, val);
+ case POWER_SUPPLY_PROP_STATUS:
+ return mt6370_chg_get_status(priv, val);
+ case POWER_SUPPLY_PROP_CHARGE_TYPE:
+ return mt6370_chg_get_charge_type(priv, val);
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
+ return mt6370_chg_get_ichg(priv, val);
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
+ return mt6370_chg_get_max_ichg(priv, val);
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
+ return mt6370_chg_get_cv(priv, val);
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
+ return mt6370_chg_get_max_cv(priv, val);
+ case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
+ return mt6370_chg_get_aicr(priv, val);
+ case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
+ return mt6370_chg_get_mivr(priv, val);
+ case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
+ return mt6370_chg_get_iprechg(priv, val);
+ case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
+ return mt6370_chg_get_ieoc(priv, val);
+ case POWER_SUPPLY_PROP_TYPE:
+ val->intval = priv->psy_desc->type;
+ return 0;
+ case POWER_SUPPLY_PROP_USB_TYPE:
+ val->intval = priv->psy_usb_type;
+ return 0;
+ default:
+ return -EINVAL;
+ }
+}
+
+static int mt6370_chg_set_property(struct power_supply *psy,
+ enum power_supply_property psp,
+ const union power_supply_propval *val)
+{
+ struct mt6370_priv *priv = power_supply_get_drvdata(psy);
+
+ switch (psp) {
+ case POWER_SUPPLY_PROP_ONLINE:
+ return mt6370_chg_set_online(priv, val);
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
+ return mt6370_chg_set_ichg(priv, val);
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
+ return mt6370_chg_set_cv(priv, val);
+ case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
+ return mt6370_chg_set_aicr(priv, val);
+ case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
+ return mt6370_chg_set_mivr(priv, val);
+ case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
+ return mt6370_chg_set_iprechg(priv, val);
+ case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
+ return mt6370_chg_set_ieoc(priv, val);
+ default:
+ return -EINVAL;
+ }
+}
+
+static int mt6370_chg_property_is_writeable(struct power_supply *psy,
+ enum power_supply_property psp)
+{
+ switch (psp) {
+ case POWER_SUPPLY_PROP_ONLINE:
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
+ case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
+ case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
+ case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
+ case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
+ return 1;
+ default:
+ return 0;
+ }
+}
+
+static enum power_supply_property mt6370_chg_properties[] = {
+ POWER_SUPPLY_PROP_ONLINE,
+ POWER_SUPPLY_PROP_STATUS,
+ POWER_SUPPLY_PROP_CHARGE_TYPE,
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT,
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE,
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
+ POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
+ POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT,
+ POWER_SUPPLY_PROP_PRECHARGE_CURRENT,
+ POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT,
+ POWER_SUPPLY_PROP_TYPE,
+ POWER_SUPPLY_PROP_USB_TYPE,
+};
+
+static enum power_supply_usb_type mt6370_chg_usb_types[] = {
+ POWER_SUPPLY_USB_TYPE_UNKNOWN,
+ POWER_SUPPLY_USB_TYPE_SDP,
+ POWER_SUPPLY_USB_TYPE_CDP,
+ POWER_SUPPLY_USB_TYPE_DCP,
+};
+
+static struct power_supply_desc mt6370_chg_psy_desc = {
+ .type = POWER_SUPPLY_TYPE_USB,
+ .properties = mt6370_chg_properties,
+ .num_properties = ARRAY_SIZE(mt6370_chg_properties),
+ .get_property = mt6370_chg_get_property,
+ .set_property = mt6370_chg_set_property,
+ .property_is_writeable = mt6370_chg_property_is_writeable,
+ .usb_types = mt6370_chg_usb_types,
+ .num_usb_types = ARRAY_SIZE(mt6370_chg_usb_types),
+};
+
+static const struct regulator_ops mt6370_chg_otg_ops = {
+ .list_voltage = regulator_list_voltage_linear,
+ .enable = regulator_enable_regmap,
+ .disable = regulator_disable_regmap,
+ .is_enabled = regulator_is_enabled_regmap,
+ .set_voltage_sel = regulator_set_voltage_sel_regmap,
+ .get_voltage_sel = regulator_get_voltage_sel_regmap,
+ .set_current_limit = regulator_set_current_limit_regmap,
+ .get_current_limit = regulator_get_current_limit_regmap,
+};
+
+static const u32 mt6370_chg_otg_oc_ma[] = {
+ 500000, 700000, 1100000, 1300000, 1800000, 2100000, 2400000,
+};
+
+static const struct regulator_desc mt6370_chg_otg_rdesc = {
+ .of_match = "usb-otg-vbus-regulator",
+ .of_parse_cb = mt6370_chg_otg_of_parse_cb,
+ .name = "mt6370-usb-otg-vbus",
+ .ops = &mt6370_chg_otg_ops,
+ .owner = THIS_MODULE,
+ .type = REGULATOR_VOLTAGE,
+ .min_uV = 4425000,
+ .uV_step = 25000,
+ .n_voltages = 57,
+ .vsel_reg = MT6370_REG_CHG_CTRL5,
+ .vsel_mask = MT6370_VOBST_MASK,
+ .enable_reg = MT6370_REG_CHG_CTRL1,
+ .enable_mask = MT6370_OPA_MODE_MASK,
+ .curr_table = mt6370_chg_otg_oc_ma,
+ .n_current_limits = ARRAY_SIZE(mt6370_chg_otg_oc_ma),
+ .csel_reg = MT6370_REG_CHG_CTRL10,
+ .csel_mask = MT6370_OTG_OC_MASK,
+};
+
+static int mt6370_chg_init_rmap_fields(struct mt6370_priv *priv)
+{
+ int i;
+ const struct mt6370_chg_field *fds = mt6370_chg_fields;
+
+ for (i = 0; i < F_MAX; i++) {
+ priv->rmap_fields[i] = devm_regmap_field_alloc(priv->dev,
+ priv->regmap,
+ fds[i].field);
+ if (IS_ERR(priv->rmap_fields[i]))
+ return dev_err_probe(priv->dev,
+ PTR_ERR(priv->rmap_fields[i]),
+ "Failed to allocate regmapfield[%s]\n",
+ fds[i].name);
+ }
+
+ return 0;
+}
+
+static int mt6370_chg_init_setting(struct mt6370_priv *priv)
+{
+ int ret;
+
+ /* Disable usb_chg_en */
+ ret = mt6370_chg_field_set(priv, F_USBCHGEN, 0);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to disable usb_chg_en\n");
+ return ret;
+ }
+
+ /* ICHG/IEOC Workaround, ICHG can not be set less than 900mA */
+ ret = mt6370_chg_field_set(priv, F_ICHG, 900);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to set ICHG to 900mA");
+ return ret;
+ }
+
+ /* Change input current limit selection to using IAICR results */
+ ret = mt6370_chg_field_set(priv, F_IINLMTSEL, 3);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to set IINLMTSEL\n");
+ return ret;
+ }
+
+ return 0;
+}
+
+#define MT6370_CHG_DT_PROP_DECL(_name, _type, _field) \
+{ \
+ .name = "mediatek,chg-" #_name, \
+ .type = MT6370_PARSE_TYPE_##_type, \
+ .fd = _field, \
+}
+
+static int mt6370_chg_init_otg_regulator(struct mt6370_priv *priv)
+{
+ struct regulator_config rcfg = {
+ .dev = priv->dev,
+ .regmap = priv->regmap,
+ .driver_data = priv,
+ };
+
+ priv->rdev = devm_regulator_register(priv->dev, &mt6370_chg_otg_rdesc,
+ &rcfg);
+
+ return PTR_ERR_OR_ZERO(priv->rdev);
+}
+
+static int mt6370_chg_init_psy(struct mt6370_priv *priv)
+{
+ struct power_supply_config cfg = {
+ .drv_data = priv,
+ .of_node = dev_of_node(priv->dev),
+ };
+
+ priv->psy_desc = &mt6370_chg_psy_desc;
+ priv->psy_desc->name = dev_name(priv->dev);
+ priv->psy = devm_power_supply_register(priv->dev, priv->psy_desc, &cfg);
+
+ return PTR_ERR_OR_ZERO(priv->psy);
+}
+
+static irqreturn_t mt6370_attach_i_handler(int irq, void *data)
+{
+ struct mt6370_priv *priv = data;
+ unsigned int otg_en;
+ int ret;
+
+ /* Check in otg mode or not */
+ ret = mt6370_chg_field_get(priv, F_BOOST_STAT, &otg_en);
+ if (ret < 0) {
+ dev_err(priv->dev, "Failed to get otg state\n");
+ return IRQ_NONE;
+ }
+
+ if (otg_en)
+ return IRQ_HANDLED;
+
+ mutex_lock(&priv->attach_lock);
+ priv->attach = MT6370_ATTACH_STAT_ATTACH_BC12_DONE;
+ mutex_unlock(&priv->attach_lock);
+
+ if (!queue_work(priv->wq, &priv->bc12_work))
+ dev_err(priv->dev, "bc12 work has already queued\n");
+
+ return IRQ_HANDLED;
+}
+
+static irqreturn_t mt6370_uvp_d_evt_handler(int irq, void *data)
+{
+ struct mt6370_priv *priv = data;
+
+ mt6370_chg_pwr_rdy_check(priv);
+
+ return IRQ_HANDLED;
+}
+
+static irqreturn_t mt6370_mivr_handler(int irq, void *data)
+{
+ struct mt6370_priv *priv = data;
+
+ pm_stay_awake(priv->dev);
+ mt6370_chg_enable_irq(priv, "mivr", false);
+ schedule_delayed_work(&priv->mivr_dwork, msecs_to_jiffies(200));
+
+ return IRQ_HANDLED;
+}
+
+#define MT6370_CHG_IRQ(_name) \
+{ \
+ .name = #_name, \
+ .handler = mt6370_##_name##_handler, \
+}
+
+static int mt6370_chg_init_irq(struct mt6370_priv *priv)
+{
+ int i, ret;
+ const struct {
+ char *name;
+ irq_handler_t handler;
+ } mt6370_chg_irqs[] = {
+ MT6370_CHG_IRQ(attach_i),
+ MT6370_CHG_IRQ(uvp_d_evt),
+ MT6370_CHG_IRQ(mivr),
+ };
+
+ for (i = 0; i < ARRAY_SIZE(mt6370_chg_irqs); i++) {
+ ret = platform_get_irq_byname(to_platform_device(priv->dev),
+ mt6370_chg_irqs[i].name);
+ if (ret < 0)
+ return dev_err_probe(priv->dev, ret,
+ "Failed to get irq %s\n",
+ mt6370_chg_irqs[i].name);
+
+ ret = devm_request_threaded_irq(priv->dev, ret, NULL,
+ mt6370_chg_irqs[i].handler,
+ IRQF_TRIGGER_FALLING,
+ dev_name(priv->dev),
+ priv);
+
+ if (ret < 0)
+ return dev_err_probe(priv->dev, ret,
+ "Failed to request irq %s\n",
+ mt6370_chg_irqs[i].name);
+ }
+
+ return 0;
+}
+
+static int mt6370_chg_probe(struct platform_device *pdev)
+{
+ int ret;
+ struct mt6370_priv *priv;
+
+ priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
+ if (!priv)
+ return -ENOMEM;
+
+ priv->dev = &pdev->dev;
+
+ priv->regmap = dev_get_regmap(pdev->dev.parent, NULL);
+ if (!priv->regmap)
+ return dev_err_probe(&pdev->dev, -ENODEV,
+ "Failed to get regmap\n");
+
+ ret = mt6370_chg_init_rmap_fields(priv);
+ if (ret)
+ return dev_err_probe(&pdev->dev, ret,
+ "Failed to init regmap fields\n");
+
+ platform_set_drvdata(pdev, priv);
+
+ priv->iio_adcs = devm_iio_channel_get_all(priv->dev);
+ if (IS_ERR(priv->iio_adcs))
+ return dev_err_probe(&pdev->dev, PTR_ERR(priv->iio_adcs),
+ "Failed to get iio adc\n");
+
+ ret = mt6370_chg_init_otg_regulator(priv);
+ if (ret)
+ return dev_err_probe(&pdev->dev, ret,
+ "Failed to init otg regulator\n");
+
+ ret = mt6370_chg_init_psy(priv);
+ if (ret)
+ return dev_err_probe(&pdev->dev, ret, "Failed to init psy\n");
+
+ mutex_init(&priv->attach_lock);
+ priv->attach = MT6370_ATTACH_STAT_DETACH;
+
+ priv->wq = create_singlethread_workqueue(dev_name(priv->dev));
+ if (IS_ERR(priv->wq))
+ return dev_err_probe(priv->dev, PTR_ERR(priv->wq),
+ "Failed to create workqueue\n");
+
+ INIT_WORK(&priv->bc12_work, mt6370_chg_bc12_work_func);
+ INIT_DELAYED_WORK(&priv->mivr_dwork, mt6370_chg_mivr_dwork_func);
+
+ ret = mt6370_chg_init_setting(priv);
+ if (ret) {
+ dev_err(&pdev->dev, "Failed to init mt6370 charger setting\n");
+ goto probe_out;
+ }
+
+ ret = mt6370_chg_init_irq(priv);
+ if (ret)
+ goto probe_out;
+
+ mt6370_chg_pwr_rdy_check(priv);
+
+ return 0;
+
+probe_out:
+ cancel_delayed_work_sync(&priv->mivr_dwork);
+ flush_workqueue(priv->wq);
+ destroy_workqueue(priv->wq);
+ mutex_destroy(&priv->attach_lock);
+
+ return ret;
+}
+
+static int mt6370_chg_remove(struct platform_device *pdev)
+{
+ struct mt6370_priv *priv = platform_get_drvdata(pdev);
+
+ cancel_delayed_work_sync(&priv->mivr_dwork);
+ flush_workqueue(priv->wq);
+ destroy_workqueue(priv->wq);
+ mutex_destroy(&priv->attach_lock);
+
+ return 0;
+}
+
+static const struct of_device_id mt6370_chg_of_match[] = {
+ { .compatible = "mediatek,mt6370-charger", },
+ {}
+};
+MODULE_DEVICE_TABLE(of, mt6370_chg_of_match);
+
+static struct platform_driver mt6370_chg_driver = {
+ .probe = mt6370_chg_probe,
+ .remove = mt6370_chg_remove,
+ .driver = {
+ .name = "mt6370-charger",
+ .of_match_table = mt6370_chg_of_match,
+ },
+};
+module_platform_driver(mt6370_chg_driver);
+
+MODULE_AUTHOR("ChiaEn Wu <[email protected]>");
+MODULE_DESCRIPTION("MediaTek MT6370 Charger Driver");
+MODULE_LICENSE("GPL v2");
--
2.7.4
Il 15/07/22 13:26, ChiaEn Wu ha scritto:
> From: ChiYuan Huang <[email protected]>
>
> The MediaTek MT6370 is a highly-integrated smart power management IC,
> which includes a single cell Li-Ion/Li-Polymer switching battery
> charger, a USB Type-C & Power Delivery (PD) controller, dual
> Flash LED current sources, a RGB LED driver, a backlight WLED driver,
> a display bias driver and a general LDO for portable devices.
>
> In MediaTek MT6370, there are four channel current-sink RGB LEDs that
> support hardware pattern for constant current, PWM, and breath mode.
> Isink4 channel can also be used as a CHG_VIN power good indicator.
>
> Signed-off-by: ChiYuan Huang <[email protected]>
> ---
> drivers/leds/Kconfig | 14 +
> drivers/leds/Makefile | 1 +
> drivers/leds/leds-mt6370.c | 994 +++++++++++++++++++++++++++++++++++++++++++++
> 3 files changed, 1009 insertions(+)
> create mode 100644 drivers/leds/leds-mt6370.c
>
> diff --git a/drivers/leds/Kconfig b/drivers/leds/Kconfig
> index a49979f..71bacb5 100644
> --- a/drivers/leds/Kconfig
> +++ b/drivers/leds/Kconfig
> @@ -244,6 +244,20 @@ config LEDS_MT6323
> This option enables support for on-chip LED drivers found on
> Mediatek MT6323 PMIC.
>
> +config LEDS_MT6370_RGB
> + tristate "LED Support for MediaTek MT6370 PMIC"
> + depends on LEDS_CLASS
> + depends on MFD_MT6370
> + select LINEAR_RANGE
> + help
> + Say Y here to enable support for MT6370_RGB LED device.
> + In MT6370, there are four channel current-sink LED drivers that
> + support hardware pattern for constant current, PWM, and breath mode.
> + Isink4 channel can also be used as a CHG_VIN power good indicator.
> +
> + This driver can also be built as a module. If so the module
> + will be called "leds-mt6370.ko".
> +
> 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 4fd2f92..557be42 100644
> --- a/drivers/leds/Makefile
> +++ b/drivers/leds/Makefile
> @@ -62,6 +62,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_MT6370_RGB) += leds-mt6370.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-mt6370.c b/drivers/leds/leds-mt6370.c
> new file mode 100644
> index 0000000..1038232
> --- /dev/null
> +++ b/drivers/leds/leds-mt6370.c
> @@ -0,0 +1,994 @@
> +// SPDX-License-Identifier: GPL-2.0-only
> +/*
> + * Copyright (C) 2022 Richtek Technology Corp.
> + *
> + * Author: Alice Chen <[email protected]>
> + */
> +
> +#include <linux/bitops.h>
> +#include <linux/kernel.h>
> +#include <linux/led-class-multicolor.h>
> +#include <linux/linear_range.h>
> +#include <linux/mod_devicetable.h>
> +#include <linux/module.h>
> +#include <linux/mutex.h>
> +#include <linux/platform_device.h>
> +#include <linux/property.h>
> +#include <linux/regmap.h>
> +
> +enum {
> + MT6370_LED_ISNK1 = 0,
> + MT6370_LED_ISNK2,
> + MT6370_LED_ISNK3,
> + MT6370_LED_ISNK4,
> + MT6370_MAX_LEDS
> +};
> +
> +enum mt6370_led_mode {
> + MT6370_LED_PWM_MODE = 0,
> + MT6370_LED_BREATH_MODE,
> + MT6370_LED_REG_MODE,
> + MT6370_LED_MAX_MODE
> +};
> +
> +enum mt6370_led_field {
> + F_RGB_EN = 0,
> + F_CHGIND_EN,
> + F_LED1_CURR,
> + F_LED2_CURR,
> + F_LED3_CURR,
> + F_LED4_CURR,
> + F_LED1_MODE,
> + F_LED2_MODE,
> + F_LED3_MODE,
> + F_LED4_MODE,
> + F_LED1_DUTY,
> + F_LED2_DUTY,
> + F_LED3_DUTY,
> + F_LED4_DUTY,
> + F_LED1_FREQ,
> + F_LED2_FREQ,
> + F_LED3_FREQ,
> + F_LED4_FREQ,
> + F_MAX_FIELDS
> +};
> +
> +enum mt6370_led_ranges {
> + R_LED123_CURR = 0,
> + R_LED4_CURR,
> + R_LED_TRFON,
> + R_LED_TOFF,
> + R_MAX_RANGES,
> +};
> +
> +enum mt6370_pattern {
> + P_LED_TR1 = 0,
> + P_LED_TR2,
> + P_LED_TF1,
> + P_LED_TF2,
> + P_LED_TON,
> + P_LED_TOFF,
> + P_MAX_PATTERNS
> +};
> +
> +#define MT6370_REG_DEV_INFO 0x100
> +#define MT6370_REG_RGB1_DIM 0x182
> +#define MT6370_REG_RGB2_DIM 0x183
> +#define MT6370_REG_RGB3_DIM 0x184
> +#define MT6370_REG_RGB_EN 0x185
> +#define MT6370_REG_RGB1_ISNK 0x186
> +#define MT6370_REG_RGB2_ISNK 0x187
> +#define MT6370_REG_RGB3_ISNK 0x188
> +#define MT6370_REG_RGB1_TR 0x189
> +#define MT6370_REG_RGB_CHRIND_DIM 0x192
> +#define MT6370_REG_RGB_CHRIND_CTRL 0x193
> +#define MT6370_REG_RGB_CHRIND_TR 0x194
> +
> +#define MT6372_REG_RGB_EN 0x182
> +#define MT6372_REG_RGB1_ISNK 0x183
> +#define MT6372_REG_RGB2_ISNK 0x184
> +#define MT6372_REG_RGB3_ISNK 0x185
> +#define MT6372_REG_RGB4_ISNK 0x186
> +#define MT6372_REG_RGB1_DIM 0x187
> +#define MT6372_REG_RGB2_DIM 0x188
> +#define MT6372_REG_RGB3_DIM 0x189
> +#define MT6372_REG_RGB4_DIM 0x18A
> +#define MT6372_REG_RGB12_FREQ 0x18B
> +#define MT6372_REG_RGB34_FREQ 0x18C
> +#define MT6372_REG_RGB1_TR 0x18D
> +
> +#define MT6370_VENID_MASK GENMASK(7, 4)
> +#define MT6370_CHEN_BIT(id) BIT(MT6370_LED_ISNK4 - id)
> +#define MT6370_VIRTUAL_MULTICOLOR 5
> +#define MC_CHANNEL_NUM 3
> +#define MT6370_PWM_DUTY 31
> +#define MT6372_PMW_DUTY 255
Please fix this typo: PMW -> PWM
> +
> +#define STATE_OFF 0
> +#define STATE_KEEP 1
> +#define STATE_ON 2
I propose, instead:
enum mt6370_state {
STATE_OFF = 0,
STATE_KEEP,
STATE_ON,
STATE_MAX,
};
> +
> +struct mt6370_led {
> + union {
> + struct led_classdev isink;
> + struct led_classdev_mc mc;
> + };
> + struct mt6370_priv *priv;
> + u32 default_state;
> + u32 index;
> +};
> +
> +struct mt6370_priv {
> + /* Per LED access lock */
> + struct mutex lock;
> + struct device *dev;
> + struct regmap *regmap;
> + struct regmap_field *fields[F_MAX_FIELDS];
> + const struct reg_field *reg_fields;
> + const struct linear_range *ranges;
> + struct reg_cfg *reg_cfgs;
> + unsigned int leds_count;
> + unsigned int leds_active;
> + bool is_mt6372;
Instead of using a bool for that, you can enhance the flexibility of
this driver (and also somewhat reduce cpu cycles) by using:
struct mt6370_pdata *pdata;
where a good definition of that structure would be...
struct mt6370_pdata {
const unsigned int *tfreq;
unsigned int tfreq_len;
u8 pwm_duty;
u8 reg_rgb1_tr;
/*
* You can set this one to -1 on MT6372 to indicate that
* this register does not exist (hence use that in function
* mt6370_get_breath_reg_base() to replace priv->is_mt6372)
*/
s16 reg_rgb_chrind_tr;
};
> + struct mt6370_led leds[];
> +};
> +
> +static const struct reg_field common_reg_fields[F_MAX_FIELDS] = {
> + [F_RGB_EN] = REG_FIELD(MT6370_REG_RGB_EN, 4, 7),
> + [F_CHGIND_EN] = REG_FIELD(MT6370_REG_RGB_CHRIND_DIM, 7, 7),
> + [F_LED1_CURR] = REG_FIELD(MT6370_REG_RGB1_ISNK, 0, 2),
> + [F_LED2_CURR] = REG_FIELD(MT6370_REG_RGB2_ISNK, 0, 2),
> + [F_LED3_CURR] = REG_FIELD(MT6370_REG_RGB3_ISNK, 0, 2),
> + [F_LED4_CURR] = REG_FIELD(MT6370_REG_RGB_CHRIND_CTRL, 0, 1),
> + [F_LED1_MODE] = REG_FIELD(MT6370_REG_RGB1_DIM, 5, 6),
> + [F_LED2_MODE] = REG_FIELD(MT6370_REG_RGB2_DIM, 5, 6),
> + [F_LED3_MODE] = REG_FIELD(MT6370_REG_RGB3_DIM, 5, 6),
> + [F_LED4_MODE] = REG_FIELD(MT6370_REG_RGB_CHRIND_DIM, 5, 6),
> + [F_LED1_DUTY] = REG_FIELD(MT6370_REG_RGB1_DIM, 0, 4),
> + [F_LED2_DUTY] = REG_FIELD(MT6370_REG_RGB2_DIM, 0, 4),
> + [F_LED3_DUTY] = REG_FIELD(MT6370_REG_RGB3_DIM, 0, 4),
> + [F_LED4_DUTY] = REG_FIELD(MT6370_REG_RGB_CHRIND_DIM, 0, 4),
> + [F_LED1_FREQ] = REG_FIELD(MT6370_REG_RGB1_ISNK, 3, 5),
> + [F_LED2_FREQ] = REG_FIELD(MT6370_REG_RGB2_ISNK, 3, 5),
> + [F_LED3_FREQ] = REG_FIELD(MT6370_REG_RGB3_ISNK, 3, 5),
> + [F_LED4_FREQ] = REG_FIELD(MT6370_REG_RGB_CHRIND_CTRL, 2, 4)
> +};
> +
> +static const struct reg_field mt6372_reg_fields[F_MAX_FIELDS] = {
> + [F_RGB_EN] = REG_FIELD(MT6372_REG_RGB_EN, 4, 7),
> + [F_CHGIND_EN] = REG_FIELD(MT6372_REG_RGB_EN, 3, 3),
> + [F_LED1_CURR] = REG_FIELD(MT6372_REG_RGB1_ISNK, 0, 3),
> + [F_LED2_CURR] = REG_FIELD(MT6372_REG_RGB2_ISNK, 0, 3),
> + [F_LED3_CURR] = REG_FIELD(MT6372_REG_RGB3_ISNK, 0, 3),
> + [F_LED4_CURR] = REG_FIELD(MT6372_REG_RGB4_ISNK, 0, 3),
> + [F_LED1_MODE] = REG_FIELD(MT6372_REG_RGB1_ISNK, 6, 7),
> + [F_LED2_MODE] = REG_FIELD(MT6372_REG_RGB2_ISNK, 6, 7),
> + [F_LED3_MODE] = REG_FIELD(MT6372_REG_RGB3_ISNK, 6, 7),
> + [F_LED4_MODE] = REG_FIELD(MT6372_REG_RGB4_ISNK, 6, 7),
> + [F_LED1_DUTY] = REG_FIELD(MT6372_REG_RGB1_DIM, 0, 7),
> + [F_LED2_DUTY] = REG_FIELD(MT6372_REG_RGB2_DIM, 0, 7),
> + [F_LED3_DUTY] = REG_FIELD(MT6372_REG_RGB3_DIM, 0, 7),
> + [F_LED4_DUTY] = REG_FIELD(MT6372_REG_RGB4_DIM, 0, 7),
> + [F_LED1_FREQ] = REG_FIELD(MT6372_REG_RGB12_FREQ, 5, 7),
> + [F_LED2_FREQ] = REG_FIELD(MT6372_REG_RGB12_FREQ, 2, 4),
> + [F_LED3_FREQ] = REG_FIELD(MT6372_REG_RGB34_FREQ, 5, 7),
> + [F_LED4_FREQ] = REG_FIELD(MT6372_REG_RGB34_FREQ, 2, 4)
> +};
> +
> +/* Current unit: microamp, time unit: millisecond */
> +static const struct linear_range common_led_ranges[R_MAX_RANGES] = {
> + [R_LED123_CURR] = { 4000, 1, 6, 4000 },
> + [R_LED4_CURR] = { 2000, 1, 3, 2000 },
> + [R_LED_TRFON] = { 125, 0, 15, 200 },
> + [R_LED_TOFF] = { 250, 0, 15, 400 }
> +};
> +
> +static const struct linear_range mt6372_led_ranges[R_MAX_RANGES] = {
> + [R_LED123_CURR] = { 2000, 1, 14, 2000 },
> + [R_LED4_CURR] = { 2000, 1, 14, 2000 },
> + [R_LED_TRFON] = { 125, 0, 15, 250 },
> + [R_LED_TOFF] = { 250, 0, 15, 500 }
> +};
> +
> +static enum mt6370_led_field mt6370_get_led_current_field(unsigned int led_no)
> +{
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + return F_LED1_CURR;
> + case MT6370_LED_ISNK2:
> + return F_LED2_CURR;
> + case MT6370_LED_ISNK3:
> + return F_LED3_CURR;
> + default:
> + return F_LED4_CURR;
> + }
> +}
> +
> +static int mt6370_set_led_brightness(struct mt6370_priv *priv,
> + unsigned int led_no, unsigned int level)
> +{
> + enum mt6370_led_field sel_field;
> +
> + sel_field = mt6370_get_led_current_field(led_no);
> +
> + return regmap_field_write(priv->fields[sel_field], level);
> +}
> +
> +static int mt6370_get_led_brightness(struct mt6370_priv *priv,
> + unsigned int led_no, unsigned int *level)
> +{
> + enum mt6370_led_field sel_field;
> +
> + sel_field = mt6370_get_led_current_field(led_no);
> +
> + return regmap_field_read(priv->fields[sel_field], level);
> +}
> +
> +static int mt6370_set_led_duty(struct mt6370_priv *priv, unsigned int led_no,
> + unsigned int ton, unsigned int toff)
> +{
> + enum mt6370_led_field sel_field;
> + unsigned int divisor, ratio;
> +
> + divisor = priv->is_mt6372 ? MT6372_PMW_DUTY : MT6370_PWM_DUTY;
> + ratio = ton * divisor / (ton + toff);
> +
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + sel_field = F_LED1_DUTY;
> + break;
> + case MT6370_LED_ISNK2:
> + sel_field = F_LED2_DUTY;
> + break;
> + case MT6370_LED_ISNK3:
> + sel_field = F_LED3_DUTY;
> + break;
> + default:
> + sel_field = F_LED4_DUTY;
> + }
> +
> + return regmap_field_write(priv->fields[sel_field], ratio);
> +}
> +
> +static const unsigned int common_tfreqs[] = {
> + 10000, 5000, 2000, 1000, 500, 200, 5, 1,
> +};
> +
> +static const unsigned int mt6372_tfreqs[] = {
> + 8000, 4000, 2000, 1000, 500, 250, 8, 4,
> +};
> +
> +static int mt6370_set_led_freq(struct mt6370_priv *priv, unsigned int led_no,
> + unsigned int ton, unsigned int toff)
> +{
> + enum mt6370_led_field sel_field;
> + const unsigned int *tfreq;
> + unsigned int tfreq_len, tsum;
> + int i;
> +
...so, if you have pdata, here you'll do:
struct mt6370_pdata *pdata = priv->pdata;
> + if (priv->is_mt6372) {
> + tfreq = mt6372_tfreqs;
> + tfreq_len = ARRAY_SIZE(mt6372_tfreqs);
> + } else {
> + tfreq = common_tfreqs;
> + tfreq_len = ARRAY_SIZE(common_tfreqs);
> + }
> +
> + tsum = ton + toff;
> +
> + if (tsum > tfreq[0] || tsum < tfreq[tfreq_len - 1])
if (tsum > pdata->tfreq[0] || tsum < pdata->tfreq[pdata->tfreq_len - 1])
( etc etc etc )
> + return -EOPNOTSUPP;
> +
> + for (i = 0; i < tfreq_len; i++) {
> + if (tsum >= tfreq[i])
> + break;
> + }
> +
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + sel_field = F_LED1_FREQ;
> + break;
> + case MT6370_LED_ISNK2:
> + sel_field = F_LED2_FREQ;
> + break;
> + case MT6370_LED_ISNK3:
> + sel_field = F_LED3_FREQ;
> + break;
> + default:
> + sel_field = F_LED4_FREQ;
> + }
> +
> + return regmap_field_write(priv->fields[sel_field], i);
> +}
> +
> +static void mt6370_get_breath_reg_base(struct mt6370_priv *priv,
> + unsigned int led_no, unsigned int *base)
> +{
if (pdata->reg_rgb_chrind_tr < 0) {
*base = pdata->reg_rgb1_tr + led_no * 3;
return;
}
> + if (priv->is_mt6372) {
> + *base = MT6372_REG_RGB1_TR + led_no * 3;
> + return;
> + }
> +
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + case MT6370_LED_ISNK2:
> + case MT6370_LED_ISNK3:
> + *base = MT6370_REG_RGB1_TR + led_no * 3;
> + break;
> + default:
> + *base = MT6370_REG_RGB_CHRIND_TR;
> + }
> +}
> +
> +static int mt6370_gen_breath_pattern(struct mt6370_priv *priv,
> + struct led_pattern *pattern, u32 len,
> + u8 *pattern_val, u32 val_len)
> +{
> + enum mt6370_led_ranges sel_range;
> + struct led_pattern *curr;
> + unsigned int sel;
> + u8 val[P_MAX_PATTERNS / 2] = {0};
> + int i;
> +
> + if (len < P_MAX_PATTERNS && val_len < P_MAX_PATTERNS / 2)
> + return -EINVAL;
> +
> + /*
> + * Pattern list
> + * tr1: byte 0, b'[7: 4]
> + * tr2: byte 0, b'[3: 0]
> + * tf1: byte 1, b'[7: 4]
> + * tf2: byte 1, b'[3: 0]
> + * ton: byte 2, b'[7: 4]
> + * toff: byte 2, b'[3: 0]
> + */
> + for (i = 0; i < P_MAX_PATTERNS; i++) {
> + curr = pattern + i;
> +
> + sel_range = i == P_LED_TOFF ? R_LED_TOFF : R_LED_TRFON;
> +
> + linear_range_get_selector_within(priv->ranges + sel_range,
> + curr->delta_t, &sel);
> +
> + val[i / 2] |= sel << (4 * ((i + 1) % 2));
> + }
> +
> + memcpy(pattern_val, val, 3);
> + return 0;
> +}
> +
> +static int mt6370_set_led_mode(struct mt6370_priv *priv, unsigned int led_no,
> + enum mt6370_led_mode mode)
> +{
> + enum mt6370_led_field sel_field;
> +
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + sel_field = F_LED1_MODE;
> + break;
> + case MT6370_LED_ISNK2:
> + sel_field = F_LED2_MODE;
> + break;
> + case MT6370_LED_ISNK3:
> + sel_field = F_LED3_MODE;
> + break;
> + default:
> + sel_field = F_LED4_MODE;
> + }
> +
> + return regmap_field_write(priv->fields[sel_field], mode);
> +}
> +
> +static int mt6370_mc_brightness_set(struct led_classdev *lcdev,
> + enum led_brightness level)
> +{
> + struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
> + struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
> + struct mt6370_priv *priv = led->priv;
> + struct mc_subled *subled;
> + unsigned int enable, disable;
> + int i, ret;
> +
> + mutex_lock(&priv->lock);
> +
> + led_mc_calc_color_components(mccdev, level);
> +
> + ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
> + if (ret)
> + goto out;
> +
> + disable = enable;
> +
> + for (i = 0; i < mccdev->num_colors; i++) {
> + u32 brightness;
> +
> + subled = mccdev->subled_info + i;
> + brightness = min(subled->brightness, lcdev->max_brightness);
> + disable &= ~MT6370_CHEN_BIT(subled->channel);
> +
> + if (level == LED_OFF) {
> + enable &= ~MT6370_CHEN_BIT(subled->channel);
> +
> + ret = mt6370_set_led_mode(priv, subled->channel,
> + MT6370_LED_REG_MODE);
> + if (ret)
> + goto out;
> +
> + continue;
> + }
> +
> + if (brightness == LED_OFF) {
> + enable &= ~MT6370_CHEN_BIT(subled->channel);
> + continue;
> + }
> +
> + enable |= MT6370_CHEN_BIT(subled->channel);
> +
> + ret = mt6370_set_led_brightness(priv, subled->channel,
> + brightness);
> + if (ret)
> + goto out;
> + }
> +
> + ret = regmap_field_write(priv->fields[F_RGB_EN], disable);
> + if (ret)
> + goto out;
> +
> + ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
> +
> +out:
> + mutex_unlock(&priv->lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_mc_blink_set(struct led_classdev *lcdev,
> + unsigned long *delay_on,
> + unsigned long *delay_off)
> +{
> + struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
> + struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
> + struct mt6370_priv *priv = led->priv;
> + struct mc_subled *subled;
> + unsigned int enable, disable;
> + int i, ret;
> +
> + mutex_lock(&priv->lock);
> +
> + if (!*delay_on && !*delay_off)
> + *delay_on = *delay_off = 500;
> +
> + ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
> + if (ret)
> + goto out;
> +
> + disable = enable;
> +
> + for (i = 0; i < mccdev->num_colors; i++) {
> + subled = mccdev->subled_info + i;
> +
> + disable &= ~MT6370_CHEN_BIT(subled->channel);
> +
> + ret = mt6370_set_led_duty(priv, subled->channel, *delay_on,
> + *delay_off);
> + if (ret)
> + goto out;
> +
> + ret = mt6370_set_led_freq(priv, subled->channel, *delay_on,
> + *delay_off);
> + if (ret)
> + goto out;
> +
> + ret = mt6370_set_led_mode(priv, subled->channel,
> + MT6370_LED_PWM_MODE);
> + if (ret)
> + goto out;
> + }
> +
> + /* Toggle to make pattern timing the same */
> + ret = regmap_field_write(priv->fields[F_RGB_EN], disable);
> + if (ret)
> + goto out;
> +
> + ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
> +
> +out:
> + mutex_unlock(&priv->lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_mc_pattern_set(struct led_classdev *lcdev,
> + struct led_pattern *pattern, u32 len, int repeat)
> +{
> + struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
> + struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
> + struct mt6370_priv *priv = led->priv;
> + struct mc_subled *subled;
> + unsigned int reg_base, enable, disable;
> + u8 params[P_MAX_PATTERNS / 2];
> + int i, ret;
> +
> + mutex_lock(&priv->lock);
> +
> + ret = mt6370_gen_breath_pattern(priv, pattern, len, params,
> + sizeof(params));
> + if (ret)
> + goto out;
> +
> + ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
> + if (ret)
> + goto out;
> +
> + disable = enable;
> +
> + for (i = 0; i < mccdev->num_colors; i++) {
> + subled = mccdev->subled_info + i;
> +
> + mt6370_get_breath_reg_base(priv, subled->channel, ®_base);
> + disable &= ~MT6370_CHEN_BIT(subled->channel);
> +
> + ret = regmap_raw_write(priv->regmap, reg_base, params,
> + sizeof(params));
> + if (ret)
> + goto out;
> +
> + ret = mt6370_set_led_mode(priv, subled->channel,
> + MT6370_LED_BREATH_MODE);
> + if (ret)
> + goto out;
> + }
> +
> + /* Toggle to make pattern timing be the same */
> + ret = regmap_field_write(priv->fields[F_RGB_EN], disable);
> + if (ret)
> + goto out;
> +
> + ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
> +
> +out:
> + mutex_unlock(&priv->lock);
> +
> + return ret;
> +}
> +
> +static inline int mt6370_mc_pattern_clear(struct led_classdev *lcdev)
> +{
> + struct led_classdev_mc *mccdev = lcdev_to_mccdev(lcdev);
> + struct mt6370_led *led = container_of(mccdev, struct mt6370_led, mc);
> + struct mt6370_priv *priv = led->priv;
> + struct mc_subled *subled;
> + int i, ret = 0;
> +
> + mutex_lock(&led->priv->lock);
> +
> + for (i = 0; i < mccdev->num_colors; i++) {
> + subled = mccdev->subled_info + i;
> +
> + ret = mt6370_set_led_mode(priv, subled->channel,
> + MT6370_LED_REG_MODE);
> + if (ret)
> + break;
> + }
> +
> + mutex_unlock(&led->priv->lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_isnk_brightness_set(struct led_classdev *lcdev,
> + enum led_brightness level)
> +{
> + struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
> + struct mt6370_priv *priv = led->priv;
> + unsigned int enable;
> + int ret;
> +
> + mutex_lock(&priv->lock);
> +
> + ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
> + if (ret)
> + goto out;
> +
> + if (level == LED_OFF) {
> + enable &= ~MT6370_CHEN_BIT(led->index);
> +
> + ret = mt6370_set_led_mode(priv, led->index,
> + MT6370_LED_REG_MODE);
> + if (ret)
> + goto out;
> +
> + ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
> + } else {
> + enable |= MT6370_CHEN_BIT(led->index);
> +
> + ret = mt6370_set_led_brightness(priv, led->index, level);
> + if (ret)
> + goto out;
> +
> + ret = regmap_field_write(priv->fields[F_RGB_EN], enable);
> + }
> +
> +out:
> + mutex_unlock(&priv->lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_isnk_blink_set(struct led_classdev *lcdev,
> + unsigned long *delay_on,
> + unsigned long *delay_off)
> +{
> + struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
> + struct mt6370_priv *priv = led->priv;
> + int ret;
> +
> + mutex_lock(&priv->lock);
> +
> + if (!*delay_on && !*delay_off)
> + *delay_on = *delay_off = 500;
> +
> + ret = mt6370_set_led_duty(priv, led->index, *delay_on, *delay_off);
> + if (ret)
> + goto out;
> +
> + ret = mt6370_set_led_freq(priv, led->index, *delay_on, *delay_off);
> + if (ret)
> + goto out;
> +
> + ret = mt6370_set_led_mode(priv, led->index, MT6370_LED_PWM_MODE);
> +
> +out:
> + mutex_unlock(&priv->lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_isnk_pattern_set(struct led_classdev *lcdev,
> + struct led_pattern *pattern, u32 len,
> + int repeat)
> +{
> + struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
> + struct mt6370_priv *priv = led->priv;
> + unsigned int reg_base;
> + u8 params[P_MAX_PATTERNS / 2];
> + int ret;
> +
> + mutex_lock(&priv->lock);
> +
> + ret = mt6370_gen_breath_pattern(priv, pattern, len, params,
> + sizeof(params));
> + if (ret)
> + goto out;
> +
> + mt6370_get_breath_reg_base(priv, led->index, ®_base);
> +
> + ret = regmap_raw_write(priv->regmap, reg_base, params, sizeof(params));
> + if (ret)
> + goto out;
> +
> + ret = mt6370_set_led_mode(priv, led->index, MT6370_LED_BREATH_MODE);
> +
> +out:
> + mutex_unlock(&priv->lock);
> +
> + return ret;
> +}
> +
> +static inline int mt6370_isnk_pattern_clear(struct led_classdev *lcdev)
> +{
> + struct mt6370_led *led = container_of(lcdev, struct mt6370_led, isink);
> + struct mt6370_priv *priv = led->priv;
> + int ret;
> +
> + mutex_lock(&led->priv->lock);
> + ret = mt6370_set_led_mode(priv, led->index, MT6370_LED_REG_MODE);
> + mutex_unlock(&led->priv->lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_init_led_properties(struct mt6370_led *led,
> + struct led_init_data *init_data)
> +{
> + struct mt6370_priv *priv = led->priv;
> + struct led_classdev *lcdev;
> + struct fwnode_handle *child;
> + enum mt6370_led_ranges sel_range;
> + u32 max_uA, max_level;
> + const char * const states[] = { "off", "keep", "on" };
> + const char *stat_str;
> + int ret;
> +
> + if (led->index == MT6370_VIRTUAL_MULTICOLOR) {
> + struct mc_subled *sub_led;
> + u32 num_color = 0;
> +
> + sub_led = devm_kzalloc(priv->dev,
> + sizeof(*sub_led) * MC_CHANNEL_NUM,
> + GFP_KERNEL);
> + if (!sub_led)
> + return -ENOMEM;
> +
> + fwnode_for_each_child_node(init_data->fwnode, child) {
> + u32 reg, color;
> +
> + ret = fwnode_property_read_u32(child, "reg", ®);
> + if (ret || reg > MT6370_LED_ISNK3 ||
> + priv->leds_active & BIT(reg))
> + return -EINVAL;
> +
> + ret = fwnode_property_read_u32(child, "color", &color);
> + if (ret) {
> + dev_err(priv->dev,
> + "led %d, no color specified\n",
> + led->index);
> + return ret;
> + }
> +
> + priv->leds_active |= BIT(reg);
> + sub_led[num_color].color_index = color;
> + sub_led[num_color].channel = reg;
> + num_color++;
> + }
> +
> + if (num_color < 2) {
> + dev_err(priv->dev,
> + "Multicolor must include 2 or more led channel\n");
> + return -EINVAL;
> + }
> +
> + led->mc.num_colors = num_color;
> + led->mc.subled_info = sub_led;
> +
> + lcdev = &led->mc.led_cdev;
> + lcdev->brightness_set_blocking = mt6370_mc_brightness_set;
> + lcdev->blink_set = mt6370_mc_blink_set;
> + lcdev->pattern_set = mt6370_mc_pattern_set;
> + lcdev->pattern_clear = mt6370_mc_pattern_clear;
> + } else {
> + lcdev = &led->isink;
> + lcdev->brightness_set_blocking = mt6370_isnk_brightness_set;
> + lcdev->blink_set = mt6370_isnk_blink_set;
> + lcdev->pattern_set = mt6370_isnk_pattern_set;
> + lcdev->pattern_clear = mt6370_isnk_pattern_clear;
> + }
> +
> + ret = fwnode_property_read_u32(init_data->fwnode, "led-max-microamp",
> + &max_uA);
> + if (ret) {
> + dev_warn(priv->dev,
> + "Not specified led-max-microamp, config to the minimum\n");
> + max_uA = 0;
> + }
> +
> + if (led->index == MT6370_LED_ISNK4)
> + sel_range = R_LED4_CURR;
> + else
> + sel_range = R_LED123_CURR;
> +
> + linear_range_get_selector_within(priv->ranges + sel_range, max_uA,
> + &max_level);
> +
> + lcdev->max_brightness = max_level;
> +
> + fwnode_property_read_string(init_data->fwnode, "linux,default-trigger",
> + &lcdev->default_trigger);
> +
> + if (!fwnode_property_read_string(init_data->fwnode, "default-state",
> + &stat_str)) {
> + ret = match_string(states, ARRAY_SIZE(states), stat_str);
> + if (ret < 0)
> + ret = STATE_OFF;
> +
> + led->default_state = ret;
> + }
> +
> + return 0;
> +}
> +
> +static int mt6370_isnk_init_default_state(struct mt6370_led *led)
> +{
> + struct mt6370_priv *priv = led->priv;
> + unsigned int enable, level;
> + int ret;
> +
> + ret = mt6370_get_led_brightness(priv, led->index, &level);
> + if (ret)
> + return ret;
> +
> + ret = regmap_field_read(priv->fields[F_RGB_EN], &enable);
> + if (ret)
> + return ret;
> +
> + if (!(enable & MT6370_CHEN_BIT(led->index)))
> + level = LED_OFF;
> +
> + switch (led->default_state) {
> + case STATE_ON:
> + led->isink.brightness = led->isink.max_brightness;
> + break;
> + case STATE_KEEP:
> + led->isink.brightness = min(level, led->isink.max_brightness);
> + break;
> + default:
> + led->isink.brightness = LED_OFF;
> + }
> +
> + return mt6370_isnk_brightness_set(&led->isink, led->isink.brightness);
> +}
> +
> +static int mt6370_led_register(struct device *parent, struct mt6370_led *led,
> + struct led_init_data *init_data)
> +{
> + struct mt6370_priv *priv = led->priv;
> + int ret;
> +
> + if (led->index == MT6370_VIRTUAL_MULTICOLOR) {
> + ret = mt6370_mc_brightness_set(&led->mc.led_cdev, LED_OFF);
> + if (ret) {
> + dev_err(parent, "Couldn't set multicolor brightness\n");
> + return ret;
> + }
> +
> + ret = devm_led_classdev_multicolor_register_ext(parent,
> + &led->mc,
> + init_data);
> + if (ret) {
> + dev_err(parent, "Couldn't register multicolor\n");
> + return ret;
> + }
> + } else {
> + if (led->index == MT6370_LED_ISNK4) {
> + ret = regmap_field_write(priv->fields[F_CHGIND_EN], 1);
> + if (ret) {
> + dev_err(parent, "Failed to set CHRIND to SW\n");
> + return ret;
> + }
> + }
> +
> + ret = mt6370_isnk_init_default_state(led);
> + if (ret) {
> + dev_err(parent, "Failed to init %d isnk state\n",
> + led->index);
> + return ret;
> + }
> +
> + ret = devm_led_classdev_register_ext(parent, &led->isink,
> + init_data);
> + if (ret) {
> + dev_err(parent, "Couldn't register isink %d\n",
> + led->index);
> + return ret;
> + }
> + }
> +
> + return 0;
> +}
> +
> +static int mt6370_check_vendor_info(struct mt6370_priv *priv)
> +{
> + unsigned int devinfo, vid;
> + int ret;
> +
> + ret = regmap_read(priv->regmap, MT6370_REG_DEV_INFO, &devinfo);
> + if (ret)
> + return ret;
> +
> + vid = FIELD_GET(MT6370_VENID_MASK, devinfo);
> + if (vid == 0x9 || vid == 0xb) {
> + priv->reg_fields = mt6372_reg_fields;
> + priv->ranges = mt6372_led_ranges;
> + priv->is_mt6372 = true;
priv->pdata = &mt6372_pdata;
> + } else {
> + priv->reg_fields = common_reg_fields;
> + priv->ranges = common_led_ranges;
priv->pdata = &mt6370_pdata;
> + }
> +
> + return 0;
> +}
Regards,
Angelo
On Fri, Jul 15, 2022 at 2:40 PM AngeloGioacchino Del Regno
<[email protected]> wrote:
> Il 15/07/22 13:26, ChiaEn Wu ha scritto:
...
> > +#define STATE_OFF 0
> > +#define STATE_KEEP 1
> > +#define STATE_ON 2
>
> I propose, instead:
>
> enum mt6370_state {
> STATE_OFF = 0,
> STATE_KEEP,
> STATE_ON,
> STATE_MAX,
Usually we don't put commas at the terminator entries.
> };
--
With Best Regards,
Andy Shevchenko
On Fri, Jul 15, 2022 at 1:29 PM ChiaEn Wu <[email protected]> wrote:
>
> From: ChiaEn Wu <[email protected]>
>
> MediaTek MT6370 is a SubPMIC consisting of a single cell battery charger
> with ADC monitoring, RGB LEDs, dual channel flashlight, WLED backlight
> driver, display bias voltage supply, one general purpose LDO, and the
> USB Type-C & PD controller complies with the latest USB Type-C and PD
> standards.
>
> This adds MediaTek MT6370 Charger driver support. The charger module
> of MT6370 supports High-Accuracy Voltage/Current Regulation,
> Average Input Current Regulation, Battery Temperature Sensing,
> Over-Temperature Protection, DPDM Detection for BC1.2.
...
> +static int mt6370_chg_probe(struct platform_device *pdev)
> +{
> + int ret;
> + struct mt6370_priv *priv;
> +
> + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
> + if (!priv)
> + return -ENOMEM;
> +
> + priv->dev = &pdev->dev;
> +
> + priv->regmap = dev_get_regmap(pdev->dev.parent, NULL);
> + if (!priv->regmap)
> + return dev_err_probe(&pdev->dev, -ENODEV,
> + "Failed to get regmap\n");
> +
> + ret = mt6370_chg_init_rmap_fields(priv);
> + if (ret)
> + return dev_err_probe(&pdev->dev, ret,
> + "Failed to init regmap fields\n");
> +
> + platform_set_drvdata(pdev, priv);
> +
> + priv->iio_adcs = devm_iio_channel_get_all(priv->dev);
> + if (IS_ERR(priv->iio_adcs))
> + return dev_err_probe(&pdev->dev, PTR_ERR(priv->iio_adcs),
> + "Failed to get iio adc\n");
> +
> + ret = mt6370_chg_init_otg_regulator(priv);
> + if (ret)
> + return dev_err_probe(&pdev->dev, ret,
> + "Failed to init otg regulator\n");
> +
> + ret = mt6370_chg_init_psy(priv);
> + if (ret)
> + return dev_err_probe(&pdev->dev, ret, "Failed to init psy\n");
> +
> + mutex_init(&priv->attach_lock);
> + priv->attach = MT6370_ATTACH_STAT_DETACH;
> +
> + priv->wq = create_singlethread_workqueue(dev_name(priv->dev));
> + if (IS_ERR(priv->wq))
> + return dev_err_probe(priv->dev, PTR_ERR(priv->wq),
> + "Failed to create workqueue\n");
You need either wrap mutex to be deallocated by devm or don't use
dev_err_probe() here.
> + INIT_WORK(&priv->bc12_work, mt6370_chg_bc12_work_func);
> + INIT_DELAYED_WORK(&priv->mivr_dwork, mt6370_chg_mivr_dwork_func);
> +
> + ret = mt6370_chg_init_setting(priv);
> + if (ret) {
> + dev_err(&pdev->dev, "Failed to init mt6370 charger setting\n");
> + goto probe_out;
> + }
> +
> + ret = mt6370_chg_init_irq(priv);
> + if (ret)
> + goto probe_out;
> +
> + mt6370_chg_pwr_rdy_check(priv);
> +
> + return 0;
> +
> +probe_out:
> + cancel_delayed_work_sync(&priv->mivr_dwork);
> + flush_workqueue(priv->wq);
> + destroy_workqueue(priv->wq);
> + mutex_destroy(&priv->attach_lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_chg_remove(struct platform_device *pdev)
> +{
> + struct mt6370_priv *priv = platform_get_drvdata(pdev);
> +
> + cancel_delayed_work_sync(&priv->mivr_dwork);
> + flush_workqueue(priv->wq);
> + destroy_workqueue(priv->wq);
> + mutex_destroy(&priv->attach_lock);
> +
> + return 0;
> +}
--
With Best Regards,
Andy Shevchenko
On Fri, Jul 15, 2022 at 1:29 PM ChiaEn Wu <[email protected]> wrote:
>
> From: ChiYuan Huang <[email protected]>
>
> The MediaTek MT6370 is a highly-integrated smart power management IC,
> which includes a single cell Li-Ion/Li-Polymer switching battery
> charger, a USB Type-C & Power Delivery (PD) controller, dual
> Flash LED current sources, a RGB LED driver, a backlight WLED driver,
> a display bias driver and a general LDO for portable devices.
>
> In MediaTek MT6370, there are four channel current-sink RGB LEDs that
> support hardware pattern for constant current, PWM, and breath mode.
> Isink4 channel can also be used as a CHG_VIN power good indicator.
...
> + This driver can also be built as a module. If so the module
so, the
> + will be called "leds-mt6370.ko".
No ".ko".
Why did you ignore these comments? Please go and fix _everywhere_ in
your series.
It's basically the rule of thumb, if the reviewer gives a comment
against an occurrence of something, go through entire series and check
if there are other places like commented one and address them all.
...
> + * Author: Alice Chen <[email protected]>
Strange, the commit message doesn't have a corresponding SoB, why?
...
> +#define MT6370_PWM_DUTY 31
> +#define MT6372_PMW_DUTY 255
Looks like these are limits by hardware?
Check with the datasheet if (BIT(x) - 1) makes more sense here.
...
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + sel_field = F_LED1_DUTY;
> + break;
> + case MT6370_LED_ISNK2:
> + sel_field = F_LED2_DUTY;
> + break;
> + case MT6370_LED_ISNK3:
> + sel_field = F_LED3_DUTY;
> + break;
> + default:
> + sel_field = F_LED4_DUTY;
Missed break;
> + }
...
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + sel_field = F_LED1_FREQ;
> + break;
> + case MT6370_LED_ISNK2:
> + sel_field = F_LED2_FREQ;
> + break;
> + case MT6370_LED_ISNK3:
> + sel_field = F_LED3_FREQ;
> + break;
> + default:
> + sel_field = F_LED4_FREQ;
Ditto.
> + }
...
> + switch (led_no) {
> + case MT6370_LED_ISNK1:
> + case MT6370_LED_ISNK2:
> + case MT6370_LED_ISNK3:
> + *base = MT6370_REG_RGB1_TR + led_no * 3;
> + break;
> + default:
> + *base = MT6370_REG_RGB_CHRIND_TR;
Ditto.
It seems you dropped them for all switch-cases. It's not goot, please
restore them back.
> + }
...
> + u8 val[P_MAX_PATTERNS / 2] = {0};
{ } should suffice
> + /*
> + * Pattern list
> + * tr1: byte 0, b'[7: 4]
> + * tr2: byte 0, b'[3: 0]
> + * tf1: byte 1, b'[7: 4]
> + * tf2: byte 1, b'[3: 0]
> + * ton: byte 2, b'[7: 4]
> + * toff: byte 2, b'[3: 0]
> + */
> + for (i = 0; i < P_MAX_PATTERNS; i++) {
> + curr = pattern + i;
> +
> + sel_range = i == P_LED_TOFF ? R_LED_TOFF : R_LED_TRFON;
> +
> + linear_range_get_selector_within(priv->ranges + sel_range,
> + curr->delta_t, &sel);
> +
> + val[i / 2] |= sel << (4 * ((i + 1) % 2));
> + }
> +
> + memcpy(pattern_val, val, 3);
> + return 0;
> +}
...
> +out:
out_unlock:
> + mutex_unlock(&priv->lock);
> +
> + return ret;
...
> +out:
Ditto. And so on.
> + mutex_unlock(&priv->lock);
> +
> + return ret;
...
> + sub_led = devm_kzalloc(priv->dev,
> + sizeof(*sub_led) * MC_CHANNEL_NUM,
> + GFP_KERNEL);
NIH devm_kcalloc(). Also check if you really need zeroed data.
> + if (!sub_led)
> + return -ENOMEM;
...
> + ret = fwnode_property_read_u32(child, "color", &color);
> + if (ret) {
> + dev_err(priv->dev,
> + "led %d, no color specified\n",
> + led->index);
> + return ret;
return dev_err_probe(...) ; ?
Ditto for many places in your entire series.
> + }
...
> + priv = devm_kzalloc(&pdev->dev,
> + struct_size(priv, leds, count), GFP_KERNEL);
At least one parameter can be placed on the previous line.
> + if (!priv)
> + return -ENOMEM;
--
With Best Regards,
Andy Shevchenko
Hi,
On Fri, Jul 15, 2022 at 07:26:04PM +0800, ChiaEn Wu wrote:
> From: ChiaEn Wu <[email protected]>
>
> MediaTek MT6370 is a SubPMIC consisting of a single cell battery charger
> with ADC monitoring, RGB LEDs, dual channel flashlight, WLED backlight
> driver, display bias voltage supply, one general purpose LDO, and the
> USB Type-C & PD controller complies with the latest USB Type-C and PD
> standards.
>
> This adds MediaTek MT6370 Charger driver support. The charger module
> of MT6370 supports High-Accuracy Voltage/Current Regulation,
> Average Input Current Regulation, Battery Temperature Sensing,
> Over-Temperature Protection, DPDM Detection for BC1.2.
>
> Signed-off-by: ChiaEn Wu <[email protected]>
> ---
Please provide a dump from '/sys/class/power_supply/<charger-name>/uevent'
below the fold in the next revision. I would like to check that you
got the units right in the next submission (in this one they are
definetly not correct).
> v5
> - Replace unsigned int type of pwr_rdy with bool in
> mt6370_chg_set_online()
> - Remove redundant 'else' in mt6370_chg_field_get()
> - Revise 'if-else' in mt6370_chg_field_set()
> - Revise 'if' condition in mt6370_chg_enable_irq()
> - Revise all text 'otg' --> 'OTG'
> - Revise MT6370_MIVR_IBUS_TH_100_MA --> MT6370_MIVR_IBUS_TH_100_mA
> - Revise the description of Kconfig help text
> ---
> drivers/power/supply/Kconfig | 14 +
> drivers/power/supply/Makefile | 1 +
> drivers/power/supply/mt6370-charger.c | 1062 +++++++++++++++++++++++++++++++++
> 3 files changed, 1077 insertions(+)
> create mode 100644 drivers/power/supply/mt6370-charger.c
>
> diff --git a/drivers/power/supply/Kconfig b/drivers/power/supply/Kconfig
> index 1aa8323..591deb8 100644
> --- a/drivers/power/supply/Kconfig
> +++ b/drivers/power/supply/Kconfig
> @@ -619,6 +619,20 @@ config CHARGER_MT6360
> Average Input Current Regulation, Battery Temperature Sensing,
> Over-Temperature Protection, DPDM Detection for BC1.2.
>
> +config CHARGER_MT6370
> + tristate "MediaTek MT6370 Charger Driver"
> + depends on MFD_MT6370
> + depends on REGULATOR
> + select LINEAR_RANGES
> + help
> + Say Y here to enable MT6370 Charger Part.
> + The device supports High-Accuracy Voltage/Current Regulation,
> + Average Input Current Regulation, Battery Temperature Sensing,
> + Over-Temperature Protection, DPDM Detection for BC1.2.
> +
> + This driver can also be built as a module. If so, the module
> + will be called "mt6370-charger".
> +
> config CHARGER_QCOM_SMBB
> tristate "Qualcomm Switch-Mode Battery Charger and Boost"
> depends on MFD_SPMI_PMIC || COMPILE_TEST
> diff --git a/drivers/power/supply/Makefile b/drivers/power/supply/Makefile
> index 7f02f36..8c95276 100644
> --- a/drivers/power/supply/Makefile
> +++ b/drivers/power/supply/Makefile
> @@ -82,6 +82,7 @@ obj-$(CONFIG_CHARGER_MAX8997) += max8997_charger.o
> obj-$(CONFIG_CHARGER_MAX8998) += max8998_charger.o
> obj-$(CONFIG_CHARGER_MP2629) += mp2629_charger.o
> obj-$(CONFIG_CHARGER_MT6360) += mt6360_charger.o
> +obj-$(CONFIG_CHARGER_MT6370) += mt6370-charger.o
> obj-$(CONFIG_CHARGER_QCOM_SMBB) += qcom_smbb.o
> obj-$(CONFIG_CHARGER_BQ2415X) += bq2415x_charger.o
> obj-$(CONFIG_CHARGER_BQ24190) += bq24190_charger.o
> diff --git a/drivers/power/supply/mt6370-charger.c b/drivers/power/supply/mt6370-charger.c
> new file mode 100644
> index 0000000..76a8c91
> --- /dev/null
> +++ b/drivers/power/supply/mt6370-charger.c
> @@ -0,0 +1,1062 @@
> +// SPDX-License-Identifier: GPL-2.0-only
> +/*
> + * Copyright (C) 2022 Richtek Technology Corp.
> + *
> + * Author: ChiaEn Wu <[email protected]>
> + */
> +
> +#include <linux/bitfield.h>
> +#include <linux/bits.h>
> +#include <linux/gpio/consumer.h>
> +#include <linux/iio/consumer.h>
> +#include <linux/init.h>
> +#include <linux/interrupt.h>
> +#include <linux/kernel.h>
> +#include <linux/linear_range.h>
> +#include <linux/module.h>
> +#include <linux/of.h>
> +#include <linux/platform_device.h>
> +#include <linux/power_supply.h>
> +#include <linux/regmap.h>
> +#include <linux/regulator/driver.h>
> +#include <linux/workqueue.h>
> +
> +#define MT6370_REG_CHG_CTRL1 0x111
> +#define MT6370_REG_CHG_CTRL2 0x112
> +#define MT6370_REG_CHG_CTRL3 0x113
> +#define MT6370_REG_CHG_CTRL4 0x114
> +#define MT6370_REG_CHG_CTRL5 0x115
> +#define MT6370_REG_CHG_CTRL6 0x116
> +#define MT6370_REG_CHG_CTRL7 0x117
> +#define MT6370_REG_CHG_CTRL8 0x118
> +#define MT6370_REG_CHG_CTRL9 0x119
> +#define MT6370_REG_CHG_CTRL10 0x11A
> +#define MT6370_REG_DEVICE_TYPE 0x122
> +#define MT6370_REG_USB_STATUS1 0x127
> +#define MT6370_REG_CHG_STAT 0x14A
> +#define MT6370_REG_FLED_EN 0x17E
> +#define MT6370_REG_CHG_STAT1 0X1D0
> +#define MT6370_REG_OVPCTRL_STAT 0x1D8
> +
> +#define MT6370_VOBST_MASK GENMASK(7, 2)
> +#define MT6370_OTG_PIN_EN_MASK BIT(1)
> +#define MT6370_OPA_MODE_MASK BIT(0)
> +#define MT6370_OTG_OC_MASK GENMASK(2, 0)
> +
> +#define MT6370_MIVR_IBUS_TH_100_mA 100000
> +#define MT6370_ADC_CHAN_IBUS 5
> +#define MT6370_ADC_CHAN_MAX 9
> +
> +enum mt6370_chg_reg_field {
> + /* MT6370_REG_CHG_CTRL2 */
> + F_IINLMTSEL, F_CFO_EN, F_CHG_EN,
> + /* MT6370_REG_CHG_CTRL3 */
> + F_IAICR, F_AICR_EN, F_ILIM_EN,
> + /* MT6370_REG_CHG_CTRL4 */
> + F_VOREG,
> + /* MT6370_REG_CHG_CTRL6 */
> + F_VMIVR,
> + /* MT6370_REG_CHG_CTRL7 */
> + F_ICHG,
> + /* MT6370_REG_CHG_CTRL8 */
> + F_IPREC,
> + /* MT6370_REG_CHG_CTRL9 */
> + F_IEOC,
> + /* MT6370_REG_DEVICE_TYPE */
> + F_USBCHGEN,
> + /* MT6370_REG_USB_STATUS1 */
> + F_USB_STAT, F_CHGDET,
> + /* MT6370_REG_CHG_STAT */
> + F_CHG_STAT, F_BOOST_STAT, F_VBAT_LVL,
> + /* MT6370_REG_FLED_EN */
> + F_FL_STROBE,
> + /* MT6370_REG_CHG_STAT1 */
> + F_CHG_MIVR_STAT,
> + /* MT6370_REG_OVPCTRL_STAT */
> + F_UVP_D_STAT,
> + F_MAX
> +};
> +
> +struct mt6370_priv {
> + struct device *dev;
> + struct iio_channel *iio_adcs;
> + struct mutex attach_lock;
> + struct power_supply *psy;
> + struct power_supply_desc *psy_desc;
> + struct regmap *regmap;
> + struct regmap_field *rmap_fields[F_MAX];
> + struct regulator_dev *rdev;
> + struct workqueue_struct *wq;
> + struct work_struct bc12_work;
> + struct delayed_work mivr_dwork;
> + int attach;
> + int psy_usb_type;
> + bool pwr_rdy;
> +};
> +
> +enum mt6370_usb_status {
> + MT6370_USB_STAT_NO_VBUS = 0,
> + MT6370_USB_STAT_VBUS_FLOW_IS_UNDER_GOING,
> + MT6370_USB_STAT_SDP,
> + MT6370_USB_STAT_SDP_NSTD,
> + MT6370_USB_STAT_DCP,
> + MT6370_USB_STAT_CDP,
> + MT6370_USB_STAT_MAX
> +};
> +
> +struct mt6370_chg_field {
> + const char *name;
> + const struct linear_range *range;
> + struct reg_field field;
> +};
> +
> +enum {
> + MT6370_RANGE_F_IAICR = 0,
> + MT6370_RANGE_F_VOREG,
> + MT6370_RANGE_F_VMIVR,
> + MT6370_RANGE_F_ICHG,
> + MT6370_RANGE_F_IPREC,
> + MT6370_RANGE_F_IEOC,
> + MT6370_RANGE_F_MAX
> +};
> +
> +#define MT6370_CHG_LINEAR_RANGE(_rfd, _min, _min_sel, _max_sel, _step) \
> +[_rfd] = { \
> + .min = _min, \
> + .min_sel = _min_sel, \
> + .max_sel = _max_sel, \
> + .step = _step, \
> +}
> +
> +/* unit: mA or mV */
> +static const struct linear_range mt6370_chg_ranges[MT6370_RANGE_F_MAX] = {
> + MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_IAICR, 100, 0x0, 0x3F, 50),
> + MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_VOREG, 3900, 0x0, 0x51, 10),
> + MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_VMIVR, 3900, 0x0, 0x5F, 100),
> + MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_ICHG, 900, 0x08, 0x31, 100),
> + MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_IPREC, 100, 0x0, 0x0F, 50),
> + MT6370_CHG_LINEAR_RANGE(MT6370_RANGE_F_IEOC, 100, 0x0, 0x0F, 50),
> +};
> +
> +#define MT6370_CHG_FIELD(_fd, _reg, _lsb, _msb) \
> +[_fd] = { \
> + .name = #_fd, \
> + .range = NULL, \
> + .field = REG_FIELD(_reg, _lsb, _msb), \
> +}
> +
> +#define MT6370_CHG_FIELD_RANGE(_fd, _reg, _lsb, _msb) \
> +[_fd] = { \
> + .name = #_fd, \
> + .range = &mt6370_chg_ranges[MT6370_RANGE_##_fd], \
> + .field = REG_FIELD(_reg, _lsb, _msb), \
> +}
> +
> +static const struct mt6370_chg_field mt6370_chg_fields[F_MAX] = {
> + MT6370_CHG_FIELD(F_IINLMTSEL, MT6370_REG_CHG_CTRL2, 2, 3),
> + MT6370_CHG_FIELD(F_CFO_EN, MT6370_REG_CHG_CTRL2, 1, 1),
> + MT6370_CHG_FIELD(F_CHG_EN, MT6370_REG_CHG_CTRL2, 0, 0),
> + MT6370_CHG_FIELD_RANGE(F_IAICR, MT6370_REG_CHG_CTRL3, 2, 7),
> + MT6370_CHG_FIELD(F_AICR_EN, MT6370_REG_CHG_CTRL3, 1, 1),
> + MT6370_CHG_FIELD(F_ILIM_EN, MT6370_REG_CHG_CTRL3, 0, 0),
> + MT6370_CHG_FIELD_RANGE(F_VOREG, MT6370_REG_CHG_CTRL4, 1, 7),
> + MT6370_CHG_FIELD_RANGE(F_VMIVR, MT6370_REG_CHG_CTRL6, 1, 7),
> + MT6370_CHG_FIELD_RANGE(F_ICHG, MT6370_REG_CHG_CTRL7, 2, 7),
> + MT6370_CHG_FIELD_RANGE(F_IPREC, MT6370_REG_CHG_CTRL8, 0, 3),
> + MT6370_CHG_FIELD_RANGE(F_IEOC, MT6370_REG_CHG_CTRL9, 4, 7),
> + MT6370_CHG_FIELD(F_USBCHGEN, MT6370_REG_DEVICE_TYPE, 7, 7),
> + MT6370_CHG_FIELD(F_USB_STAT, MT6370_REG_USB_STATUS1, 4, 6),
> + MT6370_CHG_FIELD(F_CHGDET, MT6370_REG_USB_STATUS1, 3, 3),
> + MT6370_CHG_FIELD(F_CHG_STAT, MT6370_REG_CHG_STAT, 6, 7),
> + MT6370_CHG_FIELD(F_BOOST_STAT, MT6370_REG_CHG_STAT, 3, 3),
> + MT6370_CHG_FIELD(F_VBAT_LVL, MT6370_REG_CHG_STAT, 5, 5),
> + MT6370_CHG_FIELD(F_FL_STROBE, MT6370_REG_FLED_EN, 2, 2),
> + MT6370_CHG_FIELD(F_CHG_MIVR_STAT, MT6370_REG_CHG_STAT1, 6, 6),
> + MT6370_CHG_FIELD(F_UVP_D_STAT, MT6370_REG_OVPCTRL_STAT, 4, 4),
> +};
> +
> +static inline int mt6370_chg_field_get(struct mt6370_priv *priv,
> + enum mt6370_chg_reg_field fd,
> + unsigned int *val)
> +{
> + int ret;
> + unsigned int reg_val;
> +
> + ret = regmap_field_read(priv->rmap_fields[fd], ®_val);
> + if (ret < 0)
> + return ret;
> +
> + if (mt6370_chg_fields[fd].range)
> + return linear_range_get_value(mt6370_chg_fields[fd].range,
> + reg_val, val);
> +
> + *val = reg_val;
> + return 0;
> +}
> +
> +static inline int mt6370_chg_field_set(struct mt6370_priv *priv,
> + enum mt6370_chg_reg_field fd,
> + unsigned int val)
> +{
> + int ret;
> + bool f;
> + const struct linear_range *r;
> +
> + if (mt6370_chg_fields[fd].range) {
> + r = mt6370_chg_fields[fd].range;
> +
> + if (fd == F_VMIVR) {
> + ret = linear_range_get_selector_high(r, val, &val, &f);
> + if (!ret)
> + val = r->max_sel;
> + } else {
> + linear_range_get_selector_within(r, val, &val);
> + }
> + }
> +
> + return regmap_field_write(priv->rmap_fields[fd], val);
> +}
> +
> +enum {
> + MT6370_CHG_STAT_READY = 0,
> + MT6370_CHG_STAT_CHARGE_IN_PROGRESS,
> + MT6370_CHG_STAT_DONE,
> + MT6370_CHG_STAT_FAULT,
> + MT6370_CHG_STAT_MAX
> +};
> +
> +enum {
> + MT6370_ATTACH_STAT_DETACH = 0,
> + MT6370_ATTACH_STAT_ATTACH_BC12_NOT_DONE,
> + MT6370_ATTACH_STAT_ATTACH_BC12_DONE,
> + MT6370_ATTACH_STAT_ATTACH_MAX
> +};
> +
> +static int mt6370_chg_otg_of_parse_cb(struct device_node *of,
> + const struct regulator_desc *rdesc,
> + struct regulator_config *rcfg)
> +{
> + struct mt6370_priv *priv = rcfg->driver_data;
> +
> + rcfg->ena_gpiod = fwnode_gpiod_get_index(of_fwnode_handle(of),
> + "enable", 0, GPIOD_OUT_LOW |
> + GPIOD_FLAGS_BIT_NONEXCLUSIVE,
> + rdesc->name);
> + if (IS_ERR(rcfg->ena_gpiod)) {
> + rcfg->ena_gpiod = NULL;
> + return 0;
> + }
> +
> + return regmap_update_bits(priv->regmap, MT6370_REG_CHG_CTRL1,
> + MT6370_OTG_PIN_EN_MASK,
> + MT6370_OTG_PIN_EN_MASK);
> +}
> +
> +static void mt6370_chg_bc12_work_func(struct work_struct *work)
> +{
> + struct mt6370_priv *priv = container_of(work, struct mt6370_priv,
> + bc12_work);
> + int ret;
> + bool rpt_psy = false;
> + unsigned int attach, usb_stat;
> +
> + mutex_lock(&priv->attach_lock);
> + attach = priv->attach;
> +
> + switch (attach) {
> + case MT6370_ATTACH_STAT_DETACH:
> + usb_stat = 0;
> + break;
> + case MT6370_ATTACH_STAT_ATTACH_BC12_DONE:
> + ret = mt6370_chg_field_get(priv, F_USB_STAT, &usb_stat);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to get USB status\n");
> + goto bc12_work_func_out;
> + }
> + break;
> + case MT6370_ATTACH_STAT_ATTACH_BC12_NOT_DONE:
> + ret = mt6370_chg_field_set(priv, F_USBCHGEN, attach);
> + if (ret < 0)
> + dev_err(priv->dev, "Failed to enable USB CHG EN\n");
> + goto bc12_work_func_out;
> + default:
> + dev_err(priv->dev, "Invalid attach state\n");
> + goto bc12_work_func_out;
> + }
> +
> + rpt_psy = true;
> +
> + switch (usb_stat) {
> + case MT6370_USB_STAT_SDP:
> + priv->psy_desc->type = POWER_SUPPLY_TYPE_USB;
> + priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_SDP;
> + break;
> + case MT6370_USB_STAT_SDP_NSTD:
> + priv->psy_desc->type = POWER_SUPPLY_TYPE_USB;
> + priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_DCP;
> + break;
> + case MT6370_USB_STAT_DCP:
> + priv->psy_desc->type = POWER_SUPPLY_TYPE_USB_DCP;
> + priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_DCP;
> + break;
> + case MT6370_USB_STAT_CDP:
> + priv->psy_desc->type = POWER_SUPPLY_TYPE_USB_CDP;
> + priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_CDP;
> + break;
> + case MT6370_USB_STAT_NO_VBUS:
> + case MT6370_USB_STAT_VBUS_FLOW_IS_UNDER_GOING:
> + default:
> + priv->psy_desc->type = POWER_SUPPLY_TYPE_USB;
> + priv->psy_usb_type = POWER_SUPPLY_USB_TYPE_UNKNOWN;
> + break;
> + }
Please don't change psy_desc->type. POWER_SUPPLY_TYPE_USB_DCP and
POWER_SUPPLY_TYPE_USB_CDP are deprecated and should not be used
in new code. Just use constant POWER_SUPPLY_TYPE_USB and expose
the details via the 'new' POWER_SUPPLY_PROP_USB_TYPE property
(as you are already doing).
> +bc12_work_func_out:
> + mutex_unlock(&priv->attach_lock);
> +
> + if (rpt_psy)
> + power_supply_changed(priv->psy);
> +}
> +
> +static inline void mt6370_chg_enable_irq(struct mt6370_priv *priv,
> + const char *irq_name, bool en)
> +{
> + int irq_num;
> + struct platform_device *pdev = to_platform_device(priv->dev);
> +
> + irq_num = platform_get_irq_byname(pdev, irq_name);
> + if (irq_num < 0)
> + return;
> +
> + if (en)
> + enable_irq(irq_num);
> + else
> + disable_irq_nosync(irq_num);
> +}
> +
> +static int mt6370_chg_toggle_cfo(struct mt6370_priv *priv)
> +{
> + int ret;
> + unsigned int fl_strobe;
> +
> + /* check if flash led in strobe mode */
> + ret = mt6370_chg_field_get(priv, F_FL_STROBE, &fl_strobe);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to get FL_STROBE_EN\n");
> + return ret;
> + }
> +
> + if (fl_strobe) {
> + dev_err(priv->dev, "Flash led is still in strobe mode\n");
> + return ret;
> + }
> +
> + /* cfo off */
> + ret = mt6370_chg_field_set(priv, F_CFO_EN, 0);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to disable CFO_EN\n");
> + return ret;
> + }
> +
> + /* cfo on */
> + ret = mt6370_chg_field_set(priv, F_CFO_EN, 1);
> + if (ret < 0)
> + dev_err(priv->dev, "Failed to enable CFO_EN\n");
> +
> + return ret;
> +}
> +
> +static int mt6370_chg_read_adc_chan(struct mt6370_priv *priv, unsigned int chan,
> + int *val)
> +{
> + int ret;
> +
> + if (chan >= MT6370_ADC_CHAN_MAX)
> + return -EINVAL;
> +
> + ret = iio_read_channel_processed(&priv->iio_adcs[chan], val);
> + if (ret)
> + dev_err(priv->dev, "Failed to read ADC\n");
> +
> + return ret;
> +}
> +
> +static void mt6370_chg_mivr_dwork_func(struct work_struct *work)
> +{
> + struct mt6370_priv *priv = container_of(work, struct mt6370_priv,
> + mivr_dwork.work);
> + int ret;
> + unsigned int mivr_stat, ibus;
> +
> + ret = mt6370_chg_field_get(priv, F_CHG_MIVR_STAT, &mivr_stat);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to get mivr state\n");
> + goto mivr_handler_out;
> + }
> +
> + if (!mivr_stat)
> + goto mivr_handler_out;
> +
> + ret = mt6370_chg_read_adc_chan(priv, MT6370_ADC_CHAN_IBUS, &ibus);
> + if (ret) {
> + dev_err(priv->dev, "Failed to get ibus\n");
> + goto mivr_handler_out;
> + }
> +
> + if (ibus < MT6370_MIVR_IBUS_TH_100_mA) {
> + ret = mt6370_chg_toggle_cfo(priv);
> + if (ret)
> + dev_err(priv->dev, "Failed to toggle cfo\n");
> + }
> +
> +mivr_handler_out:
> + mt6370_chg_enable_irq(priv, "mivr", true);
> + pm_relax(priv->dev);
> +}
> +
> +static void mt6370_chg_pwr_rdy_check(struct mt6370_priv *priv)
> +{
> + int ret;
> + unsigned int pwr_rdy, otg_en;
> + union power_supply_propval val;
> +
> + /* Check in OTG mode or not */
> + ret = mt6370_chg_field_get(priv, F_BOOST_STAT, &otg_en);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to get OTG state\n");
> + return;
> + }
> +
> + if (otg_en)
> + return;
> +
> + ret = mt6370_chg_field_get(priv, F_UVP_D_STAT, &pwr_rdy);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to get pwr_rdy state reg\n");
> + return;
> + }
> +
> + val.intval = !pwr_rdy;
> +
> + ret = power_supply_set_property(priv->psy, POWER_SUPPLY_PROP_ONLINE,
> + &val);
> + if (ret < 0)
> + dev_err(priv->dev, "Failed to start attach/detach flow\n");
> +}
> +
> +static int mt6370_chg_get_online(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + mutex_lock(&priv->attach_lock);
> + val->intval = !!priv->attach;
> + mutex_unlock(&priv->attach_lock);
> +
> + return 0;
> +}
> +
> +static int mt6370_chg_get_status(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + int ret;
> + unsigned int chg_stat;
> + union power_supply_propval online;
> +
> + ret = power_supply_get_property(priv->psy, POWER_SUPPLY_PROP_ONLINE,
> + &online);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to get online status\n");
> + return ret;
> + }
> +
> + if (!online.intval) {
> + val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
> + return 0;
> + }
> +
> + ret = mt6370_chg_field_get(priv, F_CHG_STAT, &chg_stat);
> + if (ret < 0)
> + return ret;
> +
> + switch (chg_stat) {
> + case MT6370_CHG_STAT_READY:
> + case MT6370_CHG_STAT_FAULT:
> + val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
> + return ret;
> + case MT6370_CHG_STAT_CHARGE_IN_PROGRESS:
> + val->intval = POWER_SUPPLY_STATUS_CHARGING;
> + return ret;
> + case MT6370_CHG_STAT_DONE:
> + val->intval = POWER_SUPPLY_STATUS_FULL;
> + return ret;
> + default:
> + val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
> + return ret;
> + }
> +}
> +
> +static int mt6370_chg_get_charge_type(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + int type, ret;
> + unsigned int chg_stat, vbat_lvl;
> +
> + ret = mt6370_chg_field_get(priv, F_CHG_STAT, &chg_stat);
> + if (ret < 0)
> + return ret;
> +
> + ret = mt6370_chg_field_get(priv, F_VBAT_LVL, &vbat_lvl);
> + if (ret < 0)
> + return ret;
> +
> + switch (chg_stat) {
> + case MT6370_CHG_STAT_CHARGE_IN_PROGRESS:
> + if (vbat_lvl)
> + type = POWER_SUPPLY_CHARGE_TYPE_FAST;
> + else
> + type = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
> + break;
> + case MT6370_CHG_STAT_READY:
> + case MT6370_CHG_STAT_DONE:
> + case MT6370_CHG_STAT_FAULT:
> + default:
> + type = POWER_SUPPLY_CHARGE_TYPE_NONE;
> + break;
> + }
> +
> + val->intval = type;
> +
> + return 0;
> +}
> +
> +static int mt6370_chg_get_ichg(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + return mt6370_chg_field_get(priv, F_ICHG, &val->intval);
> +}
> +
> +static int mt6370_chg_get_max_ichg(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + val->intval = linear_range_get_max_value(
> + &mt6370_chg_ranges[MT6370_RANGE_F_ICHG]);
> + return 0;
> +}
> +
> +static int mt6370_chg_get_cv(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + return mt6370_chg_field_get(priv, F_VOREG, &val->intval);
> +}
> +
> +static int mt6370_chg_get_max_cv(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + val->intval = linear_range_get_max_value(
> + &mt6370_chg_ranges[MT6370_RANGE_F_VOREG]);
> + return 0;
> +}
> +
> +static int mt6370_chg_get_aicr(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + return mt6370_chg_field_get(priv, F_IAICR, &val->intval);
> +}
> +
> +static int mt6370_chg_get_mivr(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + return mt6370_chg_field_get(priv, F_VMIVR, &val->intval);
> +}
> +
> +static int mt6370_chg_get_iprechg(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + return mt6370_chg_field_get(priv, F_IPREC, &val->intval);
> +}
> +
> +static int mt6370_chg_get_ieoc(struct mt6370_priv *priv,
> + union power_supply_propval *val)
> +{
> + return mt6370_chg_field_get(priv, F_IEOC, &val->intval);
> +}
> +
> +static int mt6370_chg_set_online(struct mt6370_priv *priv,
> + const union power_supply_propval *val)
> +{
> + bool pwr_rdy = !!val->intval;
> +
> + mutex_lock(&priv->attach_lock);
> + if (pwr_rdy == !!priv->attach) {
> + dev_err(priv->dev, "pwr_rdy is same(%d)\n", pwr_rdy);
> + mutex_unlock(&priv->attach_lock);
> + return 0;
> + }
> +
> + priv->attach = pwr_rdy;
> + mutex_unlock(&priv->attach_lock);
> +
> + if (!queue_work(priv->wq, &priv->bc12_work))
> + dev_err(priv->dev, "bc12 work has already queued\n");
> +
> + return 0;
> +}
> +
> +static int mt6370_chg_set_ichg(struct mt6370_priv *priv,
> + const union power_supply_propval *val)
> +{
> + return mt6370_chg_field_set(priv, F_ICHG, val->intval);
> +}
You are directly feeding sysfs value into F_ICHG register,
but the register is in mA accordering to the setup code.
The power-supply ABI is in uA and uV, see
Documentation/ABI/testing/sysfs-class-power
> +static int mt6370_chg_set_cv(struct mt6370_priv *priv,
> + const union power_supply_propval *val)
> +{
> + return mt6370_chg_field_set(priv, F_VOREG, val->intval);
> +}
> +
> +static int mt6370_chg_set_aicr(struct mt6370_priv *priv,
> + const union power_supply_propval *val)
> +{
> + return mt6370_chg_field_set(priv, F_IAICR, val->intval);
> +}
> +
> +static int mt6370_chg_set_mivr(struct mt6370_priv *priv,
> + const union power_supply_propval *val)
> +{
> + return mt6370_chg_field_set(priv, F_VMIVR, val->intval);
> +}
> +
> +static int mt6370_chg_set_iprechg(struct mt6370_priv *priv,
> + const union power_supply_propval *val)
> +{
> + return mt6370_chg_field_set(priv, F_IPREC, val->intval);
> +}
> +
> +static int mt6370_chg_set_ieoc(struct mt6370_priv *priv,
> + const union power_supply_propval *val)
> +{
> + return mt6370_chg_field_set(priv, F_IEOC, val->intval);
> +}
All these one line functions are pretty pointless, you can just
call mt6370_chg_field_set directly.
> +static int mt6370_chg_get_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + union power_supply_propval *val)
> +{
> + struct mt6370_priv *priv = power_supply_get_drvdata(psy);
> +
> + switch (psp) {
> + case POWER_SUPPLY_PROP_ONLINE:
> + return mt6370_chg_get_online(priv, val);
> + case POWER_SUPPLY_PROP_STATUS:
> + return mt6370_chg_get_status(priv, val);
> + case POWER_SUPPLY_PROP_CHARGE_TYPE:
> + return mt6370_chg_get_charge_type(priv, val);
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + return mt6370_chg_get_ichg(priv, val);
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
> + return mt6370_chg_get_max_ichg(priv, val);
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + return mt6370_chg_get_cv(priv, val);
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
> + return mt6370_chg_get_max_cv(priv, val);
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + return mt6370_chg_get_aicr(priv, val);
> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
> + return mt6370_chg_get_mivr(priv, val);
> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
> + return mt6370_chg_get_iprechg(priv, val);
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + return mt6370_chg_get_ieoc(priv, val);
> + case POWER_SUPPLY_PROP_TYPE:
> + val->intval = priv->psy_desc->type;
> + return 0;
> + case POWER_SUPPLY_PROP_USB_TYPE:
> + val->intval = priv->psy_usb_type;
> + return 0;
> + default:
> + return -EINVAL;
> + }
> +}
> +
> +static int mt6370_chg_set_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + const union power_supply_propval *val)
> +{
> + struct mt6370_priv *priv = power_supply_get_drvdata(psy);
> +
> + switch (psp) {
> + case POWER_SUPPLY_PROP_ONLINE:
> + return mt6370_chg_set_online(priv, val);
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + return mt6370_chg_set_ichg(priv, val);
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + return mt6370_chg_set_cv(priv, val);
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + return mt6370_chg_set_aicr(priv, val);
> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
> + return mt6370_chg_set_mivr(priv, val);
> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
> + return mt6370_chg_set_iprechg(priv, val);
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + return mt6370_chg_set_ieoc(priv, val);
> + default:
> + return -EINVAL;
> + }
> +}
> +
> +static int mt6370_chg_property_is_writeable(struct power_supply *psy,
> + enum power_supply_property psp)
> +{
> + switch (psp) {
> + case POWER_SUPPLY_PROP_ONLINE:
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + return 1;
> + default:
> + return 0;
> + }
> +}
> +
> +static enum power_supply_property mt6370_chg_properties[] = {
> + POWER_SUPPLY_PROP_ONLINE,
> + POWER_SUPPLY_PROP_STATUS,
> + POWER_SUPPLY_PROP_CHARGE_TYPE,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
> + POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
> + POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT,
> + POWER_SUPPLY_PROP_PRECHARGE_CURRENT,
> + POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT,
> + POWER_SUPPLY_PROP_TYPE,
> + POWER_SUPPLY_PROP_USB_TYPE,
> +};
> +
> +static enum power_supply_usb_type mt6370_chg_usb_types[] = {
> + POWER_SUPPLY_USB_TYPE_UNKNOWN,
> + POWER_SUPPLY_USB_TYPE_SDP,
> + POWER_SUPPLY_USB_TYPE_CDP,
> + POWER_SUPPLY_USB_TYPE_DCP,
> +};
> +
> +static struct power_supply_desc mt6370_chg_psy_desc = {
After fixing the code writing to the .type field use 'static const'.
> + .type = POWER_SUPPLY_TYPE_USB,
> + .properties = mt6370_chg_properties,
> + .num_properties = ARRAY_SIZE(mt6370_chg_properties),
> + .get_property = mt6370_chg_get_property,
> + .set_property = mt6370_chg_set_property,
> + .property_is_writeable = mt6370_chg_property_is_writeable,
> + .usb_types = mt6370_chg_usb_types,
> + .num_usb_types = ARRAY_SIZE(mt6370_chg_usb_types),
> +};
> +
> +static const struct regulator_ops mt6370_chg_otg_ops = {
> + .list_voltage = regulator_list_voltage_linear,
> + .enable = regulator_enable_regmap,
> + .disable = regulator_disable_regmap,
> + .is_enabled = regulator_is_enabled_regmap,
> + .set_voltage_sel = regulator_set_voltage_sel_regmap,
> + .get_voltage_sel = regulator_get_voltage_sel_regmap,
> + .set_current_limit = regulator_set_current_limit_regmap,
> + .get_current_limit = regulator_get_current_limit_regmap,
> +};
> +
> +static const u32 mt6370_chg_otg_oc_ma[] = {
> + 500000, 700000, 1100000, 1300000, 1800000, 2100000, 2400000,
> +};
> +
> +static const struct regulator_desc mt6370_chg_otg_rdesc = {
> + .of_match = "usb-otg-vbus-regulator",
> + .of_parse_cb = mt6370_chg_otg_of_parse_cb,
> + .name = "mt6370-usb-otg-vbus",
> + .ops = &mt6370_chg_otg_ops,
> + .owner = THIS_MODULE,
> + .type = REGULATOR_VOLTAGE,
> + .min_uV = 4425000,
> + .uV_step = 25000,
> + .n_voltages = 57,
> + .vsel_reg = MT6370_REG_CHG_CTRL5,
> + .vsel_mask = MT6370_VOBST_MASK,
> + .enable_reg = MT6370_REG_CHG_CTRL1,
> + .enable_mask = MT6370_OPA_MODE_MASK,
> + .curr_table = mt6370_chg_otg_oc_ma,
> + .n_current_limits = ARRAY_SIZE(mt6370_chg_otg_oc_ma),
> + .csel_reg = MT6370_REG_CHG_CTRL10,
> + .csel_mask = MT6370_OTG_OC_MASK,
> +};
> +
> +static int mt6370_chg_init_rmap_fields(struct mt6370_priv *priv)
> +{
> + int i;
> + const struct mt6370_chg_field *fds = mt6370_chg_fields;
> +
> + for (i = 0; i < F_MAX; i++) {
> + priv->rmap_fields[i] = devm_regmap_field_alloc(priv->dev,
> + priv->regmap,
> + fds[i].field);
> + if (IS_ERR(priv->rmap_fields[i]))
> + return dev_err_probe(priv->dev,
> + PTR_ERR(priv->rmap_fields[i]),
> + "Failed to allocate regmapfield[%s]\n",
> + fds[i].name);
> + }
> +
> + return 0;
> +}
> +
> +static int mt6370_chg_init_setting(struct mt6370_priv *priv)
> +{
> + int ret;
> +
> + /* Disable usb_chg_en */
> + ret = mt6370_chg_field_set(priv, F_USBCHGEN, 0);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to disable usb_chg_en\n");
> + return ret;
> + }
> +
> + /* ICHG/IEOC Workaround, ICHG can not be set less than 900mA */
> + ret = mt6370_chg_field_set(priv, F_ICHG, 900);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to set ICHG to 900mA");
> + return ret;
> + }
> +
> + /* Change input current limit selection to using IAICR results */
> + ret = mt6370_chg_field_set(priv, F_IINLMTSEL, 3);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to set IINLMTSEL\n");
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +#define MT6370_CHG_DT_PROP_DECL(_name, _type, _field) \
> +{ \
> + .name = "mediatek,chg-" #_name, \
> + .type = MT6370_PARSE_TYPE_##_type, \
> + .fd = _field, \
> +}
> +
> +static int mt6370_chg_init_otg_regulator(struct mt6370_priv *priv)
> +{
> + struct regulator_config rcfg = {
> + .dev = priv->dev,
> + .regmap = priv->regmap,
> + .driver_data = priv,
> + };
> +
> + priv->rdev = devm_regulator_register(priv->dev, &mt6370_chg_otg_rdesc,
> + &rcfg);
> +
> + return PTR_ERR_OR_ZERO(priv->rdev);
> +}
> +
> +static int mt6370_chg_init_psy(struct mt6370_priv *priv)
> +{
> + struct power_supply_config cfg = {
> + .drv_data = priv,
> + .of_node = dev_of_node(priv->dev),
> + };
> +
> + priv->psy_desc = &mt6370_chg_psy_desc;
> + priv->psy_desc->name = dev_name(priv->dev);
> + priv->psy = devm_power_supply_register(priv->dev, priv->psy_desc, &cfg);
> +
> + return PTR_ERR_OR_ZERO(priv->psy);
> +}
> +
> +static irqreturn_t mt6370_attach_i_handler(int irq, void *data)
> +{
> + struct mt6370_priv *priv = data;
> + unsigned int otg_en;
> + int ret;
> +
> + /* Check in otg mode or not */
> + ret = mt6370_chg_field_get(priv, F_BOOST_STAT, &otg_en);
> + if (ret < 0) {
> + dev_err(priv->dev, "Failed to get otg state\n");
> + return IRQ_NONE;
> + }
> +
> + if (otg_en)
> + return IRQ_HANDLED;
> +
> + mutex_lock(&priv->attach_lock);
> + priv->attach = MT6370_ATTACH_STAT_ATTACH_BC12_DONE;
> + mutex_unlock(&priv->attach_lock);
> +
> + if (!queue_work(priv->wq, &priv->bc12_work))
> + dev_err(priv->dev, "bc12 work has already queued\n");
> +
> + return IRQ_HANDLED;
> +}
> +
> +static irqreturn_t mt6370_uvp_d_evt_handler(int irq, void *data)
> +{
> + struct mt6370_priv *priv = data;
> +
> + mt6370_chg_pwr_rdy_check(priv);
> +
> + return IRQ_HANDLED;
> +}
> +
> +static irqreturn_t mt6370_mivr_handler(int irq, void *data)
> +{
> + struct mt6370_priv *priv = data;
> +
> + pm_stay_awake(priv->dev);
> + mt6370_chg_enable_irq(priv, "mivr", false);
> + schedule_delayed_work(&priv->mivr_dwork, msecs_to_jiffies(200));
> +
> + return IRQ_HANDLED;
> +}
> +
> +#define MT6370_CHG_IRQ(_name) \
> +{ \
> + .name = #_name, \
> + .handler = mt6370_##_name##_handler, \
> +}
> +
> +static int mt6370_chg_init_irq(struct mt6370_priv *priv)
> +{
> + int i, ret;
> + const struct {
> + char *name;
> + irq_handler_t handler;
> + } mt6370_chg_irqs[] = {
> + MT6370_CHG_IRQ(attach_i),
> + MT6370_CHG_IRQ(uvp_d_evt),
> + MT6370_CHG_IRQ(mivr),
> + };
> +
> + for (i = 0; i < ARRAY_SIZE(mt6370_chg_irqs); i++) {
> + ret = platform_get_irq_byname(to_platform_device(priv->dev),
> + mt6370_chg_irqs[i].name);
> + if (ret < 0)
> + return dev_err_probe(priv->dev, ret,
> + "Failed to get irq %s\n",
> + mt6370_chg_irqs[i].name);
> +
> + ret = devm_request_threaded_irq(priv->dev, ret, NULL,
> + mt6370_chg_irqs[i].handler,
> + IRQF_TRIGGER_FALLING,
> + dev_name(priv->dev),
> + priv);
> +
> + if (ret < 0)
> + return dev_err_probe(priv->dev, ret,
> + "Failed to request irq %s\n",
> + mt6370_chg_irqs[i].name);
> + }
> +
> + return 0;
> +}
> +
> +static int mt6370_chg_probe(struct platform_device *pdev)
> +{
> + int ret;
> + struct mt6370_priv *priv;
> +
> + priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
> + if (!priv)
> + return -ENOMEM;
> +
> + priv->dev = &pdev->dev;
> +
> + priv->regmap = dev_get_regmap(pdev->dev.parent, NULL);
> + if (!priv->regmap)
> + return dev_err_probe(&pdev->dev, -ENODEV,
> + "Failed to get regmap\n");
> +
> + ret = mt6370_chg_init_rmap_fields(priv);
> + if (ret)
> + return dev_err_probe(&pdev->dev, ret,
> + "Failed to init regmap fields\n");
> +
> + platform_set_drvdata(pdev, priv);
> +
> + priv->iio_adcs = devm_iio_channel_get_all(priv->dev);
> + if (IS_ERR(priv->iio_adcs))
> + return dev_err_probe(&pdev->dev, PTR_ERR(priv->iio_adcs),
> + "Failed to get iio adc\n");
> +
> + ret = mt6370_chg_init_otg_regulator(priv);
> + if (ret)
> + return dev_err_probe(&pdev->dev, ret,
> + "Failed to init otg regulator\n");
> +
> + ret = mt6370_chg_init_psy(priv);
> + if (ret)
> + return dev_err_probe(&pdev->dev, ret, "Failed to init psy\n");
> +
> + mutex_init(&priv->attach_lock);
> + priv->attach = MT6370_ATTACH_STAT_DETACH;
> +
> + priv->wq = create_singlethread_workqueue(dev_name(priv->dev));
> + if (IS_ERR(priv->wq))
> + return dev_err_probe(priv->dev, PTR_ERR(priv->wq),
> + "Failed to create workqueue\n");
> +
> + INIT_WORK(&priv->bc12_work, mt6370_chg_bc12_work_func);
> + INIT_DELAYED_WORK(&priv->mivr_dwork, mt6370_chg_mivr_dwork_func);
> +
> + ret = mt6370_chg_init_setting(priv);
> + if (ret) {
> + dev_err(&pdev->dev, "Failed to init mt6370 charger setting\n");
> + goto probe_out;
> + }
> +
> + ret = mt6370_chg_init_irq(priv);
> + if (ret)
> + goto probe_out;
Please don't allocate resource using devm_ infrastructure after
manual allocation. This will use incorrect order during driver
removal (interrupts will be released too late). Either interrupts
need to be managed manually, or you need to use
devm_add_action() for handling of the workqueue/delayed_work/mutex.
> +
> + mt6370_chg_pwr_rdy_check(priv);
> +
> + return 0;
> +
> +probe_out:
> + cancel_delayed_work_sync(&priv->mivr_dwork);
> + flush_workqueue(priv->wq);
> + destroy_workqueue(priv->wq);
> + mutex_destroy(&priv->attach_lock);
> +
> + return ret;
> +}
> +
> +static int mt6370_chg_remove(struct platform_device *pdev)
> +{
> + struct mt6370_priv *priv = platform_get_drvdata(pdev);
> +
> + cancel_delayed_work_sync(&priv->mivr_dwork);
> + flush_workqueue(priv->wq);
> + destroy_workqueue(priv->wq);
> + mutex_destroy(&priv->attach_lock);
> +
> + return 0;
> +}
> +
> +static const struct of_device_id mt6370_chg_of_match[] = {
> + { .compatible = "mediatek,mt6370-charger", },
> + {}
> +};
> +MODULE_DEVICE_TABLE(of, mt6370_chg_of_match);
> +
> +static struct platform_driver mt6370_chg_driver = {
> + .probe = mt6370_chg_probe,
> + .remove = mt6370_chg_remove,
> + .driver = {
> + .name = "mt6370-charger",
> + .of_match_table = mt6370_chg_of_match,
> + },
> +};
> +module_platform_driver(mt6370_chg_driver);
> +
> +MODULE_AUTHOR("ChiaEn Wu <[email protected]>");
> +MODULE_DESCRIPTION("MediaTek MT6370 Charger Driver");
> +MODULE_LICENSE("GPL v2");
-- Sebastian
Hi!
> The MediaTek MT6370 is a highly-integrated smart power management IC,
> which includes a single cell Li-Ion/Li-Polymer switching battery
> charger, a USB Type-C & Power Delivery (PD) controller, dual
> Flash LED current sources, a RGB LED driver, a backlight WLED driver,
> a display bias driver and a general LDO for portable devices.
>
> In MediaTek MT6370, there are four channel current-sink RGB LEDs that
> support hardware pattern for constant current, PWM, and breath mode.
> Isink4 channel can also be used as a CHG_VIN power good indicator.
>
> Signed-off-by: ChiYuan Huang <[email protected]>
> index a49979f..71bacb5 100644
> --- a/drivers/leds/Kconfig
> +++ b/drivers/leds/Kconfig
> @@ -244,6 +244,20 @@ config LEDS_MT6323
> This option enables support for on-chip LED drivers found on
> Mediatek MT6323 PMIC.
>
> +config LEDS_MT6370_RGB
> + tristate "LED Support for MediaTek MT6370 PMIC"
> + depends on LEDS_CLASS
> + depends on MFD_MT6370
> + select LINEAR_RANGE
> + help
> + Say Y here to enable support for MT6370_RGB LED device.
> + In MT6370, there are four channel current-sink LED drivers that
> + support hardware pattern for constant current, PWM, and breath mode.
> + Isink4 channel can also be used as a CHG_VIN power good
Should this go to leds/rgb directory, and should it depend on
multicolor framework?
Best regards,
Pavel
--
People of Russia, stop Putin before his war on Ukraine escalates.
ChiYuan Huang <[email protected]> 於 2022年7月20日 週三 下午5:45寫道:
>
> On Fri, Jul 15, 2022 at 08:29:42PM +0200, Andy Shevchenko wrote:
> > On Fri, Jul 15, 2022 at 1:29 PM ChiaEn Wu <[email protected]> wrote:
> > >
> > > From: ChiYuan Huang <[email protected]>
> > >
> > > The MediaTek MT6370 is a highly-integrated smart power management IC,
> > > which includes a single cell Li-Ion/Li-Polymer switching battery
> > > charger, a USB Type-C & Power Delivery (PD) controller, dual
> > > Flash LED current sources, a RGB LED driver, a backlight WLED driver,
> > > a display bias driver and a general LDO for portable devices.
> > >
> > > In MediaTek MT6370, there are four channel current-sink RGB LEDs that
> > > support hardware pattern for constant current, PWM, and breath mode.
> > > Isink4 channel can also be used as a CHG_VIN power good indicator.
> >
> > ...
> >
> > > + This driver can also be built as a module. If so the module
> >
> > so, the
> >
> > > + will be called "leds-mt6370.ko".
> >
> > No ".ko".
> >
> > Why did you ignore these comments? Please go and fix _everywhere_ in
> > your series.
> > It's basically the rule of thumb, if the reviewer gives a comment
> > against an occurrence of something, go through entire series and check
> > if there are other places like commented one and address them all.
> >
> > ...
> >
> > > + * Author: Alice Chen <[email protected]>
> >
> > Strange, the commit message doesn't have a corresponding SoB, why?
> >
> Yes, there're two authors Alice and me.
> I'll correct it in next.
> > ...
> >
> > > +#define MT6370_PWM_DUTY 31
> > > +#define MT6372_PMW_DUTY 255
> >
> > Looks like these are limits by hardware?
> > Check with the datasheet if (BIT(x) - 1) makes more sense here.
> >
> > ...
> >
> > > + switch (led_no) {
> > > + case MT6370_LED_ISNK1:
> > > + sel_field = F_LED1_DUTY;
> > > + break;
> > > + case MT6370_LED_ISNK2:
> > > + sel_field = F_LED2_DUTY;
> > > + break;
> > > + case MT6370_LED_ISNK3:
> > > + sel_field = F_LED3_DUTY;
> > > + break;
> > > + default:
> > > + sel_field = F_LED4_DUTY;
> >
> > Missed break;
> >
> > > + }
> >
> > ...
> >
> > > + switch (led_no) {
> > > + case MT6370_LED_ISNK1:
> > > + sel_field = F_LED1_FREQ;
> > > + break;
> > > + case MT6370_LED_ISNK2:
> > > + sel_field = F_LED2_FREQ;
> > > + break;
> > > + case MT6370_LED_ISNK3:
> > > + sel_field = F_LED3_FREQ;
> > > + break;
> > > + default:
> > > + sel_field = F_LED4_FREQ;
> >
> > Ditto.
> >
> > > + }
> >
> > ...
> >
> > > + switch (led_no) {
> > > + case MT6370_LED_ISNK1:
> > > + case MT6370_LED_ISNK2:
> > > + case MT6370_LED_ISNK3:
> > > + *base = MT6370_REG_RGB1_TR + led_no * 3;
> > > + break;
> > > + default:
> > > + *base = MT6370_REG_RGB_CHRIND_TR;
> >
> > Ditto.
> > It seems you dropped them for all switch-cases. It's not goot, please
> > restore them back.
> >
> > > + }
> >
> > ...
> >
> > > + u8 val[P_MAX_PATTERNS / 2] = {0};
> >
> > { } should suffice
> >
> >
> In the above range selector, we use the 'logic or' to generate the
typo, it's 'below'.
> pattern values.
>
> If to change it from '{0} to '{ }', is it correct?
> > > + /*
> > > + * Pattern list
> > > + * tr1: byte 0, b'[7: 4]
> > > + * tr2: byte 0, b'[3: 0]
> > > + * tf1: byte 1, b'[7: 4]
> > > + * tf2: byte 1, b'[3: 0]
> > > + * ton: byte 2, b'[7: 4]
> > > + * toff: byte 2, b'[3: 0]
> > > + */
> > > + for (i = 0; i < P_MAX_PATTERNS; i++) {
> > > + curr = pattern + i;
> > > +
> > > + sel_range = i == P_LED_TOFF ? R_LED_TOFF : R_LED_TRFON;
> > > +
> > > + linear_range_get_selector_within(priv->ranges + sel_range,
> > > + curr->delta_t, &sel);
> > > +
> > > + val[i / 2] |= sel << (4 * ((i + 1) % 2));
> > > + }
> > > +
> > > + memcpy(pattern_val, val, 3);
> > > + return 0;
> > > +}
> >
> > ...
> >
> > > +out:
> >
> > out_unlock:
> >
> > > + mutex_unlock(&priv->lock);
> > > +
> > > + return ret;
> >
> > ...
> >
> > > +out:
> >
> > Ditto. And so on.
> >
> > > + mutex_unlock(&priv->lock);
> > > +
> > > + return ret;
> >
> > ...
> >
> > > + sub_led = devm_kzalloc(priv->dev,
> > > + sizeof(*sub_led) * MC_CHANNEL_NUM,
> > > + GFP_KERNEL);
> >
> > NIH devm_kcalloc(). Also check if you really need zeroed data.
> >
> Ok, and after the check, I also need to add one line to set the intensity to 0.
> > > + if (!sub_led)
> > > + return -ENOMEM;
> >
> > ...
> >
> > > + ret = fwnode_property_read_u32(child, "color", &color);
> > > + if (ret) {
> > > + dev_err(priv->dev,
> > > + "led %d, no color specified\n",
> > > + led->index);
> > > + return ret;
> >
> > return dev_err_probe(...) ; ?
> >
> > Ditto for many places in your entire series.
> >
> > > + }
> >
> > ...
> >
> > > + priv = devm_kzalloc(&pdev->dev,
> > > + struct_size(priv, leds, count), GFP_KERNEL);
> >
> > At least one parameter can be placed on the previous line.
> >
> > > + if (!priv)
> > > + return -ENOMEM;
> >
> > --
> > With Best Regards,
> > Andy Shevchenko
On Fri, Jul 15, 2022 at 08:29:42PM +0200, Andy Shevchenko wrote:
> On Fri, Jul 15, 2022 at 1:29 PM ChiaEn Wu <[email protected]> wrote:
> >
> > From: ChiYuan Huang <[email protected]>
> >
> > The MediaTek MT6370 is a highly-integrated smart power management IC,
> > which includes a single cell Li-Ion/Li-Polymer switching battery
> > charger, a USB Type-C & Power Delivery (PD) controller, dual
> > Flash LED current sources, a RGB LED driver, a backlight WLED driver,
> > a display bias driver and a general LDO for portable devices.
> >
> > In MediaTek MT6370, there are four channel current-sink RGB LEDs that
> > support hardware pattern for constant current, PWM, and breath mode.
> > Isink4 channel can also be used as a CHG_VIN power good indicator.
>
> ...
>
> > + This driver can also be built as a module. If so the module
>
> so, the
>
> > + will be called "leds-mt6370.ko".
>
> No ".ko".
>
> Why did you ignore these comments? Please go and fix _everywhere_ in
> your series.
> It's basically the rule of thumb, if the reviewer gives a comment
> against an occurrence of something, go through entire series and check
> if there are other places like commented one and address them all.
>
> ...
>
> > + * Author: Alice Chen <[email protected]>
>
> Strange, the commit message doesn't have a corresponding SoB, why?
>
Yes, there're two authors Alice and me.
I'll correct it in next.
> ...
>
> > +#define MT6370_PWM_DUTY 31
> > +#define MT6372_PMW_DUTY 255
>
> Looks like these are limits by hardware?
> Check with the datasheet if (BIT(x) - 1) makes more sense here.
>
> ...
>
> > + switch (led_no) {
> > + case MT6370_LED_ISNK1:
> > + sel_field = F_LED1_DUTY;
> > + break;
> > + case MT6370_LED_ISNK2:
> > + sel_field = F_LED2_DUTY;
> > + break;
> > + case MT6370_LED_ISNK3:
> > + sel_field = F_LED3_DUTY;
> > + break;
> > + default:
> > + sel_field = F_LED4_DUTY;
>
> Missed break;
>
> > + }
>
> ...
>
> > + switch (led_no) {
> > + case MT6370_LED_ISNK1:
> > + sel_field = F_LED1_FREQ;
> > + break;
> > + case MT6370_LED_ISNK2:
> > + sel_field = F_LED2_FREQ;
> > + break;
> > + case MT6370_LED_ISNK3:
> > + sel_field = F_LED3_FREQ;
> > + break;
> > + default:
> > + sel_field = F_LED4_FREQ;
>
> Ditto.
>
> > + }
>
> ...
>
> > + switch (led_no) {
> > + case MT6370_LED_ISNK1:
> > + case MT6370_LED_ISNK2:
> > + case MT6370_LED_ISNK3:
> > + *base = MT6370_REG_RGB1_TR + led_no * 3;
> > + break;
> > + default:
> > + *base = MT6370_REG_RGB_CHRIND_TR;
>
> Ditto.
> It seems you dropped them for all switch-cases. It's not goot, please
> restore them back.
>
> > + }
>
> ...
>
> > + u8 val[P_MAX_PATTERNS / 2] = {0};
>
> { } should suffice
>
>
In the above range selector, we use the 'logic or' to generate the
pattern values.
If to change it from '{0} to '{ }', is it correct?
> > + /*
> > + * Pattern list
> > + * tr1: byte 0, b'[7: 4]
> > + * tr2: byte 0, b'[3: 0]
> > + * tf1: byte 1, b'[7: 4]
> > + * tf2: byte 1, b'[3: 0]
> > + * ton: byte 2, b'[7: 4]
> > + * toff: byte 2, b'[3: 0]
> > + */
> > + for (i = 0; i < P_MAX_PATTERNS; i++) {
> > + curr = pattern + i;
> > +
> > + sel_range = i == P_LED_TOFF ? R_LED_TOFF : R_LED_TRFON;
> > +
> > + linear_range_get_selector_within(priv->ranges + sel_range,
> > + curr->delta_t, &sel);
> > +
> > + val[i / 2] |= sel << (4 * ((i + 1) % 2));
> > + }
> > +
> > + memcpy(pattern_val, val, 3);
> > + return 0;
> > +}
>
> ...
>
> > +out:
>
> out_unlock:
>
> > + mutex_unlock(&priv->lock);
> > +
> > + return ret;
>
> ...
>
> > +out:
>
> Ditto. And so on.
>
> > + mutex_unlock(&priv->lock);
> > +
> > + return ret;
>
> ...
>
> > + sub_led = devm_kzalloc(priv->dev,
> > + sizeof(*sub_led) * MC_CHANNEL_NUM,
> > + GFP_KERNEL);
>
> NIH devm_kcalloc(). Also check if you really need zeroed data.
>
Ok, and after the check, I also need to add one line to set the intensity to 0.
> > + if (!sub_led)
> > + return -ENOMEM;
>
> ...
>
> > + ret = fwnode_property_read_u32(child, "color", &color);
> > + if (ret) {
> > + dev_err(priv->dev,
> > + "led %d, no color specified\n",
> > + led->index);
> > + return ret;
>
> return dev_err_probe(...) ; ?
>
> Ditto for many places in your entire series.
>
> > + }
>
> ...
>
> > + priv = devm_kzalloc(&pdev->dev,
> > + struct_size(priv, leds, count), GFP_KERNEL);
>
> At least one parameter can be placed on the previous line.
>
> > + if (!priv)
> > + return -ENOMEM;
>
> --
> With Best Regards,
> Andy Shevchenko
ChiYuan Huang <[email protected]> 於 2022年7月20日 週三 下午5:48寫道:
>
> ChiYuan Huang <[email protected]> 於 2022年7月20日 週三 下午5:45寫道:
> >
> > On Fri, Jul 15, 2022 at 08:29:42PM +0200, Andy Shevchenko wrote:
> > > On Fri, Jul 15, 2022 at 1:29 PM ChiaEn Wu <[email protected]> wrote:
> > > >
> > > > From: ChiYuan Huang <[email protected]>
> > > >
> > > > The MediaTek MT6370 is a highly-integrated smart power management IC,
> > > > which includes a single cell Li-Ion/Li-Polymer switching battery
> > > > charger, a USB Type-C & Power Delivery (PD) controller, dual
> > > > Flash LED current sources, a RGB LED driver, a backlight WLED driver,
> > > > a display bias driver and a general LDO for portable devices.
> > > >
> > > > In MediaTek MT6370, there are four channel current-sink RGB LEDs that
> > > > support hardware pattern for constant current, PWM, and breath mode.
> > > > Isink4 channel can also be used as a CHG_VIN power good indicator.
> > >
> > > ...
> > >
> > > > + This driver can also be built as a module. If so the module
> > >
> > > so, the
> > >
> > > > + will be called "leds-mt6370.ko".
> > >
> > > No ".ko".
> > >
> > > Why did you ignore these comments? Please go and fix _everywhere_ in
> > > your series.
> > > It's basically the rule of thumb, if the reviewer gives a comment
> > > against an occurrence of something, go through entire series and check
> > > if there are other places like commented one and address them all.
> > >
> > > ...
> > >
> > > > + * Author: Alice Chen <[email protected]>
> > >
> > > Strange, the commit message doesn't have a corresponding SoB, why?
> > >
> > Yes, there're two authors Alice and me.
> > I'll correct it in next.
> > > ...
> > >
> > > > +#define MT6370_PWM_DUTY 31
> > > > +#define MT6372_PMW_DUTY 255
> > >
> > > Looks like these are limits by hardware?
> > > Check with the datasheet if (BIT(x) - 1) makes more sense here.
> > >
> > > ...
> > >
> > > > + switch (led_no) {
> > > > + case MT6370_LED_ISNK1:
> > > > + sel_field = F_LED1_DUTY;
> > > > + break;
> > > > + case MT6370_LED_ISNK2:
> > > > + sel_field = F_LED2_DUTY;
> > > > + break;
> > > > + case MT6370_LED_ISNK3:
> > > > + sel_field = F_LED3_DUTY;
> > > > + break;
> > > > + default:
> > > > + sel_field = F_LED4_DUTY;
> > >
> > > Missed break;
> > >
> > > > + }
> > >
> > > ...
> > >
> > > > + switch (led_no) {
> > > > + case MT6370_LED_ISNK1:
> > > > + sel_field = F_LED1_FREQ;
> > > > + break;
> > > > + case MT6370_LED_ISNK2:
> > > > + sel_field = F_LED2_FREQ;
> > > > + break;
> > > > + case MT6370_LED_ISNK3:
> > > > + sel_field = F_LED3_FREQ;
> > > > + break;
> > > > + default:
> > > > + sel_field = F_LED4_FREQ;
> > >
> > > Ditto.
> > >
> > > > + }
> > >
> > > ...
> > >
> > > > + switch (led_no) {
> > > > + case MT6370_LED_ISNK1:
> > > > + case MT6370_LED_ISNK2:
> > > > + case MT6370_LED_ISNK3:
> > > > + *base = MT6370_REG_RGB1_TR + led_no * 3;
> > > > + break;
> > > > + default:
> > > > + *base = MT6370_REG_RGB_CHRIND_TR;
> > >
> > > Ditto.
> > > It seems you dropped them for all switch-cases. It's not goot, please
> > > restore them back.
> > >
> > > > + }
> > >
> > > ...
> > >
> > > > + u8 val[P_MAX_PATTERNS / 2] = {0};
> > >
> > > { } should suffice
> > >
> > >
> > In the above range selector, we use the 'logic or' to generate the
> typo, it's 'below'.
> > pattern values.
> >
Ah, found in c11 standard 6.7.9 item 21
It is the same as 'static storage duration'.
I will follow your comment to revise it.
Thanks.
> > If to change it from '{0} to '{ }', is it correct?
> > > > + /*
> > > > + * Pattern list
> > > > + * tr1: byte 0, b'[7: 4]
> > > > + * tr2: byte 0, b'[3: 0]
> > > > + * tf1: byte 1, b'[7: 4]
> > > > + * tf2: byte 1, b'[3: 0]
> > > > + * ton: byte 2, b'[7: 4]
> > > > + * toff: byte 2, b'[3: 0]
> > > > + */
> > > > + for (i = 0; i < P_MAX_PATTERNS; i++) {
> > > > + curr = pattern + i;
> > > > +
> > > > + sel_range = i == P_LED_TOFF ? R_LED_TOFF : R_LED_TRFON;
> > > > +
> > > > + linear_range_get_selector_within(priv->ranges + sel_range,
> > > > + curr->delta_t, &sel);
> > > > +
> > > > + val[i / 2] |= sel << (4 * ((i + 1) % 2));
> > > > + }
> > > > +
> > > > + memcpy(pattern_val, val, 3);
> > > > + return 0;
> > > > +}
> > >
> > > ...
> > >
> > > > +out:
> > >
> > > out_unlock:
> > >
> > > > + mutex_unlock(&priv->lock);
> > > > +
> > > > + return ret;
> > >
> > > ...
> > >
> > > > +out:
> > >
> > > Ditto. And so on.
> > >
> > > > + mutex_unlock(&priv->lock);
> > > > +
> > > > + return ret;
> > >
> > > ...
> > >
> > > > + sub_led = devm_kzalloc(priv->dev,
> > > > + sizeof(*sub_led) * MC_CHANNEL_NUM,
> > > > + GFP_KERNEL);
> > >
> > > NIH devm_kcalloc(). Also check if you really need zeroed data.
> > >
> > Ok, and after the check, I also need to add one line to set the intensity to 0.
> > > > + if (!sub_led)
> > > > + return -ENOMEM;
> > >
> > > ...
> > >
> > > > + ret = fwnode_property_read_u32(child, "color", &color);
> > > > + if (ret) {
> > > > + dev_err(priv->dev,
> > > > + "led %d, no color specified\n",
> > > > + led->index);
> > > > + return ret;
> > >
> > > return dev_err_probe(...) ; ?
> > >
> > > Ditto for many places in your entire series.
> > >
> > > > + }
> > >
> > > ...
> > >
> > > > + priv = devm_kzalloc(&pdev->dev,
> > > > + struct_size(priv, leds, count), GFP_KERNEL);
> > >
> > > At least one parameter can be placed on the previous line.
> > >
> > > > + if (!priv)
> > > > + return -ENOMEM;
> > >
> > > --
> > > With Best Regards,
> > > Andy Shevchenko
On Sun, Jul 17, 2022 at 10:46:43AM +0200, Pavel Machek wrote:
> Hi!
>
> > The MediaTek MT6370 is a highly-integrated smart power management IC,
> > which includes a single cell Li-Ion/Li-Polymer switching battery
> > charger, a USB Type-C & Power Delivery (PD) controller, dual
> > Flash LED current sources, a RGB LED driver, a backlight WLED driver,
> > a display bias driver and a general LDO for portable devices.
> >
> > In MediaTek MT6370, there are four channel current-sink RGB LEDs that
> > support hardware pattern for constant current, PWM, and breath mode.
> > Isink4 channel can also be used as a CHG_VIN power good indicator.
> >
> > Signed-off-by: ChiYuan Huang <[email protected]>
>
> > index a49979f..71bacb5 100644
> > --- a/drivers/leds/Kconfig
> > +++ b/drivers/leds/Kconfig
> > @@ -244,6 +244,20 @@ config LEDS_MT6323
> > This option enables support for on-chip LED drivers found on
> > Mediatek MT6323 PMIC.
> >
> > +config LEDS_MT6370_RGB
> > + tristate "LED Support for MediaTek MT6370 PMIC"
> > + depends on LEDS_CLASS
> > + depends on MFD_MT6370
> > + select LINEAR_RANGE
> > + help
> > + Say Y here to enable support for MT6370_RGB LED device.
> > + In MT6370, there are four channel current-sink LED drivers that
> > + support hardware pattern for constant current, PWM, and breath mode.
> > + Isink4 channel can also be used as a CHG_VIN power good
>
> Should this go to leds/rgb directory, and should it depend on
> multicolor framework?
Yes, and I may also want to change the file name from 'leds-mt6370'
to 'leds-mt6370-rgb'. Is it ok?
>
> Best regards,
> Pavel
> --
> People of Russia, stop Putin before his war on Ukraine escalates.