The BQ256XX family of devices are highly integrated buck chargers
for single cell batteries.
Signed-off-by: Ricardo Rivera-Matos <[email protected]>
v5 - adds power_supply_put_battery_info() and devm_add_action_or_rest() calls
v6 - implements bq256xx_remove function
---
drivers/power/supply/Kconfig | 11 +
drivers/power/supply/Makefile | 1 +
drivers/power/supply/bq256xx_charger.c | 1803 ++++++++++++++++++++++++
3 files changed, 1815 insertions(+)
create mode 100644 drivers/power/supply/bq256xx_charger.c
diff --git a/drivers/power/supply/Kconfig b/drivers/power/supply/Kconfig
index 44d3c8512fb8..87d852914bc2 100644
--- a/drivers/power/supply/Kconfig
+++ b/drivers/power/supply/Kconfig
@@ -618,6 +618,17 @@ config CHARGER_BQ25890
help
Say Y to enable support for the TI BQ25890 battery charger.
+config CHARGER_BQ256XX
+ tristate "TI BQ256XX battery charger driver"
+ depends on I2C
+ depends on GPIOLIB || COMPILE_TEST
+ select REGMAP_I2C
+ help
+ Say Y to enable support for the TI BQ256XX battery chargers. The
+ BQ256XX family of devices are highly-integrated, switch-mode battery
+ charge management and system power path management devices for single
+ cell Li-ion and Li-polymer batteries.
+
config CHARGER_SMB347
tristate "Summit Microelectronics SMB347 Battery Charger"
depends on I2C
diff --git a/drivers/power/supply/Makefile b/drivers/power/supply/Makefile
index b9644663e435..e762442c7cc6 100644
--- a/drivers/power/supply/Makefile
+++ b/drivers/power/supply/Makefile
@@ -83,6 +83,7 @@ obj-$(CONFIG_CHARGER_BQ24190) += bq24190_charger.o
obj-$(CONFIG_CHARGER_BQ24257) += bq24257_charger.o
obj-$(CONFIG_CHARGER_BQ24735) += bq24735-charger.o
obj-$(CONFIG_CHARGER_BQ25890) += bq25890_charger.o
+obj-$(CONFIG_CHARGER_BQ256XX) += bq256xx_charger.o
obj-$(CONFIG_CHARGER_SMB347) += smb347-charger.o
obj-$(CONFIG_CHARGER_TPS65090) += tps65090-charger.o
obj-$(CONFIG_CHARGER_TPS65217) += tps65217_charger.o
diff --git a/drivers/power/supply/bq256xx_charger.c b/drivers/power/supply/bq256xx_charger.c
new file mode 100644
index 000000000000..b9caec10c456
--- /dev/null
+++ b/drivers/power/supply/bq256xx_charger.c
@@ -0,0 +1,1803 @@
+// SPDX-License-Identifier: GPL-2.0
+// BQ256XX Battery Charger Driver
+// Copyright (C) 2020 Texas Instruments Incorporated - http://www.ti.com/
+
+#include <linux/err.h>
+#include <linux/i2c.h>
+#include <linux/init.h>
+#include <linux/interrupt.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/gpio/consumer.h>
+#include <linux/power_supply.h>
+#include <linux/regmap.h>
+#include <linux/types.h>
+#include <linux/usb/phy.h>
+#include <linux/device.h>
+#include <linux/moduleparam.h>
+#include <linux/slab.h>
+#include <linux/acpi.h>
+
+#define BQ256XX_MANUFACTURER "Texas Instruments"
+
+#define BQ256XX_INPUT_CURRENT_LIMIT 0x00
+#define BQ256XX_CHARGER_CONTROL_0 0x01
+#define BQ256XX_CHARGE_CURRENT_LIMIT 0x02
+#define BQ256XX_PRECHG_AND_TERM_CURR_LIM 0x03
+#define BQ256XX_BATTERY_VOLTAGE_LIMIT 0x04
+#define BQ256XX_CHARGER_CONTROL_1 0x05
+#define BQ256XX_CHARGER_CONTROL_2 0x06
+#define BQ256XX_CHARGER_CONTROL_3 0x07
+#define BQ256XX_CHARGER_STATUS_0 0x08
+#define BQ256XX_CHARGER_STATUS_1 0x09
+#define BQ256XX_CHARGER_STATUS_2 0x0a
+#define BQ256XX_PART_INFORMATION 0x0b
+#define BQ256XX_CHARGER_CONTROL_4 0x0c
+
+#define BQ256XX_IINDPM_MASK GENMASK(4, 0)
+#define BQ256XX_IINDPM_STEP_uA 100000
+#define BQ256XX_IINDPM_OFFSET_uA 100000
+#define BQ256XX_IINDPM_MIN_uA 100000
+#define BQ256XX_IINDPM_MAX_uA 3200000
+#define BQ256XX_IINDPM_DEF_uA 2400000
+
+#define BQ256XX_VINDPM_MASK GENMASK(3, 0)
+#define BQ256XX_VINDPM_STEP_uV 100000
+#define BQ256XX_VINDPM_OFFSET_uV 3900000
+#define BQ256XX_VINDPM_MIN_uV 3900000
+#define BQ256XX_VINDPM_MAX_uV 5400000
+#define BQ256XX_VINDPM_DEF_uV 4500000
+
+#define BQ256XX_VBATREG_MASK GENMASK(7, 3)
+#define BQ2560X_VBATREG_STEP_uV 32000
+#define BQ2560X_VBATREG_OFFSET_uV 3856000
+#define BQ2560X_VBATREG_MIN_uV 3856000
+#define BQ2560X_VBATREG_MAX_uV 4624000
+#define BQ2560X_VBATREG_DEF_uV 4208000
+#define BQ25601D_VBATREG_OFFSET_uV 3847000
+#define BQ25601D_VBATREG_MIN_uV 3847000
+#define BQ25601D_VBATREG_MAX_uV 4615000
+#define BQ25601D_VBATREG_DEF_uV 4199000
+#define BQ2561X_VBATREG_STEP_uV 10000
+#define BQ25611D_VBATREG_MIN_uV 3494000
+#define BQ25611D_VBATREG_MAX_uV 4510000
+#define BQ25611D_VBATREG_DEF_uV 4190000
+#define BQ25618_VBATREG_MIN_uV 3504000
+#define BQ25618_VBATREG_MAX_uV 4500000
+#define BQ25618_VBATREG_DEF_uV 4200000
+#define BQ256XX_VBATREG_BIT_SHIFT 3
+#define BQ2561X_VBATREG_THRESH 0x8
+#define BQ25611D_VBATREG_THRESH_uV 4290000
+#define BQ25618_VBATREG_THRESH_uV 4300000
+
+#define BQ256XX_ITERM_MASK GENMASK(3, 0)
+#define BQ256XX_ITERM_STEP_uA 60000
+#define BQ256XX_ITERM_OFFSET_uA 60000
+#define BQ256XX_ITERM_MIN_uA 60000
+#define BQ256XX_ITERM_MAX_uA 780000
+#define BQ256XX_ITERM_DEF_uA 180000
+#define BQ25618_ITERM_STEP_uA 20000
+#define BQ25618_ITERM_OFFSET_uA 20000
+#define BQ25618_ITERM_MIN_uA 20000
+#define BQ25618_ITERM_MAX_uA 260000
+#define BQ25618_ITERM_DEF_uA 60000
+
+#define BQ256XX_IPRECHG_MASK GENMASK(7, 4)
+#define BQ256XX_IPRECHG_STEP_uA 60000
+#define BQ256XX_IPRECHG_OFFSET_uA 60000
+#define BQ256XX_IPRECHG_MIN_uA 60000
+#define BQ256XX_IPRECHG_MAX_uA 780000
+#define BQ256XX_IPRECHG_DEF_uA 180000
+#define BQ25618_IPRECHG_STEP_uA 20000
+#define BQ25618_IPRECHG_OFFSET_uA 20000
+#define BQ25618_IPRECHG_MIN_uA 20000
+#define BQ25618_IPRECHG_MAX_uA 260000
+#define BQ25618_IPRECHG_DEF_uA 40000
+#define BQ256XX_IPRECHG_BIT_SHIFT 4
+
+#define BQ256XX_ICHG_MASK GENMASK(5, 0)
+#define BQ256XX_ICHG_STEP_uA 60000
+#define BQ256XX_ICHG_MIN_uA 0
+#define BQ256XX_ICHG_MAX_uA 3000000
+#define BQ2560X_ICHG_DEF_uA 2040000
+#define BQ25611D_ICHG_DEF_uA 1020000
+#define BQ25618_ICHG_STEP_uA 20000
+#define BQ25618_ICHG_MIN_uA 0
+#define BQ25618_ICHG_MAX_uA 1500000
+#define BQ25618_ICHG_DEF_uA 340000
+#define BQ25618_ICHG_THRESH 0x3c
+#define BQ25618_ICHG_THRESH_uA 1180000
+
+#define BQ256XX_VBUS_STAT_MASK GENMASK(7, 5)
+#define BQ256XX_VBUS_STAT_NO_INPUT 0
+#define BQ256XX_VBUS_STAT_USB_SDP BIT(5)
+#define BQ256XX_VBUS_STAT_USB_CDP BIT(6)
+#define BQ256XX_VBUS_STAT_USB_DCP (BIT(6) | BIT(5))
+#define BQ256XX_VBUS_STAT_USB_OTG (BIT(7) | BIT(6) | BIT(5))
+
+#define BQ256XX_CHRG_STAT_MASK GENMASK(4, 3)
+#define BQ256XX_CHRG_STAT_NOT_CHRGING 0
+#define BQ256XX_CHRG_STAT_PRECHRGING BIT(3)
+#define BQ256XX_CHRG_STAT_FAST_CHRGING BIT(4)
+#define BQ256XX_CHRG_STAT_CHRG_TERM (BIT(4) | BIT(3))
+
+#define BQ256XX_PG_STAT_MASK BIT(2)
+#define BQ256XX_WDT_FAULT_MASK BIT(7)
+#define BQ256XX_CHRG_FAULT_MASK GENMASK(5, 4)
+#define BQ256XX_CHRG_FAULT_NORMAL 0
+#define BQ256XX_CHRG_FAULT_INPUT BIT(4)
+#define BQ256XX_CHRG_FAULT_THERM BIT(5)
+#define BQ256XX_CHRG_FAULT_CST_EXPIRE (BIT(5) | BIT(4))
+#define BQ256XX_BAT_FAULT_MASK BIT(3)
+#define BQ256XX_NTC_FAULT_MASK GENMASK(2, 0)
+#define BQ256XX_NTC_FAULT_WARM BIT(1)
+#define BQ256XX_NTC_FAULT_COOL (BIT(1) | BIT(0))
+#define BQ256XX_NTC_FAULT_COLD (BIT(2) | BIT(0))
+#define BQ256XX_NTC_FAULT_HOT (BIT(2) | BIT(1))
+
+#define BQ256XX_NUM_WD_VAL 8
+#define BQ256XX_WATCHDOG_MASK GENMASK(5, 4)
+#define BQ256XX_WATCHDOG_MAX 1600000
+#define BQ256XX_WATCHDOG_DIS 0
+#define BQ256XX_WDT_BIT_SHIFT 4
+
+#define BQ256XX_REG_RST BIT(7)
+
+/**
+ * struct bq256xx_init_data -
+ * @ichg: fast charge current
+ * @iindpm: input current limit
+ * @vbatreg: charge voltage
+ * @iterm: termination current
+ * @iprechg: precharge current
+ * @vindpm: input voltage limit
+ * @ichg_max: maximum fast charge current
+ * @vbatreg_max: maximum charge voltage
+ */
+struct bq256xx_init_data {
+ u32 ichg;
+ u32 iindpm;
+ u32 vbatreg;
+ u32 iterm;
+ u32 iprechg;
+ u32 vindpm;
+ u32 ichg_max;
+ u32 vbatreg_max;
+};
+
+/**
+ * struct bq256xx_state -
+ * @vbus_stat: VBUS status according to BQ256XX_CHARGER_STATUS_0
+ * @chrg_stat: charging status according to BQ256XX_CHARGER_STATUS_0
+ * @online: PG status according to BQ256XX_CHARGER_STATUS_0
+ *
+ * @wdt_fault: watchdog fault according to BQ256XX_CHARGER_STATUS_1
+ * @bat_fault: battery fault according to BQ256XX_CHARGER_STATUS_1
+ * @chrg_fault: charging fault according to BQ256XX_CHARGER_STATUS_1
+ * @ntc_fault: TS fault according to BQ256XX_CHARGER_STATUS_1
+ */
+struct bq256xx_state {
+ u8 vbus_stat;
+ u8 chrg_stat;
+ bool online;
+
+ u8 wdt_fault;
+ u8 bat_fault;
+ u8 chrg_fault;
+ u8 ntc_fault;
+};
+
+enum bq256xx_id {
+ BQ25600,
+ BQ25600D,
+ BQ25601,
+ BQ25601D,
+ BQ25618,
+ BQ25619,
+ BQ25611D,
+};
+
+/**
+ * struct bq256xx_device -
+ * @client: i2c client structure
+ * @regmap: register map structure
+ * @dev: device structure
+ * @lock: mutex lock structure
+ *
+ * @usb2_phy: usb_phy identifier
+ * @usb3_phy: usb_phy identifier
+ * @usb_nb: notifier block
+ * @usb_work: usb work queue
+ * @usb_event: usb_event code
+ *
+ * @model_name: i2c name string
+ *
+ * @init_data: initialization data
+ * @chip_info: device variant information
+ * @state: device status and faults
+ * @watchdog_timer: watchdog timer value in milliseconds
+ */
+struct bq256xx_device {
+ struct i2c_client *client;
+ struct device *dev;
+ struct power_supply *charger;
+ struct power_supply *battery;
+ struct mutex lock;
+ struct regmap *regmap;
+
+ struct usb_phy *usb2_phy;
+ struct usb_phy *usb3_phy;
+ struct notifier_block usb_nb;
+ struct work_struct usb_work;
+ unsigned long usb_event;
+
+ char model_name[I2C_NAME_SIZE];
+
+ struct bq256xx_init_data init_data;
+ const struct bq256xx_chip_info *chip_info;
+ struct bq256xx_state state;
+ int watchdog_timer;
+};
+
+/**
+ * struct bq256xx_chip_info -
+ * @model_id: device instance
+ *
+ * @bq256xx_regmap_config: regmap configuration struct
+ * @bq256xx_get_ichg: pointer to instance specific get_ichg function
+ * @bq256xx_get_iindpm: pointer to instance specific get_iindpm function
+ * @bq256xx_get_vbatreg: pointer to instance specific get_vbatreg function
+ * @bq256xx_get_iterm: pointer to instance specific get_iterm function
+ * @bq256xx_get_iprechg: pointer to instance specific get_iprechg function
+ * @bq256xx_get_vindpm: pointer to instance specific get_vindpm function
+ *
+ * @bq256xx_set_ichg: pointer to instance specific set_ichg function
+ * @bq256xx_set_iindpm: pointer to instance specific set_iindpm function
+ * @bq256xx_set_vbatreg: pointer to instance specific set_vbatreg function
+ * @bq256xx_set_iterm: pointer to instance specific set_iterm function
+ * @bq256xx_set_iprechg: pointer to instance specific set_iprechg function
+ * @bq256xx_set_vindpm: pointer to instance specific set_vindpm function
+ *
+ * @bq256xx_def_ichg: default ichg value in microamps
+ * @bq256xx_def_iindpm: default iindpm value in microamps
+ * @bq256xx_def_vbatreg: default vbatreg value in microvolts
+ * @bq256xx_def_iterm: default iterm value in microamps
+ * @bq256xx_def_iprechg: default iprechg value in microamps
+ * @bq256xx_def_vindpm: default vindpm value in microvolts
+ *
+ * @bq256xx_max_ichg: maximum charge current in microamps
+ * @bq256xx_max_vbatreg: maximum battery regulation voltage in microvolts
+ *
+ * @has_usb_detect: indicates whether device has BC1.2 detection
+ */
+struct bq256xx_chip_info {
+ int model_id;
+
+ const struct regmap_config *bq256xx_regmap_config;
+
+ int (*bq256xx_get_ichg)(struct bq256xx_device *bq);
+ int (*bq256xx_get_iindpm)(struct bq256xx_device *bq);
+ int (*bq256xx_get_vbatreg)(struct bq256xx_device *bq);
+ int (*bq256xx_get_iterm)(struct bq256xx_device *bq);
+ int (*bq256xx_get_iprechg)(struct bq256xx_device *bq);
+ int (*bq256xx_get_vindpm)(struct bq256xx_device *bq);
+
+ int (*bq256xx_set_ichg)(struct bq256xx_device *bq, int ichg);
+ int (*bq256xx_set_iindpm)(struct bq256xx_device *bq, int iindpm);
+ int (*bq256xx_set_vbatreg)(struct bq256xx_device *bq, int vbatreg);
+ int (*bq256xx_set_iterm)(struct bq256xx_device *bq, int iterm);
+ int (*bq256xx_set_iprechg)(struct bq256xx_device *bq, int iprechg);
+ int (*bq256xx_set_vindpm)(struct bq256xx_device *bq, int vindpm);
+
+ int bq256xx_def_ichg;
+ int bq256xx_def_iindpm;
+ int bq256xx_def_vbatreg;
+ int bq256xx_def_iterm;
+ int bq256xx_def_iprechg;
+ int bq256xx_def_vindpm;
+
+ int bq256xx_max_ichg;
+ int bq256xx_max_vbatreg;
+
+ bool has_usb_detect;
+};
+
+static int bq256xx_watchdog_time[BQ256XX_NUM_WD_VAL] = {
+ 0, 40000, 80000, 1600000
+};
+
+static const int bq25611d_vbatreg_values[] = {
+ 3494000, 3590000, 3686000, 3790000, 3894000, 3990000, 4090000, 4140000,
+ 4190000
+};
+
+static const int bq25618_619_vbatreg_values[] = {
+ 3504000, 3600000, 3696000, 3800000, 3904000, 4000000, 4100000, 4150000,
+ 4200000
+};
+
+static const int bq25618_619_ichg_values[] = {
+ 1290000, 1360000, 1430000, 1500000
+};
+
+static enum power_supply_usb_type bq256xx_usb_type[] = {
+ POWER_SUPPLY_USB_TYPE_SDP,
+ POWER_SUPPLY_USB_TYPE_CDP,
+ POWER_SUPPLY_USB_TYPE_DCP,
+ POWER_SUPPLY_USB_TYPE_UNKNOWN,
+ POWER_SUPPLY_USB_TYPE_ACA,
+};
+
+static int bq256xx_array_parse(int array_size, int val, const int array[])
+{
+ int i = 0;
+
+ if (val < array[i])
+ return i - 1;
+
+ if (val >= array[array_size - 1])
+ return array_size - 1;
+
+ for (i = 1; i < array_size; i++) {
+ if (val == array[i])
+ return i;
+
+ if (val > array[i - 1] && val < array[i]) {
+ if (val < array[i])
+ return i - 1;
+ else
+ return i;
+ }
+ }
+ return -EINVAL;
+}
+
+static int bq256xx_usb_notifier(struct notifier_block *nb, unsigned long val,
+ void *priv)
+{
+ struct bq256xx_device *bq =
+ container_of(nb, struct bq256xx_device, usb_nb);
+
+ bq->usb_event = val;
+ queue_work(system_power_efficient_wq, &bq->usb_work);
+
+ return NOTIFY_OK;
+}
+
+static void bq256xx_usb_work(struct work_struct *data)
+{
+ struct bq256xx_device *bq =
+ container_of(data, struct bq256xx_device, usb_work);
+
+ switch (bq->usb_event) {
+ case USB_EVENT_ID:
+ break;
+
+ case USB_EVENT_NONE:
+ power_supply_changed(bq->charger);
+ break;
+ default:
+ dev_err(bq->dev, "Error switching to charger mode.\n");
+ break;
+ }
+}
+
+static struct reg_default bq2560x_reg_defs[] = {
+ {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
+ {BQ256XX_CHARGER_CONTROL_0, 0x1a},
+ {BQ256XX_CHARGE_CURRENT_LIMIT, 0xa2},
+ {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x22},
+ {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x58},
+ {BQ256XX_CHARGER_CONTROL_1, 0x9f},
+ {BQ256XX_CHARGER_CONTROL_2, 0x66},
+ {BQ256XX_CHARGER_CONTROL_3, 0x4c},
+};
+
+static struct reg_default bq25611d_reg_defs[] = {
+ {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
+ {BQ256XX_CHARGER_CONTROL_0, 0x1a},
+ {BQ256XX_CHARGE_CURRENT_LIMIT, 0x91},
+ {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x12},
+ {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x40},
+ {BQ256XX_CHARGER_CONTROL_1, 0x9e},
+ {BQ256XX_CHARGER_CONTROL_2, 0xe6},
+ {BQ256XX_CHARGER_CONTROL_3, 0x4c},
+ {BQ256XX_PART_INFORMATION, 0x54},
+ {BQ256XX_CHARGER_CONTROL_4, 0x75},
+};
+
+static struct reg_default bq25618_619_reg_defs[] = {
+ {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
+ {BQ256XX_CHARGER_CONTROL_0, 0x1a},
+ {BQ256XX_CHARGE_CURRENT_LIMIT, 0x91},
+ {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x12},
+ {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x40},
+ {BQ256XX_CHARGER_CONTROL_1, 0x9e},
+ {BQ256XX_CHARGER_CONTROL_2, 0xe6},
+ {BQ256XX_CHARGER_CONTROL_3, 0x4c},
+ {BQ256XX_PART_INFORMATION, 0x2c},
+ {BQ256XX_CHARGER_CONTROL_4, 0x75},
+};
+
+static int bq256xx_get_state(struct bq256xx_device *bq,
+ struct bq256xx_state *state)
+{
+ unsigned int charger_status_0;
+ unsigned int charger_status_1;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_CHARGER_STATUS_0,
+ &charger_status_0);
+ if (ret)
+ return ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_CHARGER_STATUS_1,
+ &charger_status_1);
+ if (ret)
+ return ret;
+
+ state->vbus_stat = charger_status_0 & BQ256XX_VBUS_STAT_MASK;
+ state->chrg_stat = charger_status_0 & BQ256XX_CHRG_STAT_MASK;
+ state->online = charger_status_0 & BQ256XX_PG_STAT_MASK;
+
+ state->wdt_fault = charger_status_1 & BQ256XX_WDT_FAULT_MASK;
+ state->bat_fault = charger_status_1 & BQ256XX_BAT_FAULT_MASK;
+ state->chrg_fault = charger_status_1 & BQ256XX_CHRG_FAULT_MASK;
+ state->ntc_fault = charger_status_1 & BQ256XX_NTC_FAULT_MASK;
+
+ return 0;
+}
+
+static int bq256xx_get_ichg_curr(struct bq256xx_device *bq)
+{
+ unsigned int charge_current_limit;
+ unsigned int ichg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
+ &charge_current_limit);
+ if (ret)
+ return ret;
+
+ ichg_reg_code = charge_current_limit & BQ256XX_ICHG_MASK;
+
+ return ichg_reg_code * BQ256XX_ICHG_STEP_uA;
+}
+
+static int bq25618_619_get_ichg_curr(struct bq256xx_device *bq)
+{
+ unsigned int charge_current_limit;
+ unsigned int ichg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
+ &charge_current_limit);
+ if (ret)
+ return ret;
+
+ ichg_reg_code = charge_current_limit & BQ256XX_ICHG_MASK;
+
+ if (ichg_reg_code < BQ25618_ICHG_THRESH)
+ return ichg_reg_code * BQ25618_ICHG_STEP_uA;
+
+ return bq25618_619_ichg_values[ichg_reg_code - BQ25618_ICHG_THRESH];
+}
+
+static int bq256xx_set_ichg_curr(struct bq256xx_device *bq, int ichg)
+{
+ unsigned int ichg_reg_code;
+
+ if (ichg < BQ256XX_ICHG_MIN_uA)
+ ichg = BQ256XX_ICHG_MIN_uA;
+ else if (ichg > bq->init_data.ichg_max)
+ ichg = bq->init_data.ichg_max;
+
+ ichg_reg_code = ichg / BQ256XX_ICHG_STEP_uA;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
+ BQ256XX_ICHG_MASK, ichg_reg_code);
+}
+
+static int bq25618_619_set_ichg_curr(struct bq256xx_device *bq, int ichg)
+{
+ int array_size = ARRAY_SIZE(bq25618_619_ichg_values);
+ unsigned int ichg_reg_code;
+
+ if (ichg < BQ25618_ICHG_MIN_uA)
+ ichg = BQ25618_ICHG_MIN_uA;
+ else if (ichg > bq->init_data.ichg_max)
+ ichg = bq->init_data.ichg_max;
+
+ if (ichg <= BQ25618_ICHG_THRESH_uA) {
+ ichg_reg_code = ichg / BQ25618_ICHG_STEP_uA;
+ } else {
+ ichg_reg_code = bq256xx_array_parse(array_size, ichg,
+ bq25618_619_ichg_values) + BQ25618_ICHG_THRESH;
+ }
+
+ return regmap_update_bits(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
+ BQ256XX_ICHG_MASK, ichg_reg_code);
+}
+
+static int bq25618_619_get_chrg_volt(struct bq256xx_device *bq)
+{
+ unsigned int battery_volt_lim;
+ unsigned int vbatreg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ &battery_volt_lim);
+
+ if (ret)
+ return ret;
+
+ vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
+ BQ256XX_VBATREG_BIT_SHIFT;
+
+ if (vbatreg_reg_code > BQ2561X_VBATREG_THRESH)
+ return ((vbatreg_reg_code - BQ2561X_VBATREG_THRESH) *
+ BQ2561X_VBATREG_STEP_uV) +
+ BQ25618_VBATREG_THRESH_uV;
+
+ return bq25618_619_vbatreg_values[vbatreg_reg_code];
+}
+
+static int bq25611d_get_chrg_volt(struct bq256xx_device *bq)
+{
+ unsigned int battery_volt_lim;
+ unsigned int vbatreg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ &battery_volt_lim);
+ if (ret)
+ return ret;
+
+ vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
+ BQ256XX_VBATREG_BIT_SHIFT;
+
+ if (vbatreg_reg_code > BQ2561X_VBATREG_THRESH)
+ return ((vbatreg_reg_code - BQ2561X_VBATREG_THRESH) *
+ BQ2561X_VBATREG_STEP_uV) +
+ BQ25611D_VBATREG_THRESH_uV;
+
+ return bq25611d_vbatreg_values[vbatreg_reg_code];
+}
+
+static int bq2560x_get_chrg_volt(struct bq256xx_device *bq)
+{
+ unsigned int battery_volt_lim;
+ unsigned int vbatreg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ &battery_volt_lim);
+ if (ret)
+ return ret;
+
+ vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
+ BQ256XX_VBATREG_BIT_SHIFT;
+
+ return (vbatreg_reg_code * BQ2560X_VBATREG_STEP_uV)
+ + BQ2560X_VBATREG_OFFSET_uV;
+}
+
+static int bq25601d_get_chrg_volt(struct bq256xx_device *bq)
+{
+ unsigned int battery_volt_lim;
+ unsigned int vbatreg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ &battery_volt_lim);
+ if (ret)
+ return ret;
+
+ vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
+ BQ256XX_VBATREG_BIT_SHIFT;
+
+ return (vbatreg_reg_code * BQ2560X_VBATREG_STEP_uV)
+ + BQ25601D_VBATREG_OFFSET_uV;
+}
+
+static int bq25618_619_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
+{
+ int array_size = ARRAY_SIZE(bq25618_619_vbatreg_values);
+ unsigned int vbatreg_reg_code;
+
+ if (vbatreg < BQ25618_VBATREG_MIN_uV)
+ vbatreg = BQ25618_VBATREG_MIN_uV;
+ else if (vbatreg > bq->init_data.vbatreg_max)
+ vbatreg = bq->init_data.vbatreg_max;
+
+ if (vbatreg > BQ25618_VBATREG_THRESH_uV)
+ vbatreg_reg_code = ((vbatreg -
+ BQ25618_VBATREG_THRESH_uV) /
+ (BQ2561X_VBATREG_STEP_uV)) + BQ2561X_VBATREG_THRESH;
+ else {
+ vbatreg_reg_code = bq256xx_array_parse(array_size, vbatreg,
+ bq25618_619_vbatreg_values);
+ }
+
+ return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
+ BQ256XX_VBATREG_BIT_SHIFT);
+}
+
+static int bq25611d_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
+{
+ int array_size = ARRAY_SIZE(bq25611d_vbatreg_values);
+ unsigned int vbatreg_reg_code;
+
+ if (vbatreg < BQ25611D_VBATREG_MIN_uV)
+ vbatreg = BQ25611D_VBATREG_MIN_uV;
+ else if (vbatreg > bq->init_data.vbatreg_max)
+ vbatreg = bq->init_data.vbatreg_max;
+
+ if (vbatreg > BQ25611D_VBATREG_THRESH_uV)
+ vbatreg_reg_code = ((vbatreg -
+ BQ25611D_VBATREG_THRESH_uV) /
+ (BQ2561X_VBATREG_STEP_uV)) + BQ2561X_VBATREG_THRESH;
+ else {
+ vbatreg_reg_code = bq256xx_array_parse(array_size, vbatreg,
+ bq25611d_vbatreg_values);
+ }
+
+ return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
+ BQ256XX_VBATREG_BIT_SHIFT);
+}
+
+static int bq2560x_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
+{
+ unsigned int vbatreg_reg_code;
+
+ if (vbatreg < BQ2560X_VBATREG_MIN_uV)
+ vbatreg = BQ2560X_VBATREG_MIN_uV;
+ else if (vbatreg > bq->init_data.vbatreg_max)
+ vbatreg = bq->init_data.vbatreg_max;
+
+ vbatreg_reg_code = (vbatreg - BQ2560X_VBATREG_OFFSET_uV) /
+ BQ2560X_VBATREG_STEP_uV;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
+ BQ256XX_VBATREG_BIT_SHIFT);
+}
+
+static int bq25601d_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
+{
+ unsigned int vbatreg_reg_code;
+
+ if (vbatreg < BQ25601D_VBATREG_MIN_uV)
+ vbatreg = BQ25601D_VBATREG_MIN_uV;
+ else if (vbatreg > bq->init_data.vbatreg_max)
+ vbatreg = bq->init_data.vbatreg_max;
+
+ vbatreg_reg_code = (vbatreg - BQ25601D_VBATREG_OFFSET_uV) /
+ BQ2560X_VBATREG_STEP_uV;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
+ BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
+ BQ256XX_VBATREG_BIT_SHIFT);
+}
+
+static int bq256xx_get_prechrg_curr(struct bq256xx_device *bq)
+{
+ unsigned int prechg_and_term_curr_lim;
+ unsigned int iprechg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ &prechg_and_term_curr_lim);
+ if (ret)
+ return ret;
+
+ iprechg_reg_code = (prechg_and_term_curr_lim & BQ256XX_IPRECHG_MASK)
+ >> BQ256XX_IPRECHG_BIT_SHIFT;
+
+ return (iprechg_reg_code * BQ256XX_IPRECHG_STEP_uA) +
+ BQ256XX_IPRECHG_OFFSET_uA;
+}
+
+static int bq256xx_set_prechrg_curr(struct bq256xx_device *bq, int iprechg)
+{
+ unsigned int iprechg_reg_code;
+
+ if (iprechg < BQ256XX_IPRECHG_MIN_uA)
+ iprechg = BQ256XX_IPRECHG_MIN_uA;
+ else if (iprechg > BQ256XX_IPRECHG_MAX_uA)
+ iprechg = BQ256XX_IPRECHG_MAX_uA;
+
+ iprechg_reg_code = ((iprechg - BQ256XX_IPRECHG_OFFSET_uA) /
+ BQ256XX_IPRECHG_STEP_uA) << BQ256XX_IPRECHG_BIT_SHIFT;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ BQ256XX_IPRECHG_MASK, iprechg_reg_code);
+}
+
+static int bq25618_619_get_prechrg_curr(struct bq256xx_device *bq)
+{
+ unsigned int prechg_and_term_curr_lim;
+ unsigned int iprechg_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ &prechg_and_term_curr_lim);
+ if (ret)
+ return ret;
+
+ iprechg_reg_code = (prechg_and_term_curr_lim & BQ256XX_IPRECHG_MASK)
+ >> BQ256XX_IPRECHG_BIT_SHIFT;
+
+ return (iprechg_reg_code * BQ25618_IPRECHG_STEP_uA) +
+ BQ25618_IPRECHG_OFFSET_uA;
+}
+
+static int bq25618_619_set_prechrg_curr(struct bq256xx_device *bq, int iprechg)
+{
+ unsigned int iprechg_reg_code;
+
+ if (iprechg < BQ25618_IPRECHG_MIN_uA)
+ iprechg = BQ25618_IPRECHG_MIN_uA;
+ else if (iprechg > BQ25618_IPRECHG_MAX_uA)
+ iprechg = BQ25618_IPRECHG_MAX_uA;
+
+ iprechg_reg_code = ((iprechg - BQ25618_IPRECHG_OFFSET_uA) /
+ BQ25618_IPRECHG_STEP_uA) << BQ256XX_IPRECHG_BIT_SHIFT;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ BQ256XX_IPRECHG_MASK, iprechg_reg_code);
+}
+
+static int bq256xx_get_term_curr(struct bq256xx_device *bq)
+{
+ unsigned int prechg_and_term_curr_lim;
+ unsigned int iterm_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ &prechg_and_term_curr_lim);
+ if (ret)
+ return ret;
+
+ iterm_reg_code = prechg_and_term_curr_lim & BQ256XX_ITERM_MASK;
+
+ return (iterm_reg_code * BQ256XX_ITERM_STEP_uA) +
+ BQ256XX_ITERM_OFFSET_uA;
+}
+
+static int bq256xx_set_term_curr(struct bq256xx_device *bq, int iterm)
+{
+ unsigned int iterm_reg_code;
+
+ if (iterm < BQ256XX_ITERM_MIN_uA)
+ iterm = BQ256XX_ITERM_MIN_uA;
+ else if (iterm > BQ256XX_ITERM_MAX_uA)
+ iterm = BQ256XX_ITERM_MAX_uA;
+
+ iterm_reg_code = (iterm - BQ256XX_ITERM_OFFSET_uA) /
+ BQ256XX_ITERM_STEP_uA;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ BQ256XX_ITERM_MASK, iterm_reg_code);
+}
+
+static int bq25618_619_get_term_curr(struct bq256xx_device *bq)
+{
+ unsigned int prechg_and_term_curr_lim;
+ unsigned int iterm_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ &prechg_and_term_curr_lim);
+ if (ret)
+ return ret;
+
+ iterm_reg_code = prechg_and_term_curr_lim & BQ256XX_ITERM_MASK;
+
+ return (iterm_reg_code * BQ25618_ITERM_STEP_uA) +
+ BQ25618_ITERM_OFFSET_uA;
+}
+
+static int bq25618_619_set_term_curr(struct bq256xx_device *bq, int iterm)
+{
+ unsigned int iterm_reg_code;
+
+ if (iterm < BQ25618_ITERM_MIN_uA)
+ iterm = BQ25618_ITERM_MIN_uA;
+ else if (iterm > BQ25618_ITERM_MAX_uA)
+ iterm = BQ25618_ITERM_MAX_uA;
+
+ iterm_reg_code = (iterm - BQ25618_ITERM_OFFSET_uA) /
+ BQ25618_ITERM_STEP_uA;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
+ BQ256XX_ITERM_MASK, iterm_reg_code);
+}
+
+static int bq256xx_get_input_volt_lim(struct bq256xx_device *bq)
+{
+ unsigned int charger_control_2;
+ unsigned int vindpm_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_CHARGER_CONTROL_2,
+ &charger_control_2);
+ if (ret)
+ return ret;
+
+ vindpm_reg_code = charger_control_2 & BQ256XX_VINDPM_MASK;
+
+ return (vindpm_reg_code * BQ256XX_VINDPM_STEP_uV) +
+ BQ256XX_VINDPM_OFFSET_uV;
+}
+
+static int bq256xx_set_input_volt_lim(struct bq256xx_device *bq, int vindpm)
+{
+ unsigned int vindpm_reg_code;
+
+ if (vindpm < BQ256XX_VINDPM_MIN_uV)
+ vindpm = BQ256XX_VINDPM_MIN_uV;
+ else if (vindpm > BQ256XX_VINDPM_MAX_uV)
+ vindpm = BQ256XX_VINDPM_MAX_uV;
+
+ vindpm_reg_code = (vindpm - BQ256XX_VINDPM_OFFSET_uV) /
+ BQ256XX_VINDPM_STEP_uV;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_CHARGER_CONTROL_2,
+ BQ256XX_VINDPM_MASK, vindpm_reg_code);
+}
+
+static int bq256xx_get_input_curr_lim(struct bq256xx_device *bq)
+{
+ unsigned int input_current_limit;
+ unsigned int iindpm_reg_code;
+ int ret;
+
+ ret = regmap_read(bq->regmap, BQ256XX_INPUT_CURRENT_LIMIT,
+ &input_current_limit);
+ if (ret)
+ return ret;
+
+ iindpm_reg_code = input_current_limit & BQ256XX_IINDPM_MASK;
+
+ return (iindpm_reg_code * BQ256XX_IINDPM_STEP_uA) +
+ BQ256XX_IINDPM_OFFSET_uA;
+}
+
+static int bq256xx_set_input_curr_lim(struct bq256xx_device *bq, int iindpm)
+{
+ unsigned int iindpm_reg_code;
+
+ if (iindpm < BQ256XX_IINDPM_MIN_uA)
+ iindpm = BQ256XX_IINDPM_MIN_uA;
+ else if (iindpm > BQ256XX_IINDPM_MAX_uA)
+ iindpm = BQ256XX_IINDPM_MAX_uA;
+
+ iindpm_reg_code = (iindpm - BQ256XX_IINDPM_OFFSET_uA) /
+ BQ256XX_IINDPM_STEP_uA;
+
+ return regmap_update_bits(bq->regmap, BQ256XX_INPUT_CURRENT_LIMIT,
+ BQ256XX_IINDPM_MASK, iindpm_reg_code);
+}
+
+static void bq256xx_charger_reset(void *data)
+{
+ struct bq256xx_device *bq = data;
+
+ regmap_update_bits(bq->regmap, BQ256XX_PART_INFORMATION,
+ BQ256XX_REG_RST, BQ256XX_REG_RST);
+}
+
+static int bq256xx_set_charger_property(struct power_supply *psy,
+ enum power_supply_property prop,
+ const union power_supply_propval *val)
+{
+ struct bq256xx_device *bq = power_supply_get_drvdata(psy);
+ int ret = -EINVAL;
+
+ switch (prop) {
+ case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
+ ret = bq->chip_info->bq256xx_set_iindpm(bq, val->intval);
+ if (ret)
+ return ret;
+ break;
+
+ case POWER_SUPPLY_PROP_STATUS:
+ break;
+
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
+ ret = bq->chip_info->bq256xx_set_vbatreg(bq, val->intval);
+ if (ret)
+ return ret;
+ break;
+
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
+ ret = bq->chip_info->bq256xx_set_ichg(bq, val->intval);
+ if (ret)
+ return ret;
+ break;
+
+ case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
+ ret = bq->chip_info->bq256xx_set_iprechg(bq, val->intval);
+ if (ret)
+ return ret;
+ break;
+
+ case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
+ ret = bq->chip_info->bq256xx_set_iterm(bq, val->intval);
+ if (ret)
+ return ret;
+ break;
+
+ case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
+ ret = bq->chip_info->bq256xx_set_vindpm(bq, val->intval);
+ if (ret)
+ return ret;
+ break;
+
+ default:
+ break;
+ }
+
+ return ret;
+}
+
+
+static int bq256xx_get_battery_property(struct power_supply *psy,
+ enum power_supply_property psp,
+ union power_supply_propval *val)
+{
+ struct bq256xx_device *bq = power_supply_get_drvdata(psy);
+
+ switch (psp) {
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
+ val->intval = bq->init_data.ichg_max;
+ break;
+
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
+ val->intval = bq->init_data.vbatreg_max;
+ break;
+
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+static int bq256xx_get_charger_property(struct power_supply *psy,
+ enum power_supply_property psp,
+ union power_supply_propval *val)
+{
+ struct bq256xx_device *bq = power_supply_get_drvdata(psy);
+ struct bq256xx_state state;
+ int ret = 0;
+
+ mutex_lock(&bq->lock);
+ ret = bq256xx_get_state(bq, &state);
+ mutex_unlock(&bq->lock);
+ if (ret)
+ return ret;
+
+ switch (psp) {
+ case POWER_SUPPLY_PROP_STATUS:
+ if (state.vbus_stat == BQ256XX_VBUS_STAT_NO_INPUT ||
+ state.vbus_stat == BQ256XX_VBUS_STAT_USB_OTG)
+ val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
+ else if (state.chrg_stat == BQ256XX_CHRG_STAT_NOT_CHRGING)
+ val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
+ else if (state.chrg_stat == BQ256XX_CHRG_STAT_CHRG_TERM)
+ val->intval = POWER_SUPPLY_STATUS_FULL;
+ else
+ val->intval = POWER_SUPPLY_STATUS_CHARGING;
+ break;
+
+ case POWER_SUPPLY_PROP_HEALTH:
+ val->intval = POWER_SUPPLY_HEALTH_UNKNOWN;
+ if (state.wdt_fault) {
+ val->intval =
+ POWER_SUPPLY_HEALTH_WATCHDOG_TIMER_EXPIRE;
+ } else if (state.bat_fault) {
+ val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
+ } else {
+ switch (state.chrg_stat) {
+ case BQ256XX_CHRG_FAULT_INPUT:
+ val->intval =
+ POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
+ break;
+ case BQ256XX_CHRG_FAULT_THERM:
+ val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
+ break;
+ case BQ256XX_CHRG_FAULT_CST_EXPIRE:
+ val->intval =
+ POWER_SUPPLY_HEALTH_SAFETY_TIMER_EXPIRE;
+ break;
+ default:
+ break;
+ }
+
+ switch (state.ntc_fault) {
+ case BQ256XX_NTC_FAULT_WARM:
+ val->intval = POWER_SUPPLY_HEALTH_WARM;
+ break;
+ case BQ256XX_NTC_FAULT_COOL:
+ val->intval = POWER_SUPPLY_HEALTH_COOL;
+ break;
+ case BQ256XX_NTC_FAULT_COLD:
+ val->intval = POWER_SUPPLY_HEALTH_COLD;
+ break;
+ case BQ256XX_NTC_FAULT_HOT:
+ val->intval = POWER_SUPPLY_HEALTH_HOT;
+ break;
+ default:
+ val->intval = POWER_SUPPLY_HEALTH_GOOD;
+ break;
+ }
+ }
+ break;
+
+ case POWER_SUPPLY_PROP_USB_TYPE:
+ if (bq->chip_info->has_usb_detect) {
+ switch (state.vbus_stat) {
+ case BQ256XX_VBUS_STAT_USB_SDP:
+ val->intval = POWER_SUPPLY_USB_TYPE_SDP;
+ break;
+ case BQ256XX_VBUS_STAT_USB_CDP:
+ val->intval = POWER_SUPPLY_USB_TYPE_CDP;
+ break;
+ case BQ256XX_VBUS_STAT_USB_DCP:
+ val->intval = POWER_SUPPLY_USB_TYPE_DCP;
+ break;
+ case BQ256XX_VBUS_STAT_USB_OTG:
+ val->intval = POWER_SUPPLY_USB_TYPE_ACA;
+ break;
+ default:
+ val->intval = POWER_SUPPLY_USB_TYPE_UNKNOWN;
+ break;
+ }
+ } else {
+ switch (state.vbus_stat) {
+ case BQ256XX_VBUS_STAT_USB_SDP:
+ val->intval = POWER_SUPPLY_USB_TYPE_SDP;
+ break;
+ case BQ256XX_VBUS_STAT_USB_OTG:
+ val->intval = POWER_SUPPLY_USB_TYPE_ACA;
+ break;
+ default:
+ val->intval = POWER_SUPPLY_USB_TYPE_UNKNOWN;
+ break;
+ }
+ }
+ break;
+
+ case POWER_SUPPLY_PROP_CHARGE_TYPE:
+ switch (state.chrg_stat) {
+ case BQ256XX_CHRG_STAT_NOT_CHRGING:
+ val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
+ break;
+ case BQ256XX_CHRG_STAT_PRECHRGING:
+ val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
+ break;
+ case BQ256XX_CHRG_STAT_FAST_CHRGING:
+ val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST;
+ break;
+ case BQ256XX_CHRG_STAT_CHRG_TERM:
+ val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
+ break;
+ default:
+ val->intval = POWER_SUPPLY_CHARGE_TYPE_UNKNOWN;
+ }
+ break;
+
+ case POWER_SUPPLY_PROP_MANUFACTURER:
+ val->strval = BQ256XX_MANUFACTURER;
+ break;
+
+ case POWER_SUPPLY_PROP_MODEL_NAME:
+ val->strval = bq->model_name;
+ break;
+
+ case POWER_SUPPLY_PROP_ONLINE:
+ val->intval = state.online;
+ break;
+
+ case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
+ ret = bq->chip_info->bq256xx_get_vindpm(bq);
+ if (ret < 0)
+ return ret;
+ val->intval = ret;
+ break;
+
+ case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
+ ret = bq->chip_info->bq256xx_get_iindpm(bq);
+ if (ret < 0)
+ return ret;
+ val->intval = ret;
+ break;
+
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
+ ret = bq->chip_info->bq256xx_get_vbatreg(bq);
+ if (ret < 0)
+ return ret;
+ val->intval = ret;
+ break;
+
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
+ ret = bq->chip_info->bq256xx_get_ichg(bq);
+ if (ret < 0)
+ return ret;
+ val->intval = ret;
+ break;
+
+ case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
+ ret = bq->chip_info->bq256xx_get_iprechg(bq);
+ if (ret < 0)
+ return ret;
+ val->intval = ret;
+ break;
+
+ case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
+ ret = bq->chip_info->bq256xx_get_iterm(bq);
+ if (ret < 0)
+ return ret;
+ val->intval = ret;
+ break;
+
+ default:
+ return -EINVAL;
+ }
+
+ return ret;
+}
+
+static bool bq256xx_state_changed(struct bq256xx_device *bq,
+ struct bq256xx_state *new_state)
+{
+ struct bq256xx_state old_state;
+
+ mutex_lock(&bq->lock);
+ old_state = bq->state;
+ mutex_unlock(&bq->lock);
+
+ return (old_state.vbus_stat != new_state->vbus_stat ||
+ old_state.chrg_stat != new_state->chrg_stat ||
+ old_state.online != new_state->online ||
+ old_state.wdt_fault != new_state->wdt_fault ||
+ old_state.bat_fault != new_state->bat_fault ||
+ old_state.chrg_fault != new_state->chrg_fault ||
+ old_state.ntc_fault != new_state->ntc_fault);
+}
+
+static irqreturn_t bq256xx_irq_handler_thread(int irq, void *private)
+{
+ struct bq256xx_device *bq = private;
+ struct bq256xx_state state;
+ int ret;
+
+ ret = bq256xx_get_state(bq, &state);
+ if (ret < 0)
+ goto irq_out;
+
+ if (!bq256xx_state_changed(bq, &state))
+ goto irq_out;
+
+ mutex_lock(&bq->lock);
+ bq->state = state;
+ mutex_unlock(&bq->lock);
+
+ power_supply_changed(bq->charger);
+
+irq_out:
+ return IRQ_HANDLED;
+}
+
+static enum power_supply_property bq256xx_power_supply_props[] = {
+ POWER_SUPPLY_PROP_MANUFACTURER,
+ POWER_SUPPLY_PROP_MODEL_NAME,
+ POWER_SUPPLY_PROP_STATUS,
+ POWER_SUPPLY_PROP_ONLINE,
+ POWER_SUPPLY_PROP_HEALTH,
+ POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT,
+ POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
+ POWER_SUPPLY_PROP_CHARGE_TYPE,
+ POWER_SUPPLY_PROP_USB_TYPE,
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT,
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE,
+ POWER_SUPPLY_PROP_PRECHARGE_CURRENT,
+ POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT,
+};
+
+static enum power_supply_property bq256xx_battery_props[] = {
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
+ POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
+};
+
+static char *bq256xx_charger_supplied_to[] = {
+ "main-battery",
+};
+
+static int bq256xx_property_is_writeable(struct power_supply *psy,
+ enum power_supply_property prop)
+{
+ switch (prop) {
+ case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
+ case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
+ case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
+ case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
+ case POWER_SUPPLY_PROP_STATUS:
+ case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
+ return true;
+ default:
+ return false;
+ }
+}
+
+static const struct power_supply_desc bq256xx_power_supply_desc = {
+ .name = "bq256xx-charger",
+ .type = POWER_SUPPLY_TYPE_USB,
+ .usb_types = bq256xx_usb_type,
+ .num_usb_types = ARRAY_SIZE(bq256xx_usb_type),
+ .properties = bq256xx_power_supply_props,
+ .num_properties = ARRAY_SIZE(bq256xx_power_supply_props),
+ .get_property = bq256xx_get_charger_property,
+ .set_property = bq256xx_set_charger_property,
+ .property_is_writeable = bq256xx_property_is_writeable,
+};
+
+static struct power_supply_desc bq256xx_battery_desc = {
+ .name = "bq256xx-battery",
+ .type = POWER_SUPPLY_TYPE_BATTERY,
+ .get_property = bq256xx_get_battery_property,
+ .properties = bq256xx_battery_props,
+ .num_properties = ARRAY_SIZE(bq256xx_battery_props),
+ .property_is_writeable = bq256xx_property_is_writeable,
+};
+
+
+static bool bq256xx_is_volatile_reg(struct device *dev, unsigned int reg)
+{
+ switch (reg) {
+ case BQ256XX_INPUT_CURRENT_LIMIT:
+ case BQ256XX_CHARGER_STATUS_0...BQ256XX_CHARGER_STATUS_2:
+ return true;
+ default:
+ return false;
+ }
+}
+
+static const struct regmap_config bq25600_regmap_config = {
+ .reg_bits = 8,
+ .val_bits = 8,
+
+ .max_register = BQ256XX_PART_INFORMATION,
+ .reg_defaults = bq2560x_reg_defs,
+ .num_reg_defaults = ARRAY_SIZE(bq2560x_reg_defs),
+ .cache_type = REGCACHE_RBTREE,
+ .volatile_reg = bq256xx_is_volatile_reg,
+};
+
+static const struct regmap_config bq25611d_regmap_config = {
+ .reg_bits = 8,
+ .val_bits = 8,
+
+ .max_register = BQ256XX_CHARGER_CONTROL_4,
+ .reg_defaults = bq25611d_reg_defs,
+ .num_reg_defaults = ARRAY_SIZE(bq25611d_reg_defs),
+ .cache_type = REGCACHE_RBTREE,
+ .volatile_reg = bq256xx_is_volatile_reg,
+};
+
+static const struct regmap_config bq25618_619_regmap_config = {
+ .reg_bits = 8,
+ .val_bits = 8,
+
+ .max_register = BQ256XX_CHARGER_CONTROL_4,
+ .reg_defaults = bq25618_619_reg_defs,
+ .num_reg_defaults = ARRAY_SIZE(bq25618_619_reg_defs),
+ .cache_type = REGCACHE_RBTREE,
+ .volatile_reg = bq256xx_is_volatile_reg,
+};
+
+static const struct bq256xx_chip_info bq256xx_chip_info_tbl[] = {
+ [BQ25600] = {
+ .model_id = BQ25600,
+ .bq256xx_regmap_config = &bq25600_regmap_config,
+ .bq256xx_get_ichg = bq256xx_get_ichg_curr,
+ .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
+ .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
+ .bq256xx_get_iterm = bq256xx_get_term_curr,
+ .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
+ .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
+
+ .bq256xx_set_ichg = bq256xx_set_ichg_curr,
+ .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
+ .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
+ .bq256xx_set_iterm = bq256xx_set_term_curr,
+ .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
+ .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
+
+ .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
+ .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
+ .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
+ .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
+ .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
+ .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
+
+ .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
+ .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
+
+ .has_usb_detect = false,
+ },
+
+ [BQ25600D] = {
+ .model_id = BQ25600D,
+ .bq256xx_regmap_config = &bq25600_regmap_config,
+ .bq256xx_get_ichg = bq256xx_get_ichg_curr,
+ .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
+ .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
+ .bq256xx_get_iterm = bq256xx_get_term_curr,
+ .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
+ .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
+
+ .bq256xx_set_ichg = bq256xx_set_ichg_curr,
+ .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
+ .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
+ .bq256xx_set_iterm = bq256xx_set_term_curr,
+ .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
+ .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
+
+ .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
+ .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
+ .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
+ .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
+ .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
+ .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
+
+ .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
+ .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
+
+ .has_usb_detect = true,
+ },
+
+ [BQ25601] = {
+ .model_id = BQ25601,
+ .bq256xx_regmap_config = &bq25600_regmap_config,
+ .bq256xx_get_ichg = bq256xx_get_ichg_curr,
+ .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
+ .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
+ .bq256xx_get_iterm = bq256xx_get_term_curr,
+ .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
+ .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
+
+ .bq256xx_set_ichg = bq256xx_set_ichg_curr,
+ .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
+ .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
+ .bq256xx_set_iterm = bq256xx_set_term_curr,
+ .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
+ .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
+
+ .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
+ .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
+ .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
+ .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
+ .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
+ .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
+
+ .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
+ .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
+
+ .has_usb_detect = false,
+ },
+
+ [BQ25601D] = {
+ .model_id = BQ25601D,
+ .bq256xx_regmap_config = &bq25600_regmap_config,
+ .bq256xx_get_ichg = bq256xx_get_ichg_curr,
+ .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
+ .bq256xx_get_vbatreg = bq25601d_get_chrg_volt,
+ .bq256xx_get_iterm = bq256xx_get_term_curr,
+ .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
+ .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
+
+ .bq256xx_set_ichg = bq256xx_set_ichg_curr,
+ .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
+ .bq256xx_set_vbatreg = bq25601d_set_chrg_volt,
+ .bq256xx_set_iterm = bq256xx_set_term_curr,
+ .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
+ .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
+
+ .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
+ .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
+ .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
+ .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
+ .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
+ .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
+
+ .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
+ .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
+
+ .has_usb_detect = true,
+ },
+
+ [BQ25611D] = {
+ .model_id = BQ25611D,
+ .bq256xx_regmap_config = &bq25611d_regmap_config,
+ .bq256xx_get_ichg = bq256xx_get_ichg_curr,
+ .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
+ .bq256xx_get_vbatreg = bq25611d_get_chrg_volt,
+ .bq256xx_get_iterm = bq256xx_get_term_curr,
+ .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
+ .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
+
+ .bq256xx_set_ichg = bq256xx_set_ichg_curr,
+ .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
+ .bq256xx_set_vbatreg = bq25611d_set_chrg_volt,
+ .bq256xx_set_iterm = bq256xx_set_term_curr,
+ .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
+ .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
+
+ .bq256xx_def_ichg = BQ25611D_ICHG_DEF_uA,
+ .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
+ .bq256xx_def_vbatreg = BQ25611D_VBATREG_DEF_uV,
+ .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
+ .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
+ .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
+
+ .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
+ .bq256xx_max_vbatreg = BQ25611D_VBATREG_MAX_uV,
+
+ .has_usb_detect = true,
+ },
+
+ [BQ25618] = {
+ .model_id = BQ25618,
+ .bq256xx_regmap_config = &bq25618_619_regmap_config,
+ .bq256xx_get_ichg = bq25618_619_get_ichg_curr,
+ .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
+ .bq256xx_get_vbatreg = bq25618_619_get_chrg_volt,
+ .bq256xx_get_iterm = bq25618_619_get_term_curr,
+ .bq256xx_get_iprechg = bq25618_619_get_prechrg_curr,
+ .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
+
+ .bq256xx_set_ichg = bq25618_619_set_ichg_curr,
+ .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
+ .bq256xx_set_vbatreg = bq25618_619_set_chrg_volt,
+ .bq256xx_set_iterm = bq25618_619_set_term_curr,
+ .bq256xx_set_iprechg = bq25618_619_set_prechrg_curr,
+ .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
+
+ .bq256xx_def_ichg = BQ25618_ICHG_DEF_uA,
+ .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
+ .bq256xx_def_vbatreg = BQ25618_VBATREG_DEF_uV,
+ .bq256xx_def_iterm = BQ25618_ITERM_DEF_uA,
+ .bq256xx_def_iprechg = BQ25618_IPRECHG_DEF_uA,
+ .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
+
+ .bq256xx_max_ichg = BQ25618_ICHG_MAX_uA,
+ .bq256xx_max_vbatreg = BQ25618_VBATREG_MAX_uV,
+
+ .has_usb_detect = false,
+ },
+
+ [BQ25619] = {
+ .model_id = BQ25619,
+ .bq256xx_regmap_config = &bq25618_619_regmap_config,
+ .bq256xx_get_ichg = bq25618_619_get_ichg_curr,
+ .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
+ .bq256xx_get_vbatreg = bq25618_619_get_chrg_volt,
+ .bq256xx_get_iterm = bq25618_619_get_term_curr,
+ .bq256xx_get_iprechg = bq25618_619_get_prechrg_curr,
+ .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
+
+ .bq256xx_set_ichg = bq25618_619_set_ichg_curr,
+ .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
+ .bq256xx_set_vbatreg = bq25618_619_set_chrg_volt,
+ .bq256xx_set_iterm = bq25618_619_set_term_curr,
+ .bq256xx_set_iprechg = bq25618_619_set_prechrg_curr,
+ .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
+
+ .bq256xx_def_ichg = BQ25618_ICHG_DEF_uA,
+ .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
+ .bq256xx_def_vbatreg = BQ25618_VBATREG_DEF_uV,
+ .bq256xx_def_iterm = BQ25618_ITERM_DEF_uA,
+ .bq256xx_def_iprechg = BQ25618_IPRECHG_DEF_uA,
+ .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
+
+ .bq256xx_max_ichg = BQ25618_ICHG_MAX_uA,
+ .bq256xx_max_vbatreg = BQ25618_VBATREG_MAX_uV,
+
+ .has_usb_detect = false,
+ },
+};
+
+static int bq256xx_power_supply_init(struct bq256xx_device *bq,
+ struct device *dev)
+{
+ struct power_supply_config psy_cfg = { .drv_data = bq,
+ .of_node = dev->of_node, };
+
+ psy_cfg.supplied_to = bq256xx_charger_supplied_to;
+ psy_cfg.num_supplicants = ARRAY_SIZE(bq256xx_charger_supplied_to);
+
+ bq->charger = devm_power_supply_register(bq->dev,
+ &bq256xx_power_supply_desc,
+ &psy_cfg);
+ if (IS_ERR(bq->charger))
+ return -EINVAL;
+
+ bq->battery = devm_power_supply_register(bq->dev,
+ &bq256xx_battery_desc,
+ &psy_cfg);
+ if (IS_ERR(bq->battery))
+ return -EINVAL;
+
+ return 0;
+}
+
+static int bq256xx_hw_init(struct bq256xx_device *bq)
+{
+ struct power_supply_battery_info bat_info = { };
+ int wd_reg_val = BQ256XX_WATCHDOG_DIS;
+ int ret = 0;
+ int i;
+
+ for (i = 0; i < BQ256XX_NUM_WD_VAL; i++) {
+ if (bq->watchdog_timer > bq256xx_watchdog_time[i] &&
+ bq->watchdog_timer < bq256xx_watchdog_time[i + 1])
+ wd_reg_val = i;
+ }
+ ret = regmap_update_bits(bq->regmap, BQ256XX_CHARGER_CONTROL_1,
+ BQ256XX_WATCHDOG_MASK, wd_reg_val <<
+ BQ256XX_WDT_BIT_SHIFT);
+
+ ret = power_supply_get_battery_info(bq->charger, &bat_info);
+ if (ret) {
+ dev_warn(bq->dev, "battery info missing, default values will be applied\n");
+
+ bat_info.constant_charge_current_max_ua =
+ bq->chip_info->bq256xx_def_ichg;
+
+ bat_info.constant_charge_voltage_max_uv =
+ bq->chip_info->bq256xx_def_vbatreg;
+
+ bat_info.precharge_current_ua =
+ bq->chip_info->bq256xx_def_iprechg;
+
+ bat_info.charge_term_current_ua =
+ bq->chip_info->bq256xx_def_iterm;
+
+ bq->init_data.ichg_max =
+ bq->chip_info->bq256xx_max_ichg;
+
+ bq->init_data.vbatreg_max =
+ bq->chip_info->bq256xx_max_vbatreg;
+ } else {
+ bq->init_data.ichg_max =
+ bat_info.constant_charge_current_max_ua;
+
+ bq->init_data.vbatreg_max =
+ bat_info.constant_charge_voltage_max_uv;
+ }
+
+ ret = bq->chip_info->bq256xx_set_vindpm(bq, bq->init_data.vindpm);
+ if (ret)
+ goto err_out;
+
+ ret = bq->chip_info->bq256xx_set_iindpm(bq, bq->init_data.iindpm);
+ if (ret)
+ goto err_out;
+
+ ret = bq->chip_info->bq256xx_set_ichg(bq,
+ bat_info.constant_charge_current_max_ua);
+ if (ret)
+ goto err_out;
+
+ ret = bq->chip_info->bq256xx_set_iprechg(bq,
+ bat_info.precharge_current_ua);
+ if (ret)
+ goto err_out;
+
+ ret = bq->chip_info->bq256xx_set_vbatreg(bq,
+ bat_info.constant_charge_voltage_max_uv);
+ if (ret)
+ goto err_out;
+
+ ret = bq->chip_info->bq256xx_set_iterm(bq,
+ bat_info.charge_term_current_ua);
+ if (ret)
+ goto err_out;
+
+ power_supply_put_battery_info(bq->charger, &bat_info);
+
+ return 0;
+
+err_out:
+ return ret;
+}
+
+static int bq256xx_parse_dt(struct bq256xx_device *bq)
+{
+ int ret = 0;
+
+ ret = device_property_read_u32(bq->dev, "ti,watchdog-timeout-ms",
+ &bq->watchdog_timer);
+ if (ret)
+ bq->watchdog_timer = BQ256XX_WATCHDOG_DIS;
+
+ if (bq->watchdog_timer > BQ256XX_WATCHDOG_MAX ||
+ bq->watchdog_timer < BQ256XX_WATCHDOG_DIS)
+ return -EINVAL;
+
+ ret = device_property_read_u32(bq->dev,
+ "input-voltage-limit-microvolt",
+ &bq->init_data.vindpm);
+ if (ret)
+ bq->init_data.vindpm = bq->chip_info->bq256xx_def_vindpm;
+
+ ret = device_property_read_u32(bq->dev,
+ "input-current-limit-microamp",
+ &bq->init_data.iindpm);
+ if (ret)
+ bq->init_data.iindpm = bq->chip_info->bq256xx_def_iindpm;
+
+ return 0;
+}
+
+static int bq256xx_probe(struct i2c_client *client,
+ const struct i2c_device_id *id)
+{
+ struct device *dev = &client->dev;
+ struct bq256xx_device *bq;
+ int ret;
+
+ bq = devm_kzalloc(dev, sizeof(*bq), GFP_KERNEL);
+ if (!bq)
+ return -ENOMEM;
+
+ bq->client = client;
+ bq->dev = dev;
+ bq->chip_info = &bq256xx_chip_info_tbl[id->driver_data];
+
+ mutex_init(&bq->lock);
+
+ strncpy(bq->model_name, id->name, I2C_NAME_SIZE);
+
+ bq->regmap = devm_regmap_init_i2c(client,
+ bq->chip_info->bq256xx_regmap_config);
+
+ if (IS_ERR(bq->regmap)) {
+ dev_err(dev, "Failed to allocate register map\n");
+ return PTR_ERR(bq->regmap);
+ }
+
+ i2c_set_clientdata(client, bq);
+
+ ret = bq256xx_parse_dt(bq);
+ if (ret) {
+ dev_err(dev, "Failed to read device tree properties%d\n", ret);
+ return ret;
+ }
+
+ /* OTG reporting */
+ bq->usb2_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2);
+ if (!IS_ERR_OR_NULL(bq->usb2_phy)) {
+ INIT_WORK(&bq->usb_work, bq256xx_usb_work);
+ bq->usb_nb.notifier_call = bq256xx_usb_notifier;
+ usb_register_notifier(bq->usb2_phy, &bq->usb_nb);
+ }
+
+ bq->usb3_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3);
+ if (!IS_ERR_OR_NULL(bq->usb3_phy)) {
+ INIT_WORK(&bq->usb_work, bq256xx_usb_work);
+ bq->usb_nb.notifier_call = bq256xx_usb_notifier;
+ usb_register_notifier(bq->usb3_phy, &bq->usb_nb);
+ }
+
+ if (client->irq) {
+ ret = devm_request_threaded_irq(dev, client->irq, NULL,
+ bq256xx_irq_handler_thread,
+ IRQF_TRIGGER_FALLING |
+ IRQF_ONESHOT,
+ dev_name(&client->dev), bq);
+ if (ret)
+ goto error_out;
+ }
+
+ ret = devm_add_action_or_reset(dev, bq256xx_charger_reset, bq);
+ if (ret)
+ goto error_out;
+
+ ret = bq256xx_power_supply_init(bq, dev);
+ if (ret) {
+ dev_err(dev, "Failed to register power supply\n");
+ goto error_out;
+ }
+
+ ret = bq256xx_hw_init(bq);
+ if (ret) {
+ dev_err(dev, "Cannot initialize the chip.\n");
+ goto error_out;
+ }
+
+ return ret;
+
+error_out:
+ if (!IS_ERR_OR_NULL(bq->usb2_phy))
+ usb_unregister_notifier(bq->usb2_phy, &bq->usb_nb);
+
+ if (!IS_ERR_OR_NULL(bq->usb3_phy))
+ usb_unregister_notifier(bq->usb3_phy, &bq->usb_nb);
+ return ret;
+}
+
+static int bq256xx_remove(struct i2c_client *client)
+{
+ struct bq256xx_device *bq = i2c_get_clientdata(client);
+
+ power_supply_unregister(bq->charger);
+
+ if (!IS_ERR_OR_NULL(bq->usb2_phy))
+ usb_unregister_notifier(bq->usb2_phy, &bq->usb_nb);
+
+ if (!IS_ERR_OR_NULL(bq->usb3_phy))
+ usb_unregister_notifier(bq->usb3_phy, &bq->usb_nb);
+
+ bq256xx_charger_reset(bq);
+
+ return 0;
+}
+
+static const struct i2c_device_id bq256xx_i2c_ids[] = {
+ { "bq25600", BQ25600 },
+ { "bq25600d", BQ25600D },
+ { "bq25601", BQ25601 },
+ { "bq25601d", BQ25601D },
+ { "bq25611d", BQ25611D },
+ { "bq25618", BQ25618 },
+ { "bq25619", BQ25619 },
+ {},
+};
+MODULE_DEVICE_TABLE(i2c, bq256xx_i2c_ids);
+
+static const struct of_device_id bq256xx_of_match[] = {
+ { .compatible = "ti,bq25600", .data = (void *)BQ25600 },
+ { .compatible = "ti,bq25600d", .data = (void *)BQ25600D },
+ { .compatible = "ti,bq25601", .data = (void *)BQ25601 },
+ { .compatible = "ti,bq25601d", .data = (void *)BQ25601D },
+ { .compatible = "ti,bq25611d", .data = (void *)BQ25611D },
+ { .compatible = "ti,bq25618", .data = (void *)BQ25618 },
+ { .compatible = "ti,bq25619", .data = (void *)BQ25619 },
+ { },
+};
+MODULE_DEVICE_TABLE(of, bq256xx_of_match);
+
+static const struct acpi_device_id bq256xx_acpi_match[] = {
+ { "bq25600", BQ25600 },
+ { "bq25600d", BQ25600D },
+ { "bq25601", BQ25601 },
+ { "bq25601d", BQ25601D },
+ { "bq25611d", BQ25611D },
+ { "bq25618", BQ25618 },
+ { "bq25619", BQ25619 },
+ {},
+};
+MODULE_DEVICE_TABLE(acpi, bq256xx_acpi_match);
+
+static struct i2c_driver bq256xx_driver = {
+ .driver = {
+ .name = "bq256xx-charger",
+ .of_match_table = bq256xx_of_match,
+ .acpi_match_table = ACPI_PTR(bq256xx_acpi_match),
+ },
+ .probe = bq256xx_probe,
+ .remove = bq256xx_remove,
+ .id_table = bq256xx_i2c_ids,
+};
+module_i2c_driver(bq256xx_driver);
+
+MODULE_AUTHOR("Ricardo Rivera-Matos <[email protected]>");
+MODULE_DESCRIPTION("bq256xx charger driver");
+MODULE_LICENSE("GPL v2");
--
2.28.0
Hi Ricardo,
On Mon, Oct 05, 2020 at 04:47:09PM -0500, Ricardo Rivera-Matos wrote:
> The BQ256XX family of devices are highly integrated buck chargers
> for single cell batteries.
>
> Signed-off-by: Ricardo Rivera-Matos <[email protected]>
>
> v5 - adds power_supply_put_battery_info() and devm_add_action_or_rest() calls
>
> v6 - implements bq256xx_remove function
v6 unfortunately makes things worse. You might want to read some
background information about managed resources:
https://lwn.net/Articles/222860/
https://www.kernel.org/doc/html/latest/driver-api/driver-model/devres.html
> ---
> drivers/power/supply/Kconfig | 11 +
> drivers/power/supply/Makefile | 1 +
> drivers/power/supply/bq256xx_charger.c | 1803 ++++++++++++++++++++++++
> 3 files changed, 1815 insertions(+)
> create mode 100644 drivers/power/supply/bq256xx_charger.c
>
> diff --git a/drivers/power/supply/Kconfig b/drivers/power/supply/Kconfig
> index 44d3c8512fb8..87d852914bc2 100644
> --- a/drivers/power/supply/Kconfig
> +++ b/drivers/power/supply/Kconfig
> @@ -618,6 +618,17 @@ config CHARGER_BQ25890
> help
> Say Y to enable support for the TI BQ25890 battery charger.
>
> +config CHARGER_BQ256XX
> + tristate "TI BQ256XX battery charger driver"
> + depends on I2C
> + depends on GPIOLIB || COMPILE_TEST
> + select REGMAP_I2C
> + help
> + Say Y to enable support for the TI BQ256XX battery chargers. The
> + BQ256XX family of devices are highly-integrated, switch-mode battery
> + charge management and system power path management devices for single
> + cell Li-ion and Li-polymer batteries.
> +
> config CHARGER_SMB347
> tristate "Summit Microelectronics SMB347 Battery Charger"
> depends on I2C
> diff --git a/drivers/power/supply/Makefile b/drivers/power/supply/Makefile
> index b9644663e435..e762442c7cc6 100644
> --- a/drivers/power/supply/Makefile
> +++ b/drivers/power/supply/Makefile
> @@ -83,6 +83,7 @@ obj-$(CONFIG_CHARGER_BQ24190) += bq24190_charger.o
> obj-$(CONFIG_CHARGER_BQ24257) += bq24257_charger.o
> obj-$(CONFIG_CHARGER_BQ24735) += bq24735-charger.o
> obj-$(CONFIG_CHARGER_BQ25890) += bq25890_charger.o
> +obj-$(CONFIG_CHARGER_BQ256XX) += bq256xx_charger.o
> obj-$(CONFIG_CHARGER_SMB347) += smb347-charger.o
> obj-$(CONFIG_CHARGER_TPS65090) += tps65090-charger.o
> obj-$(CONFIG_CHARGER_TPS65217) += tps65217_charger.o
> diff --git a/drivers/power/supply/bq256xx_charger.c b/drivers/power/supply/bq256xx_charger.c
> new file mode 100644
> index 000000000000..b9caec10c456
> --- /dev/null
> +++ b/drivers/power/supply/bq256xx_charger.c
> @@ -0,0 +1,1803 @@
> +// SPDX-License-Identifier: GPL-2.0
> +// BQ256XX Battery Charger Driver
> +// Copyright (C) 2020 Texas Instruments Incorporated - http://www.ti.com/
> +
> +#include <linux/err.h>
> +#include <linux/i2c.h>
> +#include <linux/init.h>
> +#include <linux/interrupt.h>
> +#include <linux/kernel.h>
> +#include <linux/module.h>
> +#include <linux/gpio/consumer.h>
> +#include <linux/power_supply.h>
> +#include <linux/regmap.h>
> +#include <linux/types.h>
> +#include <linux/usb/phy.h>
> +#include <linux/device.h>
> +#include <linux/moduleparam.h>
> +#include <linux/slab.h>
> +#include <linux/acpi.h>
> +
> +#define BQ256XX_MANUFACTURER "Texas Instruments"
> +
> +#define BQ256XX_INPUT_CURRENT_LIMIT 0x00
> +#define BQ256XX_CHARGER_CONTROL_0 0x01
> +#define BQ256XX_CHARGE_CURRENT_LIMIT 0x02
> +#define BQ256XX_PRECHG_AND_TERM_CURR_LIM 0x03
> +#define BQ256XX_BATTERY_VOLTAGE_LIMIT 0x04
> +#define BQ256XX_CHARGER_CONTROL_1 0x05
> +#define BQ256XX_CHARGER_CONTROL_2 0x06
> +#define BQ256XX_CHARGER_CONTROL_3 0x07
> +#define BQ256XX_CHARGER_STATUS_0 0x08
> +#define BQ256XX_CHARGER_STATUS_1 0x09
> +#define BQ256XX_CHARGER_STATUS_2 0x0a
> +#define BQ256XX_PART_INFORMATION 0x0b
> +#define BQ256XX_CHARGER_CONTROL_4 0x0c
> +
> +#define BQ256XX_IINDPM_MASK GENMASK(4, 0)
> +#define BQ256XX_IINDPM_STEP_uA 100000
> +#define BQ256XX_IINDPM_OFFSET_uA 100000
> +#define BQ256XX_IINDPM_MIN_uA 100000
> +#define BQ256XX_IINDPM_MAX_uA 3200000
> +#define BQ256XX_IINDPM_DEF_uA 2400000
> +
> +#define BQ256XX_VINDPM_MASK GENMASK(3, 0)
> +#define BQ256XX_VINDPM_STEP_uV 100000
> +#define BQ256XX_VINDPM_OFFSET_uV 3900000
> +#define BQ256XX_VINDPM_MIN_uV 3900000
> +#define BQ256XX_VINDPM_MAX_uV 5400000
> +#define BQ256XX_VINDPM_DEF_uV 4500000
> +
> +#define BQ256XX_VBATREG_MASK GENMASK(7, 3)
> +#define BQ2560X_VBATREG_STEP_uV 32000
> +#define BQ2560X_VBATREG_OFFSET_uV 3856000
> +#define BQ2560X_VBATREG_MIN_uV 3856000
> +#define BQ2560X_VBATREG_MAX_uV 4624000
> +#define BQ2560X_VBATREG_DEF_uV 4208000
> +#define BQ25601D_VBATREG_OFFSET_uV 3847000
> +#define BQ25601D_VBATREG_MIN_uV 3847000
> +#define BQ25601D_VBATREG_MAX_uV 4615000
> +#define BQ25601D_VBATREG_DEF_uV 4199000
> +#define BQ2561X_VBATREG_STEP_uV 10000
> +#define BQ25611D_VBATREG_MIN_uV 3494000
> +#define BQ25611D_VBATREG_MAX_uV 4510000
> +#define BQ25611D_VBATREG_DEF_uV 4190000
> +#define BQ25618_VBATREG_MIN_uV 3504000
> +#define BQ25618_VBATREG_MAX_uV 4500000
> +#define BQ25618_VBATREG_DEF_uV 4200000
> +#define BQ256XX_VBATREG_BIT_SHIFT 3
> +#define BQ2561X_VBATREG_THRESH 0x8
> +#define BQ25611D_VBATREG_THRESH_uV 4290000
> +#define BQ25618_VBATREG_THRESH_uV 4300000
> +
> +#define BQ256XX_ITERM_MASK GENMASK(3, 0)
> +#define BQ256XX_ITERM_STEP_uA 60000
> +#define BQ256XX_ITERM_OFFSET_uA 60000
> +#define BQ256XX_ITERM_MIN_uA 60000
> +#define BQ256XX_ITERM_MAX_uA 780000
> +#define BQ256XX_ITERM_DEF_uA 180000
> +#define BQ25618_ITERM_STEP_uA 20000
> +#define BQ25618_ITERM_OFFSET_uA 20000
> +#define BQ25618_ITERM_MIN_uA 20000
> +#define BQ25618_ITERM_MAX_uA 260000
> +#define BQ25618_ITERM_DEF_uA 60000
> +
> +#define BQ256XX_IPRECHG_MASK GENMASK(7, 4)
> +#define BQ256XX_IPRECHG_STEP_uA 60000
> +#define BQ256XX_IPRECHG_OFFSET_uA 60000
> +#define BQ256XX_IPRECHG_MIN_uA 60000
> +#define BQ256XX_IPRECHG_MAX_uA 780000
> +#define BQ256XX_IPRECHG_DEF_uA 180000
> +#define BQ25618_IPRECHG_STEP_uA 20000
> +#define BQ25618_IPRECHG_OFFSET_uA 20000
> +#define BQ25618_IPRECHG_MIN_uA 20000
> +#define BQ25618_IPRECHG_MAX_uA 260000
> +#define BQ25618_IPRECHG_DEF_uA 40000
> +#define BQ256XX_IPRECHG_BIT_SHIFT 4
> +
> +#define BQ256XX_ICHG_MASK GENMASK(5, 0)
> +#define BQ256XX_ICHG_STEP_uA 60000
> +#define BQ256XX_ICHG_MIN_uA 0
> +#define BQ256XX_ICHG_MAX_uA 3000000
> +#define BQ2560X_ICHG_DEF_uA 2040000
> +#define BQ25611D_ICHG_DEF_uA 1020000
> +#define BQ25618_ICHG_STEP_uA 20000
> +#define BQ25618_ICHG_MIN_uA 0
> +#define BQ25618_ICHG_MAX_uA 1500000
> +#define BQ25618_ICHG_DEF_uA 340000
> +#define BQ25618_ICHG_THRESH 0x3c
> +#define BQ25618_ICHG_THRESH_uA 1180000
> +
> +#define BQ256XX_VBUS_STAT_MASK GENMASK(7, 5)
> +#define BQ256XX_VBUS_STAT_NO_INPUT 0
> +#define BQ256XX_VBUS_STAT_USB_SDP BIT(5)
> +#define BQ256XX_VBUS_STAT_USB_CDP BIT(6)
> +#define BQ256XX_VBUS_STAT_USB_DCP (BIT(6) | BIT(5))
> +#define BQ256XX_VBUS_STAT_USB_OTG (BIT(7) | BIT(6) | BIT(5))
> +
> +#define BQ256XX_CHRG_STAT_MASK GENMASK(4, 3)
> +#define BQ256XX_CHRG_STAT_NOT_CHRGING 0
> +#define BQ256XX_CHRG_STAT_PRECHRGING BIT(3)
> +#define BQ256XX_CHRG_STAT_FAST_CHRGING BIT(4)
> +#define BQ256XX_CHRG_STAT_CHRG_TERM (BIT(4) | BIT(3))
> +
> +#define BQ256XX_PG_STAT_MASK BIT(2)
> +#define BQ256XX_WDT_FAULT_MASK BIT(7)
> +#define BQ256XX_CHRG_FAULT_MASK GENMASK(5, 4)
> +#define BQ256XX_CHRG_FAULT_NORMAL 0
> +#define BQ256XX_CHRG_FAULT_INPUT BIT(4)
> +#define BQ256XX_CHRG_FAULT_THERM BIT(5)
> +#define BQ256XX_CHRG_FAULT_CST_EXPIRE (BIT(5) | BIT(4))
> +#define BQ256XX_BAT_FAULT_MASK BIT(3)
> +#define BQ256XX_NTC_FAULT_MASK GENMASK(2, 0)
> +#define BQ256XX_NTC_FAULT_WARM BIT(1)
> +#define BQ256XX_NTC_FAULT_COOL (BIT(1) | BIT(0))
> +#define BQ256XX_NTC_FAULT_COLD (BIT(2) | BIT(0))
> +#define BQ256XX_NTC_FAULT_HOT (BIT(2) | BIT(1))
> +
> +#define BQ256XX_NUM_WD_VAL 8
> +#define BQ256XX_WATCHDOG_MASK GENMASK(5, 4)
> +#define BQ256XX_WATCHDOG_MAX 1600000
> +#define BQ256XX_WATCHDOG_DIS 0
> +#define BQ256XX_WDT_BIT_SHIFT 4
> +
> +#define BQ256XX_REG_RST BIT(7)
> +
> +/**
> + * struct bq256xx_init_data -
> + * @ichg: fast charge current
> + * @iindpm: input current limit
> + * @vbatreg: charge voltage
> + * @iterm: termination current
> + * @iprechg: precharge current
> + * @vindpm: input voltage limit
> + * @ichg_max: maximum fast charge current
> + * @vbatreg_max: maximum charge voltage
> + */
> +struct bq256xx_init_data {
> + u32 ichg;
> + u32 iindpm;
> + u32 vbatreg;
> + u32 iterm;
> + u32 iprechg;
> + u32 vindpm;
> + u32 ichg_max;
> + u32 vbatreg_max;
> +};
> +
> +/**
> + * struct bq256xx_state -
> + * @vbus_stat: VBUS status according to BQ256XX_CHARGER_STATUS_0
> + * @chrg_stat: charging status according to BQ256XX_CHARGER_STATUS_0
> + * @online: PG status according to BQ256XX_CHARGER_STATUS_0
> + *
> + * @wdt_fault: watchdog fault according to BQ256XX_CHARGER_STATUS_1
> + * @bat_fault: battery fault according to BQ256XX_CHARGER_STATUS_1
> + * @chrg_fault: charging fault according to BQ256XX_CHARGER_STATUS_1
> + * @ntc_fault: TS fault according to BQ256XX_CHARGER_STATUS_1
> + */
> +struct bq256xx_state {
> + u8 vbus_stat;
> + u8 chrg_stat;
> + bool online;
> +
> + u8 wdt_fault;
> + u8 bat_fault;
> + u8 chrg_fault;
> + u8 ntc_fault;
> +};
> +
> +enum bq256xx_id {
> + BQ25600,
> + BQ25600D,
> + BQ25601,
> + BQ25601D,
> + BQ25618,
> + BQ25619,
> + BQ25611D,
> +};
> +
> +/**
> + * struct bq256xx_device -
> + * @client: i2c client structure
> + * @regmap: register map structure
> + * @dev: device structure
> + * @lock: mutex lock structure
> + *
> + * @usb2_phy: usb_phy identifier
> + * @usb3_phy: usb_phy identifier
> + * @usb_nb: notifier block
> + * @usb_work: usb work queue
> + * @usb_event: usb_event code
> + *
> + * @model_name: i2c name string
> + *
> + * @init_data: initialization data
> + * @chip_info: device variant information
> + * @state: device status and faults
> + * @watchdog_timer: watchdog timer value in milliseconds
> + */
> +struct bq256xx_device {
> + struct i2c_client *client;
> + struct device *dev;
> + struct power_supply *charger;
> + struct power_supply *battery;
> + struct mutex lock;
> + struct regmap *regmap;
> +
> + struct usb_phy *usb2_phy;
> + struct usb_phy *usb3_phy;
> + struct notifier_block usb_nb;
> + struct work_struct usb_work;
> + unsigned long usb_event;
> +
> + char model_name[I2C_NAME_SIZE];
> +
> + struct bq256xx_init_data init_data;
> + const struct bq256xx_chip_info *chip_info;
> + struct bq256xx_state state;
> + int watchdog_timer;
> +};
> +
> +/**
> + * struct bq256xx_chip_info -
> + * @model_id: device instance
> + *
> + * @bq256xx_regmap_config: regmap configuration struct
> + * @bq256xx_get_ichg: pointer to instance specific get_ichg function
> + * @bq256xx_get_iindpm: pointer to instance specific get_iindpm function
> + * @bq256xx_get_vbatreg: pointer to instance specific get_vbatreg function
> + * @bq256xx_get_iterm: pointer to instance specific get_iterm function
> + * @bq256xx_get_iprechg: pointer to instance specific get_iprechg function
> + * @bq256xx_get_vindpm: pointer to instance specific get_vindpm function
> + *
> + * @bq256xx_set_ichg: pointer to instance specific set_ichg function
> + * @bq256xx_set_iindpm: pointer to instance specific set_iindpm function
> + * @bq256xx_set_vbatreg: pointer to instance specific set_vbatreg function
> + * @bq256xx_set_iterm: pointer to instance specific set_iterm function
> + * @bq256xx_set_iprechg: pointer to instance specific set_iprechg function
> + * @bq256xx_set_vindpm: pointer to instance specific set_vindpm function
> + *
> + * @bq256xx_def_ichg: default ichg value in microamps
> + * @bq256xx_def_iindpm: default iindpm value in microamps
> + * @bq256xx_def_vbatreg: default vbatreg value in microvolts
> + * @bq256xx_def_iterm: default iterm value in microamps
> + * @bq256xx_def_iprechg: default iprechg value in microamps
> + * @bq256xx_def_vindpm: default vindpm value in microvolts
> + *
> + * @bq256xx_max_ichg: maximum charge current in microamps
> + * @bq256xx_max_vbatreg: maximum battery regulation voltage in microvolts
> + *
> + * @has_usb_detect: indicates whether device has BC1.2 detection
> + */
> +struct bq256xx_chip_info {
> + int model_id;
> +
> + const struct regmap_config *bq256xx_regmap_config;
> +
> + int (*bq256xx_get_ichg)(struct bq256xx_device *bq);
> + int (*bq256xx_get_iindpm)(struct bq256xx_device *bq);
> + int (*bq256xx_get_vbatreg)(struct bq256xx_device *bq);
> + int (*bq256xx_get_iterm)(struct bq256xx_device *bq);
> + int (*bq256xx_get_iprechg)(struct bq256xx_device *bq);
> + int (*bq256xx_get_vindpm)(struct bq256xx_device *bq);
> +
> + int (*bq256xx_set_ichg)(struct bq256xx_device *bq, int ichg);
> + int (*bq256xx_set_iindpm)(struct bq256xx_device *bq, int iindpm);
> + int (*bq256xx_set_vbatreg)(struct bq256xx_device *bq, int vbatreg);
> + int (*bq256xx_set_iterm)(struct bq256xx_device *bq, int iterm);
> + int (*bq256xx_set_iprechg)(struct bq256xx_device *bq, int iprechg);
> + int (*bq256xx_set_vindpm)(struct bq256xx_device *bq, int vindpm);
> +
> + int bq256xx_def_ichg;
> + int bq256xx_def_iindpm;
> + int bq256xx_def_vbatreg;
> + int bq256xx_def_iterm;
> + int bq256xx_def_iprechg;
> + int bq256xx_def_vindpm;
> +
> + int bq256xx_max_ichg;
> + int bq256xx_max_vbatreg;
> +
> + bool has_usb_detect;
> +};
> +
> +static int bq256xx_watchdog_time[BQ256XX_NUM_WD_VAL] = {
> + 0, 40000, 80000, 1600000
> +};
> +
> +static const int bq25611d_vbatreg_values[] = {
> + 3494000, 3590000, 3686000, 3790000, 3894000, 3990000, 4090000, 4140000,
> + 4190000
> +};
> +
> +static const int bq25618_619_vbatreg_values[] = {
> + 3504000, 3600000, 3696000, 3800000, 3904000, 4000000, 4100000, 4150000,
> + 4200000
> +};
> +
> +static const int bq25618_619_ichg_values[] = {
> + 1290000, 1360000, 1430000, 1500000
> +};
> +
> +static enum power_supply_usb_type bq256xx_usb_type[] = {
> + POWER_SUPPLY_USB_TYPE_SDP,
> + POWER_SUPPLY_USB_TYPE_CDP,
> + POWER_SUPPLY_USB_TYPE_DCP,
> + POWER_SUPPLY_USB_TYPE_UNKNOWN,
> + POWER_SUPPLY_USB_TYPE_ACA,
> +};
> +
> +static int bq256xx_array_parse(int array_size, int val, const int array[])
> +{
> + int i = 0;
> +
> + if (val < array[i])
> + return i - 1;
You probably want to return 0 here?
> +
> + if (val >= array[array_size - 1])
> + return array_size - 1;
> +
> + for (i = 1; i < array_size; i++) {
> + if (val == array[i])
> + return i;
> +
> + if (val > array[i - 1] && val < array[i]) {
> + if (val < array[i])
> + return i - 1;
> + else
> + return i;
> + }
> + }
> + return -EINVAL;
> +}
> +
> +static int bq256xx_usb_notifier(struct notifier_block *nb, unsigned long val,
> + void *priv)
> +{
> + struct bq256xx_device *bq =
> + container_of(nb, struct bq256xx_device, usb_nb);
> +
> + bq->usb_event = val;
> + queue_work(system_power_efficient_wq, &bq->usb_work);
> +
> + return NOTIFY_OK;
> +}
> +
> +static void bq256xx_usb_work(struct work_struct *data)
> +{
> + struct bq256xx_device *bq =
> + container_of(data, struct bq256xx_device, usb_work);
> +
> + switch (bq->usb_event) {
> + case USB_EVENT_ID:
> + break;
> +
> + case USB_EVENT_NONE:
> + power_supply_changed(bq->charger);
> + break;
> + default:
> + dev_err(bq->dev, "Error switching to charger mode.\n");
> + break;
> + }
> +}
> +
> +static struct reg_default bq2560x_reg_defs[] = {
> + {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
> + {BQ256XX_CHARGER_CONTROL_0, 0x1a},
> + {BQ256XX_CHARGE_CURRENT_LIMIT, 0xa2},
> + {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x22},
> + {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x58},
> + {BQ256XX_CHARGER_CONTROL_1, 0x9f},
> + {BQ256XX_CHARGER_CONTROL_2, 0x66},
> + {BQ256XX_CHARGER_CONTROL_3, 0x4c},
> +};
> +
> +static struct reg_default bq25611d_reg_defs[] = {
> + {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
> + {BQ256XX_CHARGER_CONTROL_0, 0x1a},
> + {BQ256XX_CHARGE_CURRENT_LIMIT, 0x91},
> + {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x12},
> + {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x40},
> + {BQ256XX_CHARGER_CONTROL_1, 0x9e},
> + {BQ256XX_CHARGER_CONTROL_2, 0xe6},
> + {BQ256XX_CHARGER_CONTROL_3, 0x4c},
> + {BQ256XX_PART_INFORMATION, 0x54},
> + {BQ256XX_CHARGER_CONTROL_4, 0x75},
> +};
> +
> +static struct reg_default bq25618_619_reg_defs[] = {
> + {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
> + {BQ256XX_CHARGER_CONTROL_0, 0x1a},
> + {BQ256XX_CHARGE_CURRENT_LIMIT, 0x91},
> + {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x12},
> + {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x40},
> + {BQ256XX_CHARGER_CONTROL_1, 0x9e},
> + {BQ256XX_CHARGER_CONTROL_2, 0xe6},
> + {BQ256XX_CHARGER_CONTROL_3, 0x4c},
> + {BQ256XX_PART_INFORMATION, 0x2c},
> + {BQ256XX_CHARGER_CONTROL_4, 0x75},
> +};
> +
> +static int bq256xx_get_state(struct bq256xx_device *bq,
> + struct bq256xx_state *state)
> +{
> + unsigned int charger_status_0;
> + unsigned int charger_status_1;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_CHARGER_STATUS_0,
> + &charger_status_0);
> + if (ret)
> + return ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_CHARGER_STATUS_1,
> + &charger_status_1);
> + if (ret)
> + return ret;
> +
> + state->vbus_stat = charger_status_0 & BQ256XX_VBUS_STAT_MASK;
> + state->chrg_stat = charger_status_0 & BQ256XX_CHRG_STAT_MASK;
> + state->online = charger_status_0 & BQ256XX_PG_STAT_MASK;
> +
> + state->wdt_fault = charger_status_1 & BQ256XX_WDT_FAULT_MASK;
> + state->bat_fault = charger_status_1 & BQ256XX_BAT_FAULT_MASK;
> + state->chrg_fault = charger_status_1 & BQ256XX_CHRG_FAULT_MASK;
> + state->ntc_fault = charger_status_1 & BQ256XX_NTC_FAULT_MASK;
> +
> + return 0;
> +}
> +
> +static int bq256xx_get_ichg_curr(struct bq256xx_device *bq)
> +{
> + unsigned int charge_current_limit;
> + unsigned int ichg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
> + &charge_current_limit);
> + if (ret)
> + return ret;
> +
> + ichg_reg_code = charge_current_limit & BQ256XX_ICHG_MASK;
> +
> + return ichg_reg_code * BQ256XX_ICHG_STEP_uA;
> +}
> +
> +static int bq25618_619_get_ichg_curr(struct bq256xx_device *bq)
> +{
> + unsigned int charge_current_limit;
> + unsigned int ichg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
> + &charge_current_limit);
> + if (ret)
> + return ret;
> +
> + ichg_reg_code = charge_current_limit & BQ256XX_ICHG_MASK;
> +
> + if (ichg_reg_code < BQ25618_ICHG_THRESH)
> + return ichg_reg_code * BQ25618_ICHG_STEP_uA;
> +
> + return bq25618_619_ichg_values[ichg_reg_code - BQ25618_ICHG_THRESH];
> +}
> +
> +static int bq256xx_set_ichg_curr(struct bq256xx_device *bq, int ichg)
> +{
> + unsigned int ichg_reg_code;
> +
> + if (ichg < BQ256XX_ICHG_MIN_uA)
> + ichg = BQ256XX_ICHG_MIN_uA;
> + else if (ichg > bq->init_data.ichg_max)
> + ichg = bq->init_data.ichg_max;
Please replace above pattern with the following in the complete
driver:
ichg = clamp(ichg, BQ256XX_ICHG_MIN_uA, bq->init_data.ichg_max);
> +
> + ichg_reg_code = ichg / BQ256XX_ICHG_STEP_uA;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
> + BQ256XX_ICHG_MASK, ichg_reg_code);
> +}
> +
> +static int bq25618_619_set_ichg_curr(struct bq256xx_device *bq, int ichg)
> +{
> + int array_size = ARRAY_SIZE(bq25618_619_ichg_values);
> + unsigned int ichg_reg_code;
> +
> + if (ichg < BQ25618_ICHG_MIN_uA)
> + ichg = BQ25618_ICHG_MIN_uA;
> + else if (ichg > bq->init_data.ichg_max)
> + ichg = bq->init_data.ichg_max;
> +
> + if (ichg <= BQ25618_ICHG_THRESH_uA) {
> + ichg_reg_code = ichg / BQ25618_ICHG_STEP_uA;
> + } else {
> + ichg_reg_code = bq256xx_array_parse(array_size, ichg,
> + bq25618_619_ichg_values) + BQ25618_ICHG_THRESH;
> + }
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
> + BQ256XX_ICHG_MASK, ichg_reg_code);
> +}
> +
> +static int bq25618_619_get_chrg_volt(struct bq256xx_device *bq)
> +{
> + unsigned int battery_volt_lim;
> + unsigned int vbatreg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + &battery_volt_lim);
> +
> + if (ret)
> + return ret;
> +
> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
> + BQ256XX_VBATREG_BIT_SHIFT;
> +
> + if (vbatreg_reg_code > BQ2561X_VBATREG_THRESH)
> + return ((vbatreg_reg_code - BQ2561X_VBATREG_THRESH) *
> + BQ2561X_VBATREG_STEP_uV) +
> + BQ25618_VBATREG_THRESH_uV;
> +
> + return bq25618_619_vbatreg_values[vbatreg_reg_code];
> +}
> +
> +static int bq25611d_get_chrg_volt(struct bq256xx_device *bq)
> +{
> + unsigned int battery_volt_lim;
> + unsigned int vbatreg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + &battery_volt_lim);
> + if (ret)
> + return ret;
> +
> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
> + BQ256XX_VBATREG_BIT_SHIFT;
> +
> + if (vbatreg_reg_code > BQ2561X_VBATREG_THRESH)
> + return ((vbatreg_reg_code - BQ2561X_VBATREG_THRESH) *
> + BQ2561X_VBATREG_STEP_uV) +
> + BQ25611D_VBATREG_THRESH_uV;
> +
> + return bq25611d_vbatreg_values[vbatreg_reg_code];
> +}
> +
> +static int bq2560x_get_chrg_volt(struct bq256xx_device *bq)
> +{
> + unsigned int battery_volt_lim;
> + unsigned int vbatreg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + &battery_volt_lim);
> + if (ret)
> + return ret;
> +
> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
> + BQ256XX_VBATREG_BIT_SHIFT;
> +
> + return (vbatreg_reg_code * BQ2560X_VBATREG_STEP_uV)
> + + BQ2560X_VBATREG_OFFSET_uV;
> +}
> +
> +static int bq25601d_get_chrg_volt(struct bq256xx_device *bq)
> +{
> + unsigned int battery_volt_lim;
> + unsigned int vbatreg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + &battery_volt_lim);
> + if (ret)
> + return ret;
> +
> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
> + BQ256XX_VBATREG_BIT_SHIFT;
> +
> + return (vbatreg_reg_code * BQ2560X_VBATREG_STEP_uV)
> + + BQ25601D_VBATREG_OFFSET_uV;
> +}
> +
> +static int bq25618_619_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
> +{
> + int array_size = ARRAY_SIZE(bq25618_619_vbatreg_values);
> + unsigned int vbatreg_reg_code;
> +
> + if (vbatreg < BQ25618_VBATREG_MIN_uV)
> + vbatreg = BQ25618_VBATREG_MIN_uV;
> + else if (vbatreg > bq->init_data.vbatreg_max)
> + vbatreg = bq->init_data.vbatreg_max;
> +
> + if (vbatreg > BQ25618_VBATREG_THRESH_uV)
> + vbatreg_reg_code = ((vbatreg -
> + BQ25618_VBATREG_THRESH_uV) /
> + (BQ2561X_VBATREG_STEP_uV)) + BQ2561X_VBATREG_THRESH;
> + else {
> + vbatreg_reg_code = bq256xx_array_parse(array_size, vbatreg,
> + bq25618_619_vbatreg_values);
> + }
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
> + BQ256XX_VBATREG_BIT_SHIFT);
> +}
> +
> +static int bq25611d_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
> +{
> + int array_size = ARRAY_SIZE(bq25611d_vbatreg_values);
> + unsigned int vbatreg_reg_code;
> +
> + if (vbatreg < BQ25611D_VBATREG_MIN_uV)
> + vbatreg = BQ25611D_VBATREG_MIN_uV;
> + else if (vbatreg > bq->init_data.vbatreg_max)
> + vbatreg = bq->init_data.vbatreg_max;
> +
> + if (vbatreg > BQ25611D_VBATREG_THRESH_uV)
> + vbatreg_reg_code = ((vbatreg -
> + BQ25611D_VBATREG_THRESH_uV) /
> + (BQ2561X_VBATREG_STEP_uV)) + BQ2561X_VBATREG_THRESH;
> + else {
> + vbatreg_reg_code = bq256xx_array_parse(array_size, vbatreg,
> + bq25611d_vbatreg_values);
> + }
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
> + BQ256XX_VBATREG_BIT_SHIFT);
> +}
> +
> +static int bq2560x_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
> +{
> + unsigned int vbatreg_reg_code;
> +
> + if (vbatreg < BQ2560X_VBATREG_MIN_uV)
> + vbatreg = BQ2560X_VBATREG_MIN_uV;
> + else if (vbatreg > bq->init_data.vbatreg_max)
> + vbatreg = bq->init_data.vbatreg_max;
> +
> + vbatreg_reg_code = (vbatreg - BQ2560X_VBATREG_OFFSET_uV) /
> + BQ2560X_VBATREG_STEP_uV;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
> + BQ256XX_VBATREG_BIT_SHIFT);
> +}
> +
> +static int bq25601d_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
> +{
> + unsigned int vbatreg_reg_code;
> +
> + if (vbatreg < BQ25601D_VBATREG_MIN_uV)
> + vbatreg = BQ25601D_VBATREG_MIN_uV;
> + else if (vbatreg > bq->init_data.vbatreg_max)
> + vbatreg = bq->init_data.vbatreg_max;
> +
> + vbatreg_reg_code = (vbatreg - BQ25601D_VBATREG_OFFSET_uV) /
> + BQ2560X_VBATREG_STEP_uV;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
> + BQ256XX_VBATREG_BIT_SHIFT);
> +}
> +
> +static int bq256xx_get_prechrg_curr(struct bq256xx_device *bq)
> +{
> + unsigned int prechg_and_term_curr_lim;
> + unsigned int iprechg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + &prechg_and_term_curr_lim);
> + if (ret)
> + return ret;
> +
> + iprechg_reg_code = (prechg_and_term_curr_lim & BQ256XX_IPRECHG_MASK)
> + >> BQ256XX_IPRECHG_BIT_SHIFT;
> +
> + return (iprechg_reg_code * BQ256XX_IPRECHG_STEP_uA) +
> + BQ256XX_IPRECHG_OFFSET_uA;
> +}
> +
> +static int bq256xx_set_prechrg_curr(struct bq256xx_device *bq, int iprechg)
> +{
> + unsigned int iprechg_reg_code;
> +
> + if (iprechg < BQ256XX_IPRECHG_MIN_uA)
> + iprechg = BQ256XX_IPRECHG_MIN_uA;
> + else if (iprechg > BQ256XX_IPRECHG_MAX_uA)
> + iprechg = BQ256XX_IPRECHG_MAX_uA;
> +
> + iprechg_reg_code = ((iprechg - BQ256XX_IPRECHG_OFFSET_uA) /
> + BQ256XX_IPRECHG_STEP_uA) << BQ256XX_IPRECHG_BIT_SHIFT;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + BQ256XX_IPRECHG_MASK, iprechg_reg_code);
> +}
> +
> +static int bq25618_619_get_prechrg_curr(struct bq256xx_device *bq)
> +{
> + unsigned int prechg_and_term_curr_lim;
> + unsigned int iprechg_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + &prechg_and_term_curr_lim);
> + if (ret)
> + return ret;
> +
> + iprechg_reg_code = (prechg_and_term_curr_lim & BQ256XX_IPRECHG_MASK)
> + >> BQ256XX_IPRECHG_BIT_SHIFT;
> +
> + return (iprechg_reg_code * BQ25618_IPRECHG_STEP_uA) +
> + BQ25618_IPRECHG_OFFSET_uA;
> +}
> +
> +static int bq25618_619_set_prechrg_curr(struct bq256xx_device *bq, int iprechg)
> +{
> + unsigned int iprechg_reg_code;
> +
> + if (iprechg < BQ25618_IPRECHG_MIN_uA)
> + iprechg = BQ25618_IPRECHG_MIN_uA;
> + else if (iprechg > BQ25618_IPRECHG_MAX_uA)
> + iprechg = BQ25618_IPRECHG_MAX_uA;
> +
> + iprechg_reg_code = ((iprechg - BQ25618_IPRECHG_OFFSET_uA) /
> + BQ25618_IPRECHG_STEP_uA) << BQ256XX_IPRECHG_BIT_SHIFT;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + BQ256XX_IPRECHG_MASK, iprechg_reg_code);
> +}
> +
> +static int bq256xx_get_term_curr(struct bq256xx_device *bq)
> +{
> + unsigned int prechg_and_term_curr_lim;
> + unsigned int iterm_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + &prechg_and_term_curr_lim);
> + if (ret)
> + return ret;
> +
> + iterm_reg_code = prechg_and_term_curr_lim & BQ256XX_ITERM_MASK;
> +
> + return (iterm_reg_code * BQ256XX_ITERM_STEP_uA) +
> + BQ256XX_ITERM_OFFSET_uA;
> +}
> +
> +static int bq256xx_set_term_curr(struct bq256xx_device *bq, int iterm)
> +{
> + unsigned int iterm_reg_code;
> +
> + if (iterm < BQ256XX_ITERM_MIN_uA)
> + iterm = BQ256XX_ITERM_MIN_uA;
> + else if (iterm > BQ256XX_ITERM_MAX_uA)
> + iterm = BQ256XX_ITERM_MAX_uA;
> +
> + iterm_reg_code = (iterm - BQ256XX_ITERM_OFFSET_uA) /
> + BQ256XX_ITERM_STEP_uA;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + BQ256XX_ITERM_MASK, iterm_reg_code);
> +}
> +
> +static int bq25618_619_get_term_curr(struct bq256xx_device *bq)
> +{
> + unsigned int prechg_and_term_curr_lim;
> + unsigned int iterm_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + &prechg_and_term_curr_lim);
> + if (ret)
> + return ret;
> +
> + iterm_reg_code = prechg_and_term_curr_lim & BQ256XX_ITERM_MASK;
> +
> + return (iterm_reg_code * BQ25618_ITERM_STEP_uA) +
> + BQ25618_ITERM_OFFSET_uA;
> +}
> +
> +static int bq25618_619_set_term_curr(struct bq256xx_device *bq, int iterm)
> +{
> + unsigned int iterm_reg_code;
> +
> + if (iterm < BQ25618_ITERM_MIN_uA)
> + iterm = BQ25618_ITERM_MIN_uA;
> + else if (iterm > BQ25618_ITERM_MAX_uA)
> + iterm = BQ25618_ITERM_MAX_uA;
> +
> + iterm_reg_code = (iterm - BQ25618_ITERM_OFFSET_uA) /
> + BQ25618_ITERM_STEP_uA;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
> + BQ256XX_ITERM_MASK, iterm_reg_code);
> +}
> +
> +static int bq256xx_get_input_volt_lim(struct bq256xx_device *bq)
> +{
> + unsigned int charger_control_2;
> + unsigned int vindpm_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_CHARGER_CONTROL_2,
> + &charger_control_2);
> + if (ret)
> + return ret;
> +
> + vindpm_reg_code = charger_control_2 & BQ256XX_VINDPM_MASK;
> +
> + return (vindpm_reg_code * BQ256XX_VINDPM_STEP_uV) +
> + BQ256XX_VINDPM_OFFSET_uV;
> +}
> +
> +static int bq256xx_set_input_volt_lim(struct bq256xx_device *bq, int vindpm)
> +{
> + unsigned int vindpm_reg_code;
> +
> + if (vindpm < BQ256XX_VINDPM_MIN_uV)
> + vindpm = BQ256XX_VINDPM_MIN_uV;
> + else if (vindpm > BQ256XX_VINDPM_MAX_uV)
> + vindpm = BQ256XX_VINDPM_MAX_uV;
> +
> + vindpm_reg_code = (vindpm - BQ256XX_VINDPM_OFFSET_uV) /
> + BQ256XX_VINDPM_STEP_uV;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_CHARGER_CONTROL_2,
> + BQ256XX_VINDPM_MASK, vindpm_reg_code);
> +}
> +
> +static int bq256xx_get_input_curr_lim(struct bq256xx_device *bq)
> +{
> + unsigned int input_current_limit;
> + unsigned int iindpm_reg_code;
> + int ret;
> +
> + ret = regmap_read(bq->regmap, BQ256XX_INPUT_CURRENT_LIMIT,
> + &input_current_limit);
> + if (ret)
> + return ret;
> +
> + iindpm_reg_code = input_current_limit & BQ256XX_IINDPM_MASK;
> +
> + return (iindpm_reg_code * BQ256XX_IINDPM_STEP_uA) +
> + BQ256XX_IINDPM_OFFSET_uA;
> +}
> +
> +static int bq256xx_set_input_curr_lim(struct bq256xx_device *bq, int iindpm)
> +{
> + unsigned int iindpm_reg_code;
> +
> + if (iindpm < BQ256XX_IINDPM_MIN_uA)
> + iindpm = BQ256XX_IINDPM_MIN_uA;
> + else if (iindpm > BQ256XX_IINDPM_MAX_uA)
> + iindpm = BQ256XX_IINDPM_MAX_uA;
> +
> + iindpm_reg_code = (iindpm - BQ256XX_IINDPM_OFFSET_uA) /
> + BQ256XX_IINDPM_STEP_uA;
> +
> + return regmap_update_bits(bq->regmap, BQ256XX_INPUT_CURRENT_LIMIT,
> + BQ256XX_IINDPM_MASK, iindpm_reg_code);
> +}
> +
> +static void bq256xx_charger_reset(void *data)
> +{
> + struct bq256xx_device *bq = data;
> +
> + regmap_update_bits(bq->regmap, BQ256XX_PART_INFORMATION,
> + BQ256XX_REG_RST, BQ256XX_REG_RST);
> +}
> +
> +static int bq256xx_set_charger_property(struct power_supply *psy,
> + enum power_supply_property prop,
> + const union power_supply_propval *val)
> +{
> + struct bq256xx_device *bq = power_supply_get_drvdata(psy);
> + int ret = -EINVAL;
> +
> + switch (prop) {
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + ret = bq->chip_info->bq256xx_set_iindpm(bq, val->intval);
> + if (ret)
> + return ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_STATUS:
> + break;
> +
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + ret = bq->chip_info->bq256xx_set_vbatreg(bq, val->intval);
> + if (ret)
> + return ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + ret = bq->chip_info->bq256xx_set_ichg(bq, val->intval);
> + if (ret)
> + return ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
> + ret = bq->chip_info->bq256xx_set_iprechg(bq, val->intval);
> + if (ret)
> + return ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + ret = bq->chip_info->bq256xx_set_iterm(bq, val->intval);
> + if (ret)
> + return ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
> + ret = bq->chip_info->bq256xx_set_vindpm(bq, val->intval);
> + if (ret)
> + return ret;
> + break;
> +
> + default:
> + break;
> + }
> +
> + return ret;
> +}
> +
> +
> +static int bq256xx_get_battery_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + union power_supply_propval *val)
> +{
> + struct bq256xx_device *bq = power_supply_get_drvdata(psy);
> +
> + switch (psp) {
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
> + val->intval = bq->init_data.ichg_max;
> + break;
> +
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
> + val->intval = bq->init_data.vbatreg_max;
> + break;
> +
> + default:
> + return -EINVAL;
> + }
> +
> + return 0;
> +}
> +
> +static int bq256xx_get_charger_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + union power_supply_propval *val)
> +{
> + struct bq256xx_device *bq = power_supply_get_drvdata(psy);
> + struct bq256xx_state state;
> + int ret = 0;
> +
> + mutex_lock(&bq->lock);
> + ret = bq256xx_get_state(bq, &state);
> + mutex_unlock(&bq->lock);
> + if (ret)
> + return ret;
> +
> + switch (psp) {
> + case POWER_SUPPLY_PROP_STATUS:
> + if (state.vbus_stat == BQ256XX_VBUS_STAT_NO_INPUT ||
> + state.vbus_stat == BQ256XX_VBUS_STAT_USB_OTG)
> + val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
> + else if (state.chrg_stat == BQ256XX_CHRG_STAT_NOT_CHRGING)
> + val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
> + else if (state.chrg_stat == BQ256XX_CHRG_STAT_CHRG_TERM)
> + val->intval = POWER_SUPPLY_STATUS_FULL;
> + else
> + val->intval = POWER_SUPPLY_STATUS_CHARGING;
> + break;
> +
> + case POWER_SUPPLY_PROP_HEALTH:
> + val->intval = POWER_SUPPLY_HEALTH_UNKNOWN;
> + if (state.wdt_fault) {
> + val->intval =
> + POWER_SUPPLY_HEALTH_WATCHDOG_TIMER_EXPIRE;
> + } else if (state.bat_fault) {
> + val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
> + } else {
> + switch (state.chrg_stat) {
> + case BQ256XX_CHRG_FAULT_INPUT:
> + val->intval =
> + POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
> + break;
> + case BQ256XX_CHRG_FAULT_THERM:
> + val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
> + break;
> + case BQ256XX_CHRG_FAULT_CST_EXPIRE:
> + val->intval =
> + POWER_SUPPLY_HEALTH_SAFETY_TIMER_EXPIRE;
> + break;
> + default:
> + break;
> + }
> +
> + switch (state.ntc_fault) {
> + case BQ256XX_NTC_FAULT_WARM:
> + val->intval = POWER_SUPPLY_HEALTH_WARM;
> + break;
> + case BQ256XX_NTC_FAULT_COOL:
> + val->intval = POWER_SUPPLY_HEALTH_COOL;
> + break;
> + case BQ256XX_NTC_FAULT_COLD:
> + val->intval = POWER_SUPPLY_HEALTH_COLD;
> + break;
> + case BQ256XX_NTC_FAULT_HOT:
> + val->intval = POWER_SUPPLY_HEALTH_HOT;
> + break;
> + default:
> + val->intval = POWER_SUPPLY_HEALTH_GOOD;
> + break;
> + }
> + }
> + break;
> +
> + case POWER_SUPPLY_PROP_USB_TYPE:
> + if (bq->chip_info->has_usb_detect) {
> + switch (state.vbus_stat) {
> + case BQ256XX_VBUS_STAT_USB_SDP:
> + val->intval = POWER_SUPPLY_USB_TYPE_SDP;
> + break;
> + case BQ256XX_VBUS_STAT_USB_CDP:
> + val->intval = POWER_SUPPLY_USB_TYPE_CDP;
> + break;
> + case BQ256XX_VBUS_STAT_USB_DCP:
> + val->intval = POWER_SUPPLY_USB_TYPE_DCP;
> + break;
> + case BQ256XX_VBUS_STAT_USB_OTG:
> + val->intval = POWER_SUPPLY_USB_TYPE_ACA;
> + break;
> + default:
> + val->intval = POWER_SUPPLY_USB_TYPE_UNKNOWN;
> + break;
> + }
> + } else {
> + switch (state.vbus_stat) {
> + case BQ256XX_VBUS_STAT_USB_SDP:
> + val->intval = POWER_SUPPLY_USB_TYPE_SDP;
> + break;
> + case BQ256XX_VBUS_STAT_USB_OTG:
> + val->intval = POWER_SUPPLY_USB_TYPE_ACA;
> + break;
> + default:
> + val->intval = POWER_SUPPLY_USB_TYPE_UNKNOWN;
> + break;
> + }
> + }
> + break;
> +
> + case POWER_SUPPLY_PROP_CHARGE_TYPE:
> + switch (state.chrg_stat) {
> + case BQ256XX_CHRG_STAT_NOT_CHRGING:
> + val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
> + break;
> + case BQ256XX_CHRG_STAT_PRECHRGING:
> + val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
> + break;
> + case BQ256XX_CHRG_STAT_FAST_CHRGING:
> + val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST;
> + break;
> + case BQ256XX_CHRG_STAT_CHRG_TERM:
> + val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
> + break;
> + default:
> + val->intval = POWER_SUPPLY_CHARGE_TYPE_UNKNOWN;
> + }
> + break;
> +
> + case POWER_SUPPLY_PROP_MANUFACTURER:
> + val->strval = BQ256XX_MANUFACTURER;
> + break;
> +
> + case POWER_SUPPLY_PROP_MODEL_NAME:
> + val->strval = bq->model_name;
> + break;
> +
> + case POWER_SUPPLY_PROP_ONLINE:
> + val->intval = state.online;
> + break;
> +
> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
> + ret = bq->chip_info->bq256xx_get_vindpm(bq);
> + if (ret < 0)
> + return ret;
> + val->intval = ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + ret = bq->chip_info->bq256xx_get_iindpm(bq);
> + if (ret < 0)
> + return ret;
> + val->intval = ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + ret = bq->chip_info->bq256xx_get_vbatreg(bq);
> + if (ret < 0)
> + return ret;
> + val->intval = ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + ret = bq->chip_info->bq256xx_get_ichg(bq);
> + if (ret < 0)
> + return ret;
> + val->intval = ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
> + ret = bq->chip_info->bq256xx_get_iprechg(bq);
> + if (ret < 0)
> + return ret;
> + val->intval = ret;
> + break;
> +
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + ret = bq->chip_info->bq256xx_get_iterm(bq);
> + if (ret < 0)
> + return ret;
> + val->intval = ret;
> + break;
> +
> + default:
> + return -EINVAL;
> + }
> +
> + return ret;
> +}
> +
> +static bool bq256xx_state_changed(struct bq256xx_device *bq,
> + struct bq256xx_state *new_state)
> +{
> + struct bq256xx_state old_state;
> +
> + mutex_lock(&bq->lock);
> + old_state = bq->state;
> + mutex_unlock(&bq->lock);
> +
> + return (old_state.vbus_stat != new_state->vbus_stat ||
> + old_state.chrg_stat != new_state->chrg_stat ||
> + old_state.online != new_state->online ||
> + old_state.wdt_fault != new_state->wdt_fault ||
> + old_state.bat_fault != new_state->bat_fault ||
> + old_state.chrg_fault != new_state->chrg_fault ||
> + old_state.ntc_fault != new_state->ntc_fault);
it should be possible to just do this?
return memcmp(old_state, new_state, sizeof(struct bq256xx_state)) != 0;
> +}
> +
> +static irqreturn_t bq256xx_irq_handler_thread(int irq, void *private)
> +{
> + struct bq256xx_device *bq = private;
> + struct bq256xx_state state;
> + int ret;
> +
> + ret = bq256xx_get_state(bq, &state);
> + if (ret < 0)
> + goto irq_out;
> +
> + if (!bq256xx_state_changed(bq, &state))
> + goto irq_out;
> +
> + mutex_lock(&bq->lock);
> + bq->state = state;
> + mutex_unlock(&bq->lock);
> +
> + power_supply_changed(bq->charger);
> +
> +irq_out:
> + return IRQ_HANDLED;
> +}
> +
> +static enum power_supply_property bq256xx_power_supply_props[] = {
> + POWER_SUPPLY_PROP_MANUFACTURER,
> + POWER_SUPPLY_PROP_MODEL_NAME,
> + POWER_SUPPLY_PROP_STATUS,
> + POWER_SUPPLY_PROP_ONLINE,
> + POWER_SUPPLY_PROP_HEALTH,
> + POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT,
> + POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
> + POWER_SUPPLY_PROP_CHARGE_TYPE,
> + POWER_SUPPLY_PROP_USB_TYPE,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE,
> + POWER_SUPPLY_PROP_PRECHARGE_CURRENT,
> + POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT,
> +};
> +
> +static enum power_supply_property bq256xx_battery_props[] = {
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
> +};
> +
> +static char *bq256xx_charger_supplied_to[] = {
> + "main-battery",
> +};
> +
> +static int bq256xx_property_is_writeable(struct power_supply *psy,
> + enum power_supply_property prop)
> +{
> + switch (prop) {
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + case POWER_SUPPLY_PROP_STATUS:
> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
> + return true;
> + default:
> + return false;
> + }
> +}
> +
> +static const struct power_supply_desc bq256xx_power_supply_desc = {
> + .name = "bq256xx-charger",
> + .type = POWER_SUPPLY_TYPE_USB,
> + .usb_types = bq256xx_usb_type,
> + .num_usb_types = ARRAY_SIZE(bq256xx_usb_type),
> + .properties = bq256xx_power_supply_props,
> + .num_properties = ARRAY_SIZE(bq256xx_power_supply_props),
> + .get_property = bq256xx_get_charger_property,
> + .set_property = bq256xx_set_charger_property,
> + .property_is_writeable = bq256xx_property_is_writeable,
> +};
> +
> +static struct power_supply_desc bq256xx_battery_desc = {
> + .name = "bq256xx-battery",
> + .type = POWER_SUPPLY_TYPE_BATTERY,
> + .get_property = bq256xx_get_battery_property,
> + .properties = bq256xx_battery_props,
> + .num_properties = ARRAY_SIZE(bq256xx_battery_props),
> + .property_is_writeable = bq256xx_property_is_writeable,
> +};
> +
> +
> +static bool bq256xx_is_volatile_reg(struct device *dev, unsigned int reg)
> +{
> + switch (reg) {
> + case BQ256XX_INPUT_CURRENT_LIMIT:
> + case BQ256XX_CHARGER_STATUS_0...BQ256XX_CHARGER_STATUS_2:
> + return true;
> + default:
> + return false;
> + }
> +}
> +
> +static const struct regmap_config bq25600_regmap_config = {
> + .reg_bits = 8,
> + .val_bits = 8,
> +
> + .max_register = BQ256XX_PART_INFORMATION,
> + .reg_defaults = bq2560x_reg_defs,
> + .num_reg_defaults = ARRAY_SIZE(bq2560x_reg_defs),
> + .cache_type = REGCACHE_RBTREE,
> + .volatile_reg = bq256xx_is_volatile_reg,
> +};
> +
> +static const struct regmap_config bq25611d_regmap_config = {
> + .reg_bits = 8,
> + .val_bits = 8,
> +
> + .max_register = BQ256XX_CHARGER_CONTROL_4,
> + .reg_defaults = bq25611d_reg_defs,
> + .num_reg_defaults = ARRAY_SIZE(bq25611d_reg_defs),
> + .cache_type = REGCACHE_RBTREE,
> + .volatile_reg = bq256xx_is_volatile_reg,
> +};
> +
> +static const struct regmap_config bq25618_619_regmap_config = {
> + .reg_bits = 8,
> + .val_bits = 8,
> +
> + .max_register = BQ256XX_CHARGER_CONTROL_4,
> + .reg_defaults = bq25618_619_reg_defs,
> + .num_reg_defaults = ARRAY_SIZE(bq25618_619_reg_defs),
> + .cache_type = REGCACHE_RBTREE,
there are no holes in the register map, so it's better to use
REGCACHE_FLAT to keep overhead small.
> + .volatile_reg = bq256xx_is_volatile_reg,
> +};
> +
> +static const struct bq256xx_chip_info bq256xx_chip_info_tbl[] = {
> + [BQ25600] = {
> + .model_id = BQ25600,
> + .bq256xx_regmap_config = &bq25600_regmap_config,
> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
> + .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
> + .bq256xx_get_iterm = bq256xx_get_term_curr,
> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
> +
> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
> + .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
> + .bq256xx_set_iterm = bq256xx_set_term_curr,
> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
> +
> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
> +
> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
> +
> + .has_usb_detect = false,
> + },
> +
> + [BQ25600D] = {
> + .model_id = BQ25600D,
> + .bq256xx_regmap_config = &bq25600_regmap_config,
> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
> + .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
> + .bq256xx_get_iterm = bq256xx_get_term_curr,
> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
> +
> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
> + .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
> + .bq256xx_set_iterm = bq256xx_set_term_curr,
> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
> +
> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
> +
> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
> +
> + .has_usb_detect = true,
> + },
> +
> + [BQ25601] = {
> + .model_id = BQ25601,
> + .bq256xx_regmap_config = &bq25600_regmap_config,
> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
> + .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
> + .bq256xx_get_iterm = bq256xx_get_term_curr,
> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
> +
> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
> + .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
> + .bq256xx_set_iterm = bq256xx_set_term_curr,
> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
> +
> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
> +
> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
> +
> + .has_usb_detect = false,
> + },
> +
> + [BQ25601D] = {
> + .model_id = BQ25601D,
> + .bq256xx_regmap_config = &bq25600_regmap_config,
> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
> + .bq256xx_get_vbatreg = bq25601d_get_chrg_volt,
> + .bq256xx_get_iterm = bq256xx_get_term_curr,
> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
> +
> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
> + .bq256xx_set_vbatreg = bq25601d_set_chrg_volt,
> + .bq256xx_set_iterm = bq256xx_set_term_curr,
> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
> +
> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
> +
> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
> +
> + .has_usb_detect = true,
> + },
> +
> + [BQ25611D] = {
> + .model_id = BQ25611D,
> + .bq256xx_regmap_config = &bq25611d_regmap_config,
> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
> + .bq256xx_get_vbatreg = bq25611d_get_chrg_volt,
> + .bq256xx_get_iterm = bq256xx_get_term_curr,
> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
> +
> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
> + .bq256xx_set_vbatreg = bq25611d_set_chrg_volt,
> + .bq256xx_set_iterm = bq256xx_set_term_curr,
> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
> +
> + .bq256xx_def_ichg = BQ25611D_ICHG_DEF_uA,
> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
> + .bq256xx_def_vbatreg = BQ25611D_VBATREG_DEF_uV,
> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
> +
> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
> + .bq256xx_max_vbatreg = BQ25611D_VBATREG_MAX_uV,
> +
> + .has_usb_detect = true,
> + },
> +
> + [BQ25618] = {
> + .model_id = BQ25618,
> + .bq256xx_regmap_config = &bq25618_619_regmap_config,
> + .bq256xx_get_ichg = bq25618_619_get_ichg_curr,
> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
> + .bq256xx_get_vbatreg = bq25618_619_get_chrg_volt,
> + .bq256xx_get_iterm = bq25618_619_get_term_curr,
> + .bq256xx_get_iprechg = bq25618_619_get_prechrg_curr,
> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
> +
> + .bq256xx_set_ichg = bq25618_619_set_ichg_curr,
> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
> + .bq256xx_set_vbatreg = bq25618_619_set_chrg_volt,
> + .bq256xx_set_iterm = bq25618_619_set_term_curr,
> + .bq256xx_set_iprechg = bq25618_619_set_prechrg_curr,
> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
> +
> + .bq256xx_def_ichg = BQ25618_ICHG_DEF_uA,
> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
> + .bq256xx_def_vbatreg = BQ25618_VBATREG_DEF_uV,
> + .bq256xx_def_iterm = BQ25618_ITERM_DEF_uA,
> + .bq256xx_def_iprechg = BQ25618_IPRECHG_DEF_uA,
> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
> +
> + .bq256xx_max_ichg = BQ25618_ICHG_MAX_uA,
> + .bq256xx_max_vbatreg = BQ25618_VBATREG_MAX_uV,
> +
> + .has_usb_detect = false,
> + },
> +
> + [BQ25619] = {
> + .model_id = BQ25619,
> + .bq256xx_regmap_config = &bq25618_619_regmap_config,
> + .bq256xx_get_ichg = bq25618_619_get_ichg_curr,
> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
> + .bq256xx_get_vbatreg = bq25618_619_get_chrg_volt,
> + .bq256xx_get_iterm = bq25618_619_get_term_curr,
> + .bq256xx_get_iprechg = bq25618_619_get_prechrg_curr,
> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
> +
> + .bq256xx_set_ichg = bq25618_619_set_ichg_curr,
> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
> + .bq256xx_set_vbatreg = bq25618_619_set_chrg_volt,
> + .bq256xx_set_iterm = bq25618_619_set_term_curr,
> + .bq256xx_set_iprechg = bq25618_619_set_prechrg_curr,
> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
> +
> + .bq256xx_def_ichg = BQ25618_ICHG_DEF_uA,
> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
> + .bq256xx_def_vbatreg = BQ25618_VBATREG_DEF_uV,
> + .bq256xx_def_iterm = BQ25618_ITERM_DEF_uA,
> + .bq256xx_def_iprechg = BQ25618_IPRECHG_DEF_uA,
> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
> +
> + .bq256xx_max_ichg = BQ25618_ICHG_MAX_uA,
> + .bq256xx_max_vbatreg = BQ25618_VBATREG_MAX_uV,
> +
> + .has_usb_detect = false,
> + },
> +};
> +
> +static int bq256xx_power_supply_init(struct bq256xx_device *bq,
> + struct device *dev)
> +{
> + struct power_supply_config psy_cfg = { .drv_data = bq,
> + .of_node = dev->of_node, };
> +
> + psy_cfg.supplied_to = bq256xx_charger_supplied_to;
> + psy_cfg.num_supplicants = ARRAY_SIZE(bq256xx_charger_supplied_to);
Why do you initialize the supplied_to information?
This should be initialized from DT.
> + bq->charger = devm_power_supply_register(bq->dev,
> + &bq256xx_power_supply_desc,
> + &psy_cfg);
> + if (IS_ERR(bq->charger))
> + return -EINVAL;
> +
> + bq->battery = devm_power_supply_register(bq->dev,
> + &bq256xx_battery_desc,
> + &psy_cfg);
> + if (IS_ERR(bq->battery))
> + return -EINVAL;
> +
> + return 0;
> +}
> +
> +static int bq256xx_hw_init(struct bq256xx_device *bq)
> +{
> + struct power_supply_battery_info bat_info = { };
> + int wd_reg_val = BQ256XX_WATCHDOG_DIS;
> + int ret = 0;
> + int i;
> +
> + for (i = 0; i < BQ256XX_NUM_WD_VAL; i++) {
> + if (bq->watchdog_timer > bq256xx_watchdog_time[i] &&
> + bq->watchdog_timer < bq256xx_watchdog_time[i + 1])
> + wd_reg_val = i;
> + }
> + ret = regmap_update_bits(bq->regmap, BQ256XX_CHARGER_CONTROL_1,
> + BQ256XX_WATCHDOG_MASK, wd_reg_val <<
> + BQ256XX_WDT_BIT_SHIFT);
> +
> + ret = power_supply_get_battery_info(bq->charger, &bat_info);
> + if (ret) {
> + dev_warn(bq->dev, "battery info missing, default values will be applied\n");
> +
> + bat_info.constant_charge_current_max_ua =
> + bq->chip_info->bq256xx_def_ichg;
> +
> + bat_info.constant_charge_voltage_max_uv =
> + bq->chip_info->bq256xx_def_vbatreg;
> +
> + bat_info.precharge_current_ua =
> + bq->chip_info->bq256xx_def_iprechg;
> +
> + bat_info.charge_term_current_ua =
> + bq->chip_info->bq256xx_def_iterm;
> +
> + bq->init_data.ichg_max =
> + bq->chip_info->bq256xx_max_ichg;
> +
> + bq->init_data.vbatreg_max =
> + bq->chip_info->bq256xx_max_vbatreg;
> + } else {
> + bq->init_data.ichg_max =
> + bat_info.constant_charge_current_max_ua;
> +
> + bq->init_data.vbatreg_max =
> + bat_info.constant_charge_voltage_max_uv;
> + }
> +
> + ret = bq->chip_info->bq256xx_set_vindpm(bq, bq->init_data.vindpm);
> + if (ret)
> + goto err_out;
> +
> + ret = bq->chip_info->bq256xx_set_iindpm(bq, bq->init_data.iindpm);
> + if (ret)
> + goto err_out;
> +
> + ret = bq->chip_info->bq256xx_set_ichg(bq,
> + bat_info.constant_charge_current_max_ua);
> + if (ret)
> + goto err_out;
> +
> + ret = bq->chip_info->bq256xx_set_iprechg(bq,
> + bat_info.precharge_current_ua);
> + if (ret)
> + goto err_out;
> +
> + ret = bq->chip_info->bq256xx_set_vbatreg(bq,
> + bat_info.constant_charge_voltage_max_uv);
> + if (ret)
> + goto err_out;
> +
> + ret = bq->chip_info->bq256xx_set_iterm(bq,
> + bat_info.charge_term_current_ua);
> + if (ret)
> + goto err_out;
> +
> + power_supply_put_battery_info(bq->charger, &bat_info);
> +
> + return 0;
> +
> +err_out:
> + return ret;
> +}
> +
> +static int bq256xx_parse_dt(struct bq256xx_device *bq)
> +{
> + int ret = 0;
> +
> + ret = device_property_read_u32(bq->dev, "ti,watchdog-timeout-ms",
> + &bq->watchdog_timer);
> + if (ret)
> + bq->watchdog_timer = BQ256XX_WATCHDOG_DIS;
> +
> + if (bq->watchdog_timer > BQ256XX_WATCHDOG_MAX ||
> + bq->watchdog_timer < BQ256XX_WATCHDOG_DIS)
> + return -EINVAL;
> +
> + ret = device_property_read_u32(bq->dev,
> + "input-voltage-limit-microvolt",
> + &bq->init_data.vindpm);
> + if (ret)
> + bq->init_data.vindpm = bq->chip_info->bq256xx_def_vindpm;
> +
> + ret = device_property_read_u32(bq->dev,
> + "input-current-limit-microamp",
> + &bq->init_data.iindpm);
> + if (ret)
> + bq->init_data.iindpm = bq->chip_info->bq256xx_def_iindpm;
> +
> + return 0;
> +}
> +
> +static int bq256xx_probe(struct i2c_client *client,
> + const struct i2c_device_id *id)
> +{
> + struct device *dev = &client->dev;
> + struct bq256xx_device *bq;
> + int ret;
> +
> + bq = devm_kzalloc(dev, sizeof(*bq), GFP_KERNEL);
> + if (!bq)
> + return -ENOMEM;
> +
> + bq->client = client;
> + bq->dev = dev;
> + bq->chip_info = &bq256xx_chip_info_tbl[id->driver_data];
> +
> + mutex_init(&bq->lock);
> +
> + strncpy(bq->model_name, id->name, I2C_NAME_SIZE);
> +
> + bq->regmap = devm_regmap_init_i2c(client,
> + bq->chip_info->bq256xx_regmap_config);
> +
> + if (IS_ERR(bq->regmap)) {
> + dev_err(dev, "Failed to allocate register map\n");
> + return PTR_ERR(bq->regmap);
> + }
> +
> + i2c_set_clientdata(client, bq);
> +
> + ret = bq256xx_parse_dt(bq);
> + if (ret) {
> + dev_err(dev, "Failed to read device tree properties%d\n", ret);
> + return ret;
> + }
> +
> + /* OTG reporting */
> + bq->usb2_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2);
> + if (!IS_ERR_OR_NULL(bq->usb2_phy)) {
> + INIT_WORK(&bq->usb_work, bq256xx_usb_work);
> + bq->usb_nb.notifier_call = bq256xx_usb_notifier;
> + usb_register_notifier(bq->usb2_phy, &bq->usb_nb);
> + }
> +
> + bq->usb3_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3);
> + if (!IS_ERR_OR_NULL(bq->usb3_phy)) {
> + INIT_WORK(&bq->usb_work, bq256xx_usb_work);
> + bq->usb_nb.notifier_call = bq256xx_usb_notifier;
> + usb_register_notifier(bq->usb3_phy, &bq->usb_nb);
> + }
> +
> + if (client->irq) {
> + ret = devm_request_threaded_irq(dev, client->irq, NULL,
> + bq256xx_irq_handler_thread,
> + IRQF_TRIGGER_FALLING |
> + IRQF_ONESHOT,
> + dev_name(&client->dev), bq);
> + if (ret)
> + goto error_out;
> + }
> +
> + ret = devm_add_action_or_reset(dev, bq256xx_charger_reset, bq);
> + if (ret)
> + goto error_out;
> +
> + ret = bq256xx_power_supply_init(bq, dev);
> + if (ret) {
> + dev_err(dev, "Failed to register power supply\n");
> + goto error_out;
> + }
> +
> + ret = bq256xx_hw_init(bq);
> + if (ret) {
> + dev_err(dev, "Cannot initialize the chip.\n");
> + goto error_out;
> + }
> +
> + return ret;
> +
> +error_out:
> + if (!IS_ERR_OR_NULL(bq->usb2_phy))
> + usb_unregister_notifier(bq->usb2_phy, &bq->usb_nb);
> +
> + if (!IS_ERR_OR_NULL(bq->usb3_phy))
> + usb_unregister_notifier(bq->usb3_phy, &bq->usb_nb);
> + return ret;
> +}
> +
> +static int bq256xx_remove(struct i2c_client *client)
> +{
> + struct bq256xx_device *bq = i2c_get_clientdata(client);
> +
> + power_supply_unregister(bq->charger);
You are registering the charger with devm_power_supply_register,
so this is not needed and actually wrong (results in double free).
> + if (!IS_ERR_OR_NULL(bq->usb2_phy))
> + usb_unregister_notifier(bq->usb2_phy, &bq->usb_nb);
> +
> + if (!IS_ERR_OR_NULL(bq->usb3_phy))
> + usb_unregister_notifier(bq->usb3_phy, &bq->usb_nb);
Do this via devm_add_action_or_reset, so that we do not need
the code twice (in probe error path and on module removal).
Alternatively implement devm_usb_register_notifier() and use
that instead of usb_register_notifier().
> + bq256xx_charger_reset(bq);
This is also already handled automatically via the call you
registered with devm_add_action_or_reset.
> + return 0;
> +}
> +
> +static const struct i2c_device_id bq256xx_i2c_ids[] = {
> + { "bq25600", BQ25600 },
> + { "bq25600d", BQ25600D },
> + { "bq25601", BQ25601 },
> + { "bq25601d", BQ25601D },
> + { "bq25611d", BQ25611D },
> + { "bq25618", BQ25618 },
> + { "bq25619", BQ25619 },
> + {},
> +};
> +MODULE_DEVICE_TABLE(i2c, bq256xx_i2c_ids);
> +
> +static const struct of_device_id bq256xx_of_match[] = {
> + { .compatible = "ti,bq25600", .data = (void *)BQ25600 },
> + { .compatible = "ti,bq25600d", .data = (void *)BQ25600D },
> + { .compatible = "ti,bq25601", .data = (void *)BQ25601 },
> + { .compatible = "ti,bq25601d", .data = (void *)BQ25601D },
> + { .compatible = "ti,bq25611d", .data = (void *)BQ25611D },
> + { .compatible = "ti,bq25618", .data = (void *)BQ25618 },
> + { .compatible = "ti,bq25619", .data = (void *)BQ25619 },
> + { },
> +};
> +MODULE_DEVICE_TABLE(of, bq256xx_of_match);
> +
> +static const struct acpi_device_id bq256xx_acpi_match[] = {
> + { "bq25600", BQ25600 },
> + { "bq25600d", BQ25600D },
> + { "bq25601", BQ25601 },
> + { "bq25601d", BQ25601D },
> + { "bq25611d", BQ25611D },
> + { "bq25618", BQ25618 },
> + { "bq25619", BQ25619 },
> + {},
> +};
> +MODULE_DEVICE_TABLE(acpi, bq256xx_acpi_match);
> +
> +static struct i2c_driver bq256xx_driver = {
> + .driver = {
> + .name = "bq256xx-charger",
> + .of_match_table = bq256xx_of_match,
> + .acpi_match_table = ACPI_PTR(bq256xx_acpi_match),
> + },
> + .probe = bq256xx_probe,
> + .remove = bq256xx_remove,
> + .id_table = bq256xx_i2c_ids,
> +};
> +module_i2c_driver(bq256xx_driver);
> +
> +MODULE_AUTHOR("Ricardo Rivera-Matos <[email protected]>");
> +MODULE_DESCRIPTION("bq256xx charger driver");
> +MODULE_LICENSE("GPL v2");
> --
> 2.28.0
>
Sebastian,
On 10/19/20 4:53 PM, Sebastian Reichel wrote:
> Hi Ricardo,
>
> On Mon, Oct 05, 2020 at 04:47:09PM -0500, Ricardo Rivera-Matos wrote:
>> The BQ256XX family of devices are highly integrated buck chargers
>> for single cell batteries.
>>
>> Signed-off-by: Ricardo Rivera-Matos <[email protected]>
>>
>> v5 - adds power_supply_put_battery_info() and devm_add_action_or_rest() calls
>>
>> v6 - implements bq256xx_remove function
> v6 unfortunately makes things worse. You might want to read some
> background information about managed resources:
>
> https://lwn.net/Articles/222860/
> https://www.kernel.org/doc/html/latest/driver-api/driver-model/devres.html
ACK
>
>> ---
>> drivers/power/supply/Kconfig | 11 +
>> drivers/power/supply/Makefile | 1 +
>> drivers/power/supply/bq256xx_charger.c | 1803 ++++++++++++++++++++++++
>> 3 files changed, 1815 insertions(+)
>> create mode 100644 drivers/power/supply/bq256xx_charger.c
>>
>> diff --git a/drivers/power/supply/Kconfig b/drivers/power/supply/Kconfig
>> index 44d3c8512fb8..87d852914bc2 100644
>> --- a/drivers/power/supply/Kconfig
>> +++ b/drivers/power/supply/Kconfig
>> @@ -618,6 +618,17 @@ config CHARGER_BQ25890
>> help
>> Say Y to enable support for the TI BQ25890 battery charger.
>>
>> +config CHARGER_BQ256XX
>> + tristate "TI BQ256XX battery charger driver"
>> + depends on I2C
>> + depends on GPIOLIB || COMPILE_TEST
>> + select REGMAP_I2C
>> + help
>> + Say Y to enable support for the TI BQ256XX battery chargers. The
>> + BQ256XX family of devices are highly-integrated, switch-mode battery
>> + charge management and system power path management devices for single
>> + cell Li-ion and Li-polymer batteries.
>> +
>> config CHARGER_SMB347
>> tristate "Summit Microelectronics SMB347 Battery Charger"
>> depends on I2C
>> diff --git a/drivers/power/supply/Makefile b/drivers/power/supply/Makefile
>> index b9644663e435..e762442c7cc6 100644
>> --- a/drivers/power/supply/Makefile
>> +++ b/drivers/power/supply/Makefile
>> @@ -83,6 +83,7 @@ obj-$(CONFIG_CHARGER_BQ24190) += bq24190_charger.o
>> obj-$(CONFIG_CHARGER_BQ24257) += bq24257_charger.o
>> obj-$(CONFIG_CHARGER_BQ24735) += bq24735-charger.o
>> obj-$(CONFIG_CHARGER_BQ25890) += bq25890_charger.o
>> +obj-$(CONFIG_CHARGER_BQ256XX) += bq256xx_charger.o
>> obj-$(CONFIG_CHARGER_SMB347) += smb347-charger.o
>> obj-$(CONFIG_CHARGER_TPS65090) += tps65090-charger.o
>> obj-$(CONFIG_CHARGER_TPS65217) += tps65217_charger.o
>> diff --git a/drivers/power/supply/bq256xx_charger.c b/drivers/power/supply/bq256xx_charger.c
>> new file mode 100644
>> index 000000000000..b9caec10c456
>> --- /dev/null
>> +++ b/drivers/power/supply/bq256xx_charger.c
>> @@ -0,0 +1,1803 @@
>> +// SPDX-License-Identifier: GPL-2.0
>> +// BQ256XX Battery Charger Driver
>> +// Copyright (C) 2020 Texas Instruments Incorporated - http://www.ti.com/
>> +
>> +#include <linux/err.h>
>> +#include <linux/i2c.h>
>> +#include <linux/init.h>
>> +#include <linux/interrupt.h>
>> +#include <linux/kernel.h>
>> +#include <linux/module.h>
>> +#include <linux/gpio/consumer.h>
>> +#include <linux/power_supply.h>
>> +#include <linux/regmap.h>
>> +#include <linux/types.h>
>> +#include <linux/usb/phy.h>
>> +#include <linux/device.h>
>> +#include <linux/moduleparam.h>
>> +#include <linux/slab.h>
>> +#include <linux/acpi.h>
>> +
>> +#define BQ256XX_MANUFACTURER "Texas Instruments"
>> +
>> +#define BQ256XX_INPUT_CURRENT_LIMIT 0x00
>> +#define BQ256XX_CHARGER_CONTROL_0 0x01
>> +#define BQ256XX_CHARGE_CURRENT_LIMIT 0x02
>> +#define BQ256XX_PRECHG_AND_TERM_CURR_LIM 0x03
>> +#define BQ256XX_BATTERY_VOLTAGE_LIMIT 0x04
>> +#define BQ256XX_CHARGER_CONTROL_1 0x05
>> +#define BQ256XX_CHARGER_CONTROL_2 0x06
>> +#define BQ256XX_CHARGER_CONTROL_3 0x07
>> +#define BQ256XX_CHARGER_STATUS_0 0x08
>> +#define BQ256XX_CHARGER_STATUS_1 0x09
>> +#define BQ256XX_CHARGER_STATUS_2 0x0a
>> +#define BQ256XX_PART_INFORMATION 0x0b
>> +#define BQ256XX_CHARGER_CONTROL_4 0x0c
>> +
>> +#define BQ256XX_IINDPM_MASK GENMASK(4, 0)
>> +#define BQ256XX_IINDPM_STEP_uA 100000
>> +#define BQ256XX_IINDPM_OFFSET_uA 100000
>> +#define BQ256XX_IINDPM_MIN_uA 100000
>> +#define BQ256XX_IINDPM_MAX_uA 3200000
>> +#define BQ256XX_IINDPM_DEF_uA 2400000
>> +
>> +#define BQ256XX_VINDPM_MASK GENMASK(3, 0)
>> +#define BQ256XX_VINDPM_STEP_uV 100000
>> +#define BQ256XX_VINDPM_OFFSET_uV 3900000
>> +#define BQ256XX_VINDPM_MIN_uV 3900000
>> +#define BQ256XX_VINDPM_MAX_uV 5400000
>> +#define BQ256XX_VINDPM_DEF_uV 4500000
>> +
>> +#define BQ256XX_VBATREG_MASK GENMASK(7, 3)
>> +#define BQ2560X_VBATREG_STEP_uV 32000
>> +#define BQ2560X_VBATREG_OFFSET_uV 3856000
>> +#define BQ2560X_VBATREG_MIN_uV 3856000
>> +#define BQ2560X_VBATREG_MAX_uV 4624000
>> +#define BQ2560X_VBATREG_DEF_uV 4208000
>> +#define BQ25601D_VBATREG_OFFSET_uV 3847000
>> +#define BQ25601D_VBATREG_MIN_uV 3847000
>> +#define BQ25601D_VBATREG_MAX_uV 4615000
>> +#define BQ25601D_VBATREG_DEF_uV 4199000
>> +#define BQ2561X_VBATREG_STEP_uV 10000
>> +#define BQ25611D_VBATREG_MIN_uV 3494000
>> +#define BQ25611D_VBATREG_MAX_uV 4510000
>> +#define BQ25611D_VBATREG_DEF_uV 4190000
>> +#define BQ25618_VBATREG_MIN_uV 3504000
>> +#define BQ25618_VBATREG_MAX_uV 4500000
>> +#define BQ25618_VBATREG_DEF_uV 4200000
>> +#define BQ256XX_VBATREG_BIT_SHIFT 3
>> +#define BQ2561X_VBATREG_THRESH 0x8
>> +#define BQ25611D_VBATREG_THRESH_uV 4290000
>> +#define BQ25618_VBATREG_THRESH_uV 4300000
>> +
>> +#define BQ256XX_ITERM_MASK GENMASK(3, 0)
>> +#define BQ256XX_ITERM_STEP_uA 60000
>> +#define BQ256XX_ITERM_OFFSET_uA 60000
>> +#define BQ256XX_ITERM_MIN_uA 60000
>> +#define BQ256XX_ITERM_MAX_uA 780000
>> +#define BQ256XX_ITERM_DEF_uA 180000
>> +#define BQ25618_ITERM_STEP_uA 20000
>> +#define BQ25618_ITERM_OFFSET_uA 20000
>> +#define BQ25618_ITERM_MIN_uA 20000
>> +#define BQ25618_ITERM_MAX_uA 260000
>> +#define BQ25618_ITERM_DEF_uA 60000
>> +
>> +#define BQ256XX_IPRECHG_MASK GENMASK(7, 4)
>> +#define BQ256XX_IPRECHG_STEP_uA 60000
>> +#define BQ256XX_IPRECHG_OFFSET_uA 60000
>> +#define BQ256XX_IPRECHG_MIN_uA 60000
>> +#define BQ256XX_IPRECHG_MAX_uA 780000
>> +#define BQ256XX_IPRECHG_DEF_uA 180000
>> +#define BQ25618_IPRECHG_STEP_uA 20000
>> +#define BQ25618_IPRECHG_OFFSET_uA 20000
>> +#define BQ25618_IPRECHG_MIN_uA 20000
>> +#define BQ25618_IPRECHG_MAX_uA 260000
>> +#define BQ25618_IPRECHG_DEF_uA 40000
>> +#define BQ256XX_IPRECHG_BIT_SHIFT 4
>> +
>> +#define BQ256XX_ICHG_MASK GENMASK(5, 0)
>> +#define BQ256XX_ICHG_STEP_uA 60000
>> +#define BQ256XX_ICHG_MIN_uA 0
>> +#define BQ256XX_ICHG_MAX_uA 3000000
>> +#define BQ2560X_ICHG_DEF_uA 2040000
>> +#define BQ25611D_ICHG_DEF_uA 1020000
>> +#define BQ25618_ICHG_STEP_uA 20000
>> +#define BQ25618_ICHG_MIN_uA 0
>> +#define BQ25618_ICHG_MAX_uA 1500000
>> +#define BQ25618_ICHG_DEF_uA 340000
>> +#define BQ25618_ICHG_THRESH 0x3c
>> +#define BQ25618_ICHG_THRESH_uA 1180000
>> +
>> +#define BQ256XX_VBUS_STAT_MASK GENMASK(7, 5)
>> +#define BQ256XX_VBUS_STAT_NO_INPUT 0
>> +#define BQ256XX_VBUS_STAT_USB_SDP BIT(5)
>> +#define BQ256XX_VBUS_STAT_USB_CDP BIT(6)
>> +#define BQ256XX_VBUS_STAT_USB_DCP (BIT(6) | BIT(5))
>> +#define BQ256XX_VBUS_STAT_USB_OTG (BIT(7) | BIT(6) | BIT(5))
>> +
>> +#define BQ256XX_CHRG_STAT_MASK GENMASK(4, 3)
>> +#define BQ256XX_CHRG_STAT_NOT_CHRGING 0
>> +#define BQ256XX_CHRG_STAT_PRECHRGING BIT(3)
>> +#define BQ256XX_CHRG_STAT_FAST_CHRGING BIT(4)
>> +#define BQ256XX_CHRG_STAT_CHRG_TERM (BIT(4) | BIT(3))
>> +
>> +#define BQ256XX_PG_STAT_MASK BIT(2)
>> +#define BQ256XX_WDT_FAULT_MASK BIT(7)
>> +#define BQ256XX_CHRG_FAULT_MASK GENMASK(5, 4)
>> +#define BQ256XX_CHRG_FAULT_NORMAL 0
>> +#define BQ256XX_CHRG_FAULT_INPUT BIT(4)
>> +#define BQ256XX_CHRG_FAULT_THERM BIT(5)
>> +#define BQ256XX_CHRG_FAULT_CST_EXPIRE (BIT(5) | BIT(4))
>> +#define BQ256XX_BAT_FAULT_MASK BIT(3)
>> +#define BQ256XX_NTC_FAULT_MASK GENMASK(2, 0)
>> +#define BQ256XX_NTC_FAULT_WARM BIT(1)
>> +#define BQ256XX_NTC_FAULT_COOL (BIT(1) | BIT(0))
>> +#define BQ256XX_NTC_FAULT_COLD (BIT(2) | BIT(0))
>> +#define BQ256XX_NTC_FAULT_HOT (BIT(2) | BIT(1))
>> +
>> +#define BQ256XX_NUM_WD_VAL 8
>> +#define BQ256XX_WATCHDOG_MASK GENMASK(5, 4)
>> +#define BQ256XX_WATCHDOG_MAX 1600000
>> +#define BQ256XX_WATCHDOG_DIS 0
>> +#define BQ256XX_WDT_BIT_SHIFT 4
>> +
>> +#define BQ256XX_REG_RST BIT(7)
>> +
>> +/**
>> + * struct bq256xx_init_data -
>> + * @ichg: fast charge current
>> + * @iindpm: input current limit
>> + * @vbatreg: charge voltage
>> + * @iterm: termination current
>> + * @iprechg: precharge current
>> + * @vindpm: input voltage limit
>> + * @ichg_max: maximum fast charge current
>> + * @vbatreg_max: maximum charge voltage
>> + */
>> +struct bq256xx_init_data {
>> + u32 ichg;
>> + u32 iindpm;
>> + u32 vbatreg;
>> + u32 iterm;
>> + u32 iprechg;
>> + u32 vindpm;
>> + u32 ichg_max;
>> + u32 vbatreg_max;
>> +};
>> +
>> +/**
>> + * struct bq256xx_state -
>> + * @vbus_stat: VBUS status according to BQ256XX_CHARGER_STATUS_0
>> + * @chrg_stat: charging status according to BQ256XX_CHARGER_STATUS_0
>> + * @online: PG status according to BQ256XX_CHARGER_STATUS_0
>> + *
>> + * @wdt_fault: watchdog fault according to BQ256XX_CHARGER_STATUS_1
>> + * @bat_fault: battery fault according to BQ256XX_CHARGER_STATUS_1
>> + * @chrg_fault: charging fault according to BQ256XX_CHARGER_STATUS_1
>> + * @ntc_fault: TS fault according to BQ256XX_CHARGER_STATUS_1
>> + */
>> +struct bq256xx_state {
>> + u8 vbus_stat;
>> + u8 chrg_stat;
>> + bool online;
>> +
>> + u8 wdt_fault;
>> + u8 bat_fault;
>> + u8 chrg_fault;
>> + u8 ntc_fault;
>> +};
>> +
>> +enum bq256xx_id {
>> + BQ25600,
>> + BQ25600D,
>> + BQ25601,
>> + BQ25601D,
>> + BQ25618,
>> + BQ25619,
>> + BQ25611D,
>> +};
>> +
>> +/**
>> + * struct bq256xx_device -
>> + * @client: i2c client structure
>> + * @regmap: register map structure
>> + * @dev: device structure
>> + * @lock: mutex lock structure
>> + *
>> + * @usb2_phy: usb_phy identifier
>> + * @usb3_phy: usb_phy identifier
>> + * @usb_nb: notifier block
>> + * @usb_work: usb work queue
>> + * @usb_event: usb_event code
>> + *
>> + * @model_name: i2c name string
>> + *
>> + * @init_data: initialization data
>> + * @chip_info: device variant information
>> + * @state: device status and faults
>> + * @watchdog_timer: watchdog timer value in milliseconds
>> + */
>> +struct bq256xx_device {
>> + struct i2c_client *client;
>> + struct device *dev;
>> + struct power_supply *charger;
>> + struct power_supply *battery;
>> + struct mutex lock;
>> + struct regmap *regmap;
>> +
>> + struct usb_phy *usb2_phy;
>> + struct usb_phy *usb3_phy;
>> + struct notifier_block usb_nb;
>> + struct work_struct usb_work;
>> + unsigned long usb_event;
>> +
>> + char model_name[I2C_NAME_SIZE];
>> +
>> + struct bq256xx_init_data init_data;
>> + const struct bq256xx_chip_info *chip_info;
>> + struct bq256xx_state state;
>> + int watchdog_timer;
>> +};
>> +
>> +/**
>> + * struct bq256xx_chip_info -
>> + * @model_id: device instance
>> + *
>> + * @bq256xx_regmap_config: regmap configuration struct
>> + * @bq256xx_get_ichg: pointer to instance specific get_ichg function
>> + * @bq256xx_get_iindpm: pointer to instance specific get_iindpm function
>> + * @bq256xx_get_vbatreg: pointer to instance specific get_vbatreg function
>> + * @bq256xx_get_iterm: pointer to instance specific get_iterm function
>> + * @bq256xx_get_iprechg: pointer to instance specific get_iprechg function
>> + * @bq256xx_get_vindpm: pointer to instance specific get_vindpm function
>> + *
>> + * @bq256xx_set_ichg: pointer to instance specific set_ichg function
>> + * @bq256xx_set_iindpm: pointer to instance specific set_iindpm function
>> + * @bq256xx_set_vbatreg: pointer to instance specific set_vbatreg function
>> + * @bq256xx_set_iterm: pointer to instance specific set_iterm function
>> + * @bq256xx_set_iprechg: pointer to instance specific set_iprechg function
>> + * @bq256xx_set_vindpm: pointer to instance specific set_vindpm function
>> + *
>> + * @bq256xx_def_ichg: default ichg value in microamps
>> + * @bq256xx_def_iindpm: default iindpm value in microamps
>> + * @bq256xx_def_vbatreg: default vbatreg value in microvolts
>> + * @bq256xx_def_iterm: default iterm value in microamps
>> + * @bq256xx_def_iprechg: default iprechg value in microamps
>> + * @bq256xx_def_vindpm: default vindpm value in microvolts
>> + *
>> + * @bq256xx_max_ichg: maximum charge current in microamps
>> + * @bq256xx_max_vbatreg: maximum battery regulation voltage in microvolts
>> + *
>> + * @has_usb_detect: indicates whether device has BC1.2 detection
>> + */
>> +struct bq256xx_chip_info {
>> + int model_id;
>> +
>> + const struct regmap_config *bq256xx_regmap_config;
>> +
>> + int (*bq256xx_get_ichg)(struct bq256xx_device *bq);
>> + int (*bq256xx_get_iindpm)(struct bq256xx_device *bq);
>> + int (*bq256xx_get_vbatreg)(struct bq256xx_device *bq);
>> + int (*bq256xx_get_iterm)(struct bq256xx_device *bq);
>> + int (*bq256xx_get_iprechg)(struct bq256xx_device *bq);
>> + int (*bq256xx_get_vindpm)(struct bq256xx_device *bq);
>> +
>> + int (*bq256xx_set_ichg)(struct bq256xx_device *bq, int ichg);
>> + int (*bq256xx_set_iindpm)(struct bq256xx_device *bq, int iindpm);
>> + int (*bq256xx_set_vbatreg)(struct bq256xx_device *bq, int vbatreg);
>> + int (*bq256xx_set_iterm)(struct bq256xx_device *bq, int iterm);
>> + int (*bq256xx_set_iprechg)(struct bq256xx_device *bq, int iprechg);
>> + int (*bq256xx_set_vindpm)(struct bq256xx_device *bq, int vindpm);
>> +
>> + int bq256xx_def_ichg;
>> + int bq256xx_def_iindpm;
>> + int bq256xx_def_vbatreg;
>> + int bq256xx_def_iterm;
>> + int bq256xx_def_iprechg;
>> + int bq256xx_def_vindpm;
>> +
>> + int bq256xx_max_ichg;
>> + int bq256xx_max_vbatreg;
>> +
>> + bool has_usb_detect;
>> +};
>> +
>> +static int bq256xx_watchdog_time[BQ256XX_NUM_WD_VAL] = {
>> + 0, 40000, 80000, 1600000
>> +};
>> +
>> +static const int bq25611d_vbatreg_values[] = {
>> + 3494000, 3590000, 3686000, 3790000, 3894000, 3990000, 4090000, 4140000,
>> + 4190000
>> +};
>> +
>> +static const int bq25618_619_vbatreg_values[] = {
>> + 3504000, 3600000, 3696000, 3800000, 3904000, 4000000, 4100000, 4150000,
>> + 4200000
>> +};
>> +
>> +static const int bq25618_619_ichg_values[] = {
>> + 1290000, 1360000, 1430000, 1500000
>> +};
>> +
>> +static enum power_supply_usb_type bq256xx_usb_type[] = {
>> + POWER_SUPPLY_USB_TYPE_SDP,
>> + POWER_SUPPLY_USB_TYPE_CDP,
>> + POWER_SUPPLY_USB_TYPE_DCP,
>> + POWER_SUPPLY_USB_TYPE_UNKNOWN,
>> + POWER_SUPPLY_USB_TYPE_ACA,
>> +};
>> +
>> +static int bq256xx_array_parse(int array_size, int val, const int array[])
>> +{
>> + int i = 0;
>> +
>> + if (val < array[i])
>> + return i - 1;
> You probably want to return 0 here?
NACK, we want to round down to the previous value as the "special"
values sit on the upper end of the field.
>
>> +
>> + if (val >= array[array_size - 1])
>> + return array_size - 1;
>> +
>> + for (i = 1; i < array_size; i++) {
>> + if (val == array[i])
>> + return i;
>> +
>> + if (val > array[i - 1] && val < array[i]) {
>> + if (val < array[i])
>> + return i - 1;
>> + else
>> + return i;
>> + }
>> + }
>> + return -EINVAL;
>> +}
>> +
>> +static int bq256xx_usb_notifier(struct notifier_block *nb, unsigned long val,
>> + void *priv)
>> +{
>> + struct bq256xx_device *bq =
>> + container_of(nb, struct bq256xx_device, usb_nb);
>> +
>> + bq->usb_event = val;
>> + queue_work(system_power_efficient_wq, &bq->usb_work);
>> +
>> + return NOTIFY_OK;
>> +}
>> +
>> +static void bq256xx_usb_work(struct work_struct *data)
>> +{
>> + struct bq256xx_device *bq =
>> + container_of(data, struct bq256xx_device, usb_work);
>> +
>> + switch (bq->usb_event) {
>> + case USB_EVENT_ID:
>> + break;
>> +
>> + case USB_EVENT_NONE:
>> + power_supply_changed(bq->charger);
>> + break;
>> + default:
>> + dev_err(bq->dev, "Error switching to charger mode.\n");
>> + break;
>> + }
>> +}
>> +
>> +static struct reg_default bq2560x_reg_defs[] = {
>> + {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
>> + {BQ256XX_CHARGER_CONTROL_0, 0x1a},
>> + {BQ256XX_CHARGE_CURRENT_LIMIT, 0xa2},
>> + {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x22},
>> + {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x58},
>> + {BQ256XX_CHARGER_CONTROL_1, 0x9f},
>> + {BQ256XX_CHARGER_CONTROL_2, 0x66},
>> + {BQ256XX_CHARGER_CONTROL_3, 0x4c},
>> +};
>> +
>> +static struct reg_default bq25611d_reg_defs[] = {
>> + {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
>> + {BQ256XX_CHARGER_CONTROL_0, 0x1a},
>> + {BQ256XX_CHARGE_CURRENT_LIMIT, 0x91},
>> + {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x12},
>> + {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x40},
>> + {BQ256XX_CHARGER_CONTROL_1, 0x9e},
>> + {BQ256XX_CHARGER_CONTROL_2, 0xe6},
>> + {BQ256XX_CHARGER_CONTROL_3, 0x4c},
>> + {BQ256XX_PART_INFORMATION, 0x54},
>> + {BQ256XX_CHARGER_CONTROL_4, 0x75},
>> +};
>> +
>> +static struct reg_default bq25618_619_reg_defs[] = {
>> + {BQ256XX_INPUT_CURRENT_LIMIT, 0x17},
>> + {BQ256XX_CHARGER_CONTROL_0, 0x1a},
>> + {BQ256XX_CHARGE_CURRENT_LIMIT, 0x91},
>> + {BQ256XX_PRECHG_AND_TERM_CURR_LIM, 0x12},
>> + {BQ256XX_BATTERY_VOLTAGE_LIMIT, 0x40},
>> + {BQ256XX_CHARGER_CONTROL_1, 0x9e},
>> + {BQ256XX_CHARGER_CONTROL_2, 0xe6},
>> + {BQ256XX_CHARGER_CONTROL_3, 0x4c},
>> + {BQ256XX_PART_INFORMATION, 0x2c},
>> + {BQ256XX_CHARGER_CONTROL_4, 0x75},
>> +};
>> +
>> +static int bq256xx_get_state(struct bq256xx_device *bq,
>> + struct bq256xx_state *state)
>> +{
>> + unsigned int charger_status_0;
>> + unsigned int charger_status_1;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_CHARGER_STATUS_0,
>> + &charger_status_0);
>> + if (ret)
>> + return ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_CHARGER_STATUS_1,
>> + &charger_status_1);
>> + if (ret)
>> + return ret;
>> +
>> + state->vbus_stat = charger_status_0 & BQ256XX_VBUS_STAT_MASK;
>> + state->chrg_stat = charger_status_0 & BQ256XX_CHRG_STAT_MASK;
>> + state->online = charger_status_0 & BQ256XX_PG_STAT_MASK;
>> +
>> + state->wdt_fault = charger_status_1 & BQ256XX_WDT_FAULT_MASK;
>> + state->bat_fault = charger_status_1 & BQ256XX_BAT_FAULT_MASK;
>> + state->chrg_fault = charger_status_1 & BQ256XX_CHRG_FAULT_MASK;
>> + state->ntc_fault = charger_status_1 & BQ256XX_NTC_FAULT_MASK;
>> +
>> + return 0;
>> +}
>> +
>> +static int bq256xx_get_ichg_curr(struct bq256xx_device *bq)
>> +{
>> + unsigned int charge_current_limit;
>> + unsigned int ichg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
>> + &charge_current_limit);
>> + if (ret)
>> + return ret;
>> +
>> + ichg_reg_code = charge_current_limit & BQ256XX_ICHG_MASK;
>> +
>> + return ichg_reg_code * BQ256XX_ICHG_STEP_uA;
>> +}
>> +
>> +static int bq25618_619_get_ichg_curr(struct bq256xx_device *bq)
>> +{
>> + unsigned int charge_current_limit;
>> + unsigned int ichg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
>> + &charge_current_limit);
>> + if (ret)
>> + return ret;
>> +
>> + ichg_reg_code = charge_current_limit & BQ256XX_ICHG_MASK;
>> +
>> + if (ichg_reg_code < BQ25618_ICHG_THRESH)
>> + return ichg_reg_code * BQ25618_ICHG_STEP_uA;
>> +
>> + return bq25618_619_ichg_values[ichg_reg_code - BQ25618_ICHG_THRESH];
>> +}
>> +
>> +static int bq256xx_set_ichg_curr(struct bq256xx_device *bq, int ichg)
>> +{
>> + unsigned int ichg_reg_code;
>> +
>> + if (ichg < BQ256XX_ICHG_MIN_uA)
>> + ichg = BQ256XX_ICHG_MIN_uA;
>> + else if (ichg > bq->init_data.ichg_max)
>> + ichg = bq->init_data.ichg_max;
> Please replace above pattern with the following in the complete
> driver:
>
> ichg = clamp(ichg, BQ256XX_ICHG_MIN_uA, bq->init_data.ichg_max);
ACK
>
>> +
>> + ichg_reg_code = ichg / BQ256XX_ICHG_STEP_uA;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
>> + BQ256XX_ICHG_MASK, ichg_reg_code);
>> +}
>> +
>> +static int bq25618_619_set_ichg_curr(struct bq256xx_device *bq, int ichg)
>> +{
>> + int array_size = ARRAY_SIZE(bq25618_619_ichg_values);
>> + unsigned int ichg_reg_code;
>> +
>> + if (ichg < BQ25618_ICHG_MIN_uA)
>> + ichg = BQ25618_ICHG_MIN_uA;
>> + else if (ichg > bq->init_data.ichg_max)
>> + ichg = bq->init_data.ichg_max;
>> +
>> + if (ichg <= BQ25618_ICHG_THRESH_uA) {
>> + ichg_reg_code = ichg / BQ25618_ICHG_STEP_uA;
>> + } else {
>> + ichg_reg_code = bq256xx_array_parse(array_size, ichg,
>> + bq25618_619_ichg_values) + BQ25618_ICHG_THRESH;
>> + }
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_CHARGE_CURRENT_LIMIT,
>> + BQ256XX_ICHG_MASK, ichg_reg_code);
>> +}
>> +
>> +static int bq25618_619_get_chrg_volt(struct bq256xx_device *bq)
>> +{
>> + unsigned int battery_volt_lim;
>> + unsigned int vbatreg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + &battery_volt_lim);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
>> + BQ256XX_VBATREG_BIT_SHIFT;
>> +
>> + if (vbatreg_reg_code > BQ2561X_VBATREG_THRESH)
>> + return ((vbatreg_reg_code - BQ2561X_VBATREG_THRESH) *
>> + BQ2561X_VBATREG_STEP_uV) +
>> + BQ25618_VBATREG_THRESH_uV;
>> +
>> + return bq25618_619_vbatreg_values[vbatreg_reg_code];
>> +}
>> +
>> +static int bq25611d_get_chrg_volt(struct bq256xx_device *bq)
>> +{
>> + unsigned int battery_volt_lim;
>> + unsigned int vbatreg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + &battery_volt_lim);
>> + if (ret)
>> + return ret;
>> +
>> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
>> + BQ256XX_VBATREG_BIT_SHIFT;
>> +
>> + if (vbatreg_reg_code > BQ2561X_VBATREG_THRESH)
>> + return ((vbatreg_reg_code - BQ2561X_VBATREG_THRESH) *
>> + BQ2561X_VBATREG_STEP_uV) +
>> + BQ25611D_VBATREG_THRESH_uV;
>> +
>> + return bq25611d_vbatreg_values[vbatreg_reg_code];
>> +}
>> +
>> +static int bq2560x_get_chrg_volt(struct bq256xx_device *bq)
>> +{
>> + unsigned int battery_volt_lim;
>> + unsigned int vbatreg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + &battery_volt_lim);
>> + if (ret)
>> + return ret;
>> +
>> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
>> + BQ256XX_VBATREG_BIT_SHIFT;
>> +
>> + return (vbatreg_reg_code * BQ2560X_VBATREG_STEP_uV)
>> + + BQ2560X_VBATREG_OFFSET_uV;
>> +}
>> +
>> +static int bq25601d_get_chrg_volt(struct bq256xx_device *bq)
>> +{
>> + unsigned int battery_volt_lim;
>> + unsigned int vbatreg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + &battery_volt_lim);
>> + if (ret)
>> + return ret;
>> +
>> + vbatreg_reg_code = (battery_volt_lim & BQ256XX_VBATREG_MASK) >>
>> + BQ256XX_VBATREG_BIT_SHIFT;
>> +
>> + return (vbatreg_reg_code * BQ2560X_VBATREG_STEP_uV)
>> + + BQ25601D_VBATREG_OFFSET_uV;
>> +}
>> +
>> +static int bq25618_619_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
>> +{
>> + int array_size = ARRAY_SIZE(bq25618_619_vbatreg_values);
>> + unsigned int vbatreg_reg_code;
>> +
>> + if (vbatreg < BQ25618_VBATREG_MIN_uV)
>> + vbatreg = BQ25618_VBATREG_MIN_uV;
>> + else if (vbatreg > bq->init_data.vbatreg_max)
>> + vbatreg = bq->init_data.vbatreg_max;
>> +
>> + if (vbatreg > BQ25618_VBATREG_THRESH_uV)
>> + vbatreg_reg_code = ((vbatreg -
>> + BQ25618_VBATREG_THRESH_uV) /
>> + (BQ2561X_VBATREG_STEP_uV)) + BQ2561X_VBATREG_THRESH;
>> + else {
>> + vbatreg_reg_code = bq256xx_array_parse(array_size, vbatreg,
>> + bq25618_619_vbatreg_values);
>> + }
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
>> + BQ256XX_VBATREG_BIT_SHIFT);
>> +}
>> +
>> +static int bq25611d_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
>> +{
>> + int array_size = ARRAY_SIZE(bq25611d_vbatreg_values);
>> + unsigned int vbatreg_reg_code;
>> +
>> + if (vbatreg < BQ25611D_VBATREG_MIN_uV)
>> + vbatreg = BQ25611D_VBATREG_MIN_uV;
>> + else if (vbatreg > bq->init_data.vbatreg_max)
>> + vbatreg = bq->init_data.vbatreg_max;
>> +
>> + if (vbatreg > BQ25611D_VBATREG_THRESH_uV)
>> + vbatreg_reg_code = ((vbatreg -
>> + BQ25611D_VBATREG_THRESH_uV) /
>> + (BQ2561X_VBATREG_STEP_uV)) + BQ2561X_VBATREG_THRESH;
>> + else {
>> + vbatreg_reg_code = bq256xx_array_parse(array_size, vbatreg,
>> + bq25611d_vbatreg_values);
>> + }
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
>> + BQ256XX_VBATREG_BIT_SHIFT);
>> +}
>> +
>> +static int bq2560x_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
>> +{
>> + unsigned int vbatreg_reg_code;
>> +
>> + if (vbatreg < BQ2560X_VBATREG_MIN_uV)
>> + vbatreg = BQ2560X_VBATREG_MIN_uV;
>> + else if (vbatreg > bq->init_data.vbatreg_max)
>> + vbatreg = bq->init_data.vbatreg_max;
>> +
>> + vbatreg_reg_code = (vbatreg - BQ2560X_VBATREG_OFFSET_uV) /
>> + BQ2560X_VBATREG_STEP_uV;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
>> + BQ256XX_VBATREG_BIT_SHIFT);
>> +}
>> +
>> +static int bq25601d_set_chrg_volt(struct bq256xx_device *bq, int vbatreg)
>> +{
>> + unsigned int vbatreg_reg_code;
>> +
>> + if (vbatreg < BQ25601D_VBATREG_MIN_uV)
>> + vbatreg = BQ25601D_VBATREG_MIN_uV;
>> + else if (vbatreg > bq->init_data.vbatreg_max)
>> + vbatreg = bq->init_data.vbatreg_max;
>> +
>> + vbatreg_reg_code = (vbatreg - BQ25601D_VBATREG_OFFSET_uV) /
>> + BQ2560X_VBATREG_STEP_uV;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_BATTERY_VOLTAGE_LIMIT,
>> + BQ256XX_VBATREG_MASK, vbatreg_reg_code <<
>> + BQ256XX_VBATREG_BIT_SHIFT);
>> +}
>> +
>> +static int bq256xx_get_prechrg_curr(struct bq256xx_device *bq)
>> +{
>> + unsigned int prechg_and_term_curr_lim;
>> + unsigned int iprechg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + &prechg_and_term_curr_lim);
>> + if (ret)
>> + return ret;
>> +
>> + iprechg_reg_code = (prechg_and_term_curr_lim & BQ256XX_IPRECHG_MASK)
>> + >> BQ256XX_IPRECHG_BIT_SHIFT;
>> +
>> + return (iprechg_reg_code * BQ256XX_IPRECHG_STEP_uA) +
>> + BQ256XX_IPRECHG_OFFSET_uA;
>> +}
>> +
>> +static int bq256xx_set_prechrg_curr(struct bq256xx_device *bq, int iprechg)
>> +{
>> + unsigned int iprechg_reg_code;
>> +
>> + if (iprechg < BQ256XX_IPRECHG_MIN_uA)
>> + iprechg = BQ256XX_IPRECHG_MIN_uA;
>> + else if (iprechg > BQ256XX_IPRECHG_MAX_uA)
>> + iprechg = BQ256XX_IPRECHG_MAX_uA;
>> +
>> + iprechg_reg_code = ((iprechg - BQ256XX_IPRECHG_OFFSET_uA) /
>> + BQ256XX_IPRECHG_STEP_uA) << BQ256XX_IPRECHG_BIT_SHIFT;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + BQ256XX_IPRECHG_MASK, iprechg_reg_code);
>> +}
>> +
>> +static int bq25618_619_get_prechrg_curr(struct bq256xx_device *bq)
>> +{
>> + unsigned int prechg_and_term_curr_lim;
>> + unsigned int iprechg_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + &prechg_and_term_curr_lim);
>> + if (ret)
>> + return ret;
>> +
>> + iprechg_reg_code = (prechg_and_term_curr_lim & BQ256XX_IPRECHG_MASK)
>> + >> BQ256XX_IPRECHG_BIT_SHIFT;
>> +
>> + return (iprechg_reg_code * BQ25618_IPRECHG_STEP_uA) +
>> + BQ25618_IPRECHG_OFFSET_uA;
>> +}
>> +
>> +static int bq25618_619_set_prechrg_curr(struct bq256xx_device *bq, int iprechg)
>> +{
>> + unsigned int iprechg_reg_code;
>> +
>> + if (iprechg < BQ25618_IPRECHG_MIN_uA)
>> + iprechg = BQ25618_IPRECHG_MIN_uA;
>> + else if (iprechg > BQ25618_IPRECHG_MAX_uA)
>> + iprechg = BQ25618_IPRECHG_MAX_uA;
>> +
>> + iprechg_reg_code = ((iprechg - BQ25618_IPRECHG_OFFSET_uA) /
>> + BQ25618_IPRECHG_STEP_uA) << BQ256XX_IPRECHG_BIT_SHIFT;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + BQ256XX_IPRECHG_MASK, iprechg_reg_code);
>> +}
>> +
>> +static int bq256xx_get_term_curr(struct bq256xx_device *bq)
>> +{
>> + unsigned int prechg_and_term_curr_lim;
>> + unsigned int iterm_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + &prechg_and_term_curr_lim);
>> + if (ret)
>> + return ret;
>> +
>> + iterm_reg_code = prechg_and_term_curr_lim & BQ256XX_ITERM_MASK;
>> +
>> + return (iterm_reg_code * BQ256XX_ITERM_STEP_uA) +
>> + BQ256XX_ITERM_OFFSET_uA;
>> +}
>> +
>> +static int bq256xx_set_term_curr(struct bq256xx_device *bq, int iterm)
>> +{
>> + unsigned int iterm_reg_code;
>> +
>> + if (iterm < BQ256XX_ITERM_MIN_uA)
>> + iterm = BQ256XX_ITERM_MIN_uA;
>> + else if (iterm > BQ256XX_ITERM_MAX_uA)
>> + iterm = BQ256XX_ITERM_MAX_uA;
>> +
>> + iterm_reg_code = (iterm - BQ256XX_ITERM_OFFSET_uA) /
>> + BQ256XX_ITERM_STEP_uA;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + BQ256XX_ITERM_MASK, iterm_reg_code);
>> +}
>> +
>> +static int bq25618_619_get_term_curr(struct bq256xx_device *bq)
>> +{
>> + unsigned int prechg_and_term_curr_lim;
>> + unsigned int iterm_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + &prechg_and_term_curr_lim);
>> + if (ret)
>> + return ret;
>> +
>> + iterm_reg_code = prechg_and_term_curr_lim & BQ256XX_ITERM_MASK;
>> +
>> + return (iterm_reg_code * BQ25618_ITERM_STEP_uA) +
>> + BQ25618_ITERM_OFFSET_uA;
>> +}
>> +
>> +static int bq25618_619_set_term_curr(struct bq256xx_device *bq, int iterm)
>> +{
>> + unsigned int iterm_reg_code;
>> +
>> + if (iterm < BQ25618_ITERM_MIN_uA)
>> + iterm = BQ25618_ITERM_MIN_uA;
>> + else if (iterm > BQ25618_ITERM_MAX_uA)
>> + iterm = BQ25618_ITERM_MAX_uA;
>> +
>> + iterm_reg_code = (iterm - BQ25618_ITERM_OFFSET_uA) /
>> + BQ25618_ITERM_STEP_uA;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_PRECHG_AND_TERM_CURR_LIM,
>> + BQ256XX_ITERM_MASK, iterm_reg_code);
>> +}
>> +
>> +static int bq256xx_get_input_volt_lim(struct bq256xx_device *bq)
>> +{
>> + unsigned int charger_control_2;
>> + unsigned int vindpm_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_CHARGER_CONTROL_2,
>> + &charger_control_2);
>> + if (ret)
>> + return ret;
>> +
>> + vindpm_reg_code = charger_control_2 & BQ256XX_VINDPM_MASK;
>> +
>> + return (vindpm_reg_code * BQ256XX_VINDPM_STEP_uV) +
>> + BQ256XX_VINDPM_OFFSET_uV;
>> +}
>> +
>> +static int bq256xx_set_input_volt_lim(struct bq256xx_device *bq, int vindpm)
>> +{
>> + unsigned int vindpm_reg_code;
>> +
>> + if (vindpm < BQ256XX_VINDPM_MIN_uV)
>> + vindpm = BQ256XX_VINDPM_MIN_uV;
>> + else if (vindpm > BQ256XX_VINDPM_MAX_uV)
>> + vindpm = BQ256XX_VINDPM_MAX_uV;
>> +
>> + vindpm_reg_code = (vindpm - BQ256XX_VINDPM_OFFSET_uV) /
>> + BQ256XX_VINDPM_STEP_uV;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_CHARGER_CONTROL_2,
>> + BQ256XX_VINDPM_MASK, vindpm_reg_code);
>> +}
>> +
>> +static int bq256xx_get_input_curr_lim(struct bq256xx_device *bq)
>> +{
>> + unsigned int input_current_limit;
>> + unsigned int iindpm_reg_code;
>> + int ret;
>> +
>> + ret = regmap_read(bq->regmap, BQ256XX_INPUT_CURRENT_LIMIT,
>> + &input_current_limit);
>> + if (ret)
>> + return ret;
>> +
>> + iindpm_reg_code = input_current_limit & BQ256XX_IINDPM_MASK;
>> +
>> + return (iindpm_reg_code * BQ256XX_IINDPM_STEP_uA) +
>> + BQ256XX_IINDPM_OFFSET_uA;
>> +}
>> +
>> +static int bq256xx_set_input_curr_lim(struct bq256xx_device *bq, int iindpm)
>> +{
>> + unsigned int iindpm_reg_code;
>> +
>> + if (iindpm < BQ256XX_IINDPM_MIN_uA)
>> + iindpm = BQ256XX_IINDPM_MIN_uA;
>> + else if (iindpm > BQ256XX_IINDPM_MAX_uA)
>> + iindpm = BQ256XX_IINDPM_MAX_uA;
>> +
>> + iindpm_reg_code = (iindpm - BQ256XX_IINDPM_OFFSET_uA) /
>> + BQ256XX_IINDPM_STEP_uA;
>> +
>> + return regmap_update_bits(bq->regmap, BQ256XX_INPUT_CURRENT_LIMIT,
>> + BQ256XX_IINDPM_MASK, iindpm_reg_code);
>> +}
>> +
>> +static void bq256xx_charger_reset(void *data)
>> +{
>> + struct bq256xx_device *bq = data;
>> +
>> + regmap_update_bits(bq->regmap, BQ256XX_PART_INFORMATION,
>> + BQ256XX_REG_RST, BQ256XX_REG_RST);
>> +}
>> +
>> +static int bq256xx_set_charger_property(struct power_supply *psy,
>> + enum power_supply_property prop,
>> + const union power_supply_propval *val)
>> +{
>> + struct bq256xx_device *bq = power_supply_get_drvdata(psy);
>> + int ret = -EINVAL;
>> +
>> + switch (prop) {
>> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
>> + ret = bq->chip_info->bq256xx_set_iindpm(bq, val->intval);
>> + if (ret)
>> + return ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_STATUS:
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
>> + ret = bq->chip_info->bq256xx_set_vbatreg(bq, val->intval);
>> + if (ret)
>> + return ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
>> + ret = bq->chip_info->bq256xx_set_ichg(bq, val->intval);
>> + if (ret)
>> + return ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
>> + ret = bq->chip_info->bq256xx_set_iprechg(bq, val->intval);
>> + if (ret)
>> + return ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
>> + ret = bq->chip_info->bq256xx_set_iterm(bq, val->intval);
>> + if (ret)
>> + return ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
>> + ret = bq->chip_info->bq256xx_set_vindpm(bq, val->intval);
>> + if (ret)
>> + return ret;
>> + break;
>> +
>> + default:
>> + break;
>> + }
>> +
>> + return ret;
>> +}
>> +
>> +
>> +static int bq256xx_get_battery_property(struct power_supply *psy,
>> + enum power_supply_property psp,
>> + union power_supply_propval *val)
>> +{
>> + struct bq256xx_device *bq = power_supply_get_drvdata(psy);
>> +
>> + switch (psp) {
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
>> + val->intval = bq->init_data.ichg_max;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
>> + val->intval = bq->init_data.vbatreg_max;
>> + break;
>> +
>> + default:
>> + return -EINVAL;
>> + }
>> +
>> + return 0;
>> +}
>> +
>> +static int bq256xx_get_charger_property(struct power_supply *psy,
>> + enum power_supply_property psp,
>> + union power_supply_propval *val)
>> +{
>> + struct bq256xx_device *bq = power_supply_get_drvdata(psy);
>> + struct bq256xx_state state;
>> + int ret = 0;
>> +
>> + mutex_lock(&bq->lock);
>> + ret = bq256xx_get_state(bq, &state);
>> + mutex_unlock(&bq->lock);
>> + if (ret)
>> + return ret;
>> +
>> + switch (psp) {
>> + case POWER_SUPPLY_PROP_STATUS:
>> + if (state.vbus_stat == BQ256XX_VBUS_STAT_NO_INPUT ||
>> + state.vbus_stat == BQ256XX_VBUS_STAT_USB_OTG)
>> + val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
>> + else if (state.chrg_stat == BQ256XX_CHRG_STAT_NOT_CHRGING)
>> + val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
>> + else if (state.chrg_stat == BQ256XX_CHRG_STAT_CHRG_TERM)
>> + val->intval = POWER_SUPPLY_STATUS_FULL;
>> + else
>> + val->intval = POWER_SUPPLY_STATUS_CHARGING;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_HEALTH:
>> + val->intval = POWER_SUPPLY_HEALTH_UNKNOWN;
>> + if (state.wdt_fault) {
>> + val->intval =
>> + POWER_SUPPLY_HEALTH_WATCHDOG_TIMER_EXPIRE;
>> + } else if (state.bat_fault) {
>> + val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
>> + } else {
>> + switch (state.chrg_stat) {
>> + case BQ256XX_CHRG_FAULT_INPUT:
>> + val->intval =
>> + POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
>> + break;
>> + case BQ256XX_CHRG_FAULT_THERM:
>> + val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
>> + break;
>> + case BQ256XX_CHRG_FAULT_CST_EXPIRE:
>> + val->intval =
>> + POWER_SUPPLY_HEALTH_SAFETY_TIMER_EXPIRE;
>> + break;
>> + default:
>> + break;
>> + }
>> +
>> + switch (state.ntc_fault) {
>> + case BQ256XX_NTC_FAULT_WARM:
>> + val->intval = POWER_SUPPLY_HEALTH_WARM;
>> + break;
>> + case BQ256XX_NTC_FAULT_COOL:
>> + val->intval = POWER_SUPPLY_HEALTH_COOL;
>> + break;
>> + case BQ256XX_NTC_FAULT_COLD:
>> + val->intval = POWER_SUPPLY_HEALTH_COLD;
>> + break;
>> + case BQ256XX_NTC_FAULT_HOT:
>> + val->intval = POWER_SUPPLY_HEALTH_HOT;
>> + break;
>> + default:
>> + val->intval = POWER_SUPPLY_HEALTH_GOOD;
>> + break;
>> + }
>> + }
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_USB_TYPE:
>> + if (bq->chip_info->has_usb_detect) {
>> + switch (state.vbus_stat) {
>> + case BQ256XX_VBUS_STAT_USB_SDP:
>> + val->intval = POWER_SUPPLY_USB_TYPE_SDP;
>> + break;
>> + case BQ256XX_VBUS_STAT_USB_CDP:
>> + val->intval = POWER_SUPPLY_USB_TYPE_CDP;
>> + break;
>> + case BQ256XX_VBUS_STAT_USB_DCP:
>> + val->intval = POWER_SUPPLY_USB_TYPE_DCP;
>> + break;
>> + case BQ256XX_VBUS_STAT_USB_OTG:
>> + val->intval = POWER_SUPPLY_USB_TYPE_ACA;
>> + break;
>> + default:
>> + val->intval = POWER_SUPPLY_USB_TYPE_UNKNOWN;
>> + break;
>> + }
>> + } else {
>> + switch (state.vbus_stat) {
>> + case BQ256XX_VBUS_STAT_USB_SDP:
>> + val->intval = POWER_SUPPLY_USB_TYPE_SDP;
>> + break;
>> + case BQ256XX_VBUS_STAT_USB_OTG:
>> + val->intval = POWER_SUPPLY_USB_TYPE_ACA;
>> + break;
>> + default:
>> + val->intval = POWER_SUPPLY_USB_TYPE_UNKNOWN;
>> + break;
>> + }
>> + }
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CHARGE_TYPE:
>> + switch (state.chrg_stat) {
>> + case BQ256XX_CHRG_STAT_NOT_CHRGING:
>> + val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
>> + break;
>> + case BQ256XX_CHRG_STAT_PRECHRGING:
>> + val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
>> + break;
>> + case BQ256XX_CHRG_STAT_FAST_CHRGING:
>> + val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST;
>> + break;
>> + case BQ256XX_CHRG_STAT_CHRG_TERM:
>> + val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
>> + break;
>> + default:
>> + val->intval = POWER_SUPPLY_CHARGE_TYPE_UNKNOWN;
>> + }
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_MANUFACTURER:
>> + val->strval = BQ256XX_MANUFACTURER;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_MODEL_NAME:
>> + val->strval = bq->model_name;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_ONLINE:
>> + val->intval = state.online;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
>> + ret = bq->chip_info->bq256xx_get_vindpm(bq);
>> + if (ret < 0)
>> + return ret;
>> + val->intval = ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
>> + ret = bq->chip_info->bq256xx_get_iindpm(bq);
>> + if (ret < 0)
>> + return ret;
>> + val->intval = ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
>> + ret = bq->chip_info->bq256xx_get_vbatreg(bq);
>> + if (ret < 0)
>> + return ret;
>> + val->intval = ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
>> + ret = bq->chip_info->bq256xx_get_ichg(bq);
>> + if (ret < 0)
>> + return ret;
>> + val->intval = ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
>> + ret = bq->chip_info->bq256xx_get_iprechg(bq);
>> + if (ret < 0)
>> + return ret;
>> + val->intval = ret;
>> + break;
>> +
>> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
>> + ret = bq->chip_info->bq256xx_get_iterm(bq);
>> + if (ret < 0)
>> + return ret;
>> + val->intval = ret;
>> + break;
>> +
>> + default:
>> + return -EINVAL;
>> + }
>> +
>> + return ret;
>> +}
>> +
>> +static bool bq256xx_state_changed(struct bq256xx_device *bq,
>> + struct bq256xx_state *new_state)
>> +{
>> + struct bq256xx_state old_state;
>> +
>> + mutex_lock(&bq->lock);
>> + old_state = bq->state;
>> + mutex_unlock(&bq->lock);
>> +
>> + return (old_state.vbus_stat != new_state->vbus_stat ||
>> + old_state.chrg_stat != new_state->chrg_stat ||
>> + old_state.online != new_state->online ||
>> + old_state.wdt_fault != new_state->wdt_fault ||
>> + old_state.bat_fault != new_state->bat_fault ||
>> + old_state.chrg_fault != new_state->chrg_fault ||
>> + old_state.ntc_fault != new_state->ntc_fault);
> it should be possible to just do this?
>
> return memcmp(old_state, new_state, sizeof(struct bq256xx_state)) != 0;
ACK
>
>> +}
>> +
>> +static irqreturn_t bq256xx_irq_handler_thread(int irq, void *private)
>> +{
>> + struct bq256xx_device *bq = private;
>> + struct bq256xx_state state;
>> + int ret;
>> +
>> + ret = bq256xx_get_state(bq, &state);
>> + if (ret < 0)
>> + goto irq_out;
>> +
>> + if (!bq256xx_state_changed(bq, &state))
>> + goto irq_out;
>> +
>> + mutex_lock(&bq->lock);
>> + bq->state = state;
>> + mutex_unlock(&bq->lock);
>> +
>> + power_supply_changed(bq->charger);
>> +
>> +irq_out:
>> + return IRQ_HANDLED;
>> +}
>> +
>> +static enum power_supply_property bq256xx_power_supply_props[] = {
>> + POWER_SUPPLY_PROP_MANUFACTURER,
>> + POWER_SUPPLY_PROP_MODEL_NAME,
>> + POWER_SUPPLY_PROP_STATUS,
>> + POWER_SUPPLY_PROP_ONLINE,
>> + POWER_SUPPLY_PROP_HEALTH,
>> + POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT,
>> + POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
>> + POWER_SUPPLY_PROP_CHARGE_TYPE,
>> + POWER_SUPPLY_PROP_USB_TYPE,
>> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT,
>> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE,
>> + POWER_SUPPLY_PROP_PRECHARGE_CURRENT,
>> + POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT,
>> +};
>> +
>> +static enum power_supply_property bq256xx_battery_props[] = {
>> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
>> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
>> +};
>> +
>> +static char *bq256xx_charger_supplied_to[] = {
>> + "main-battery",
>> +};
>> +
>> +static int bq256xx_property_is_writeable(struct power_supply *psy,
>> + enum power_supply_property prop)
>> +{
>> + switch (prop) {
>> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
>> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
>> + case POWER_SUPPLY_PROP_PRECHARGE_CURRENT:
>> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
>> + case POWER_SUPPLY_PROP_STATUS:
>> + case POWER_SUPPLY_PROP_INPUT_VOLTAGE_LIMIT:
>> + return true;
>> + default:
>> + return false;
>> + }
>> +}
>> +
>> +static const struct power_supply_desc bq256xx_power_supply_desc = {
>> + .name = "bq256xx-charger",
>> + .type = POWER_SUPPLY_TYPE_USB,
>> + .usb_types = bq256xx_usb_type,
>> + .num_usb_types = ARRAY_SIZE(bq256xx_usb_type),
>> + .properties = bq256xx_power_supply_props,
>> + .num_properties = ARRAY_SIZE(bq256xx_power_supply_props),
>> + .get_property = bq256xx_get_charger_property,
>> + .set_property = bq256xx_set_charger_property,
>> + .property_is_writeable = bq256xx_property_is_writeable,
>> +};
>> +
>> +static struct power_supply_desc bq256xx_battery_desc = {
>> + .name = "bq256xx-battery",
>> + .type = POWER_SUPPLY_TYPE_BATTERY,
>> + .get_property = bq256xx_get_battery_property,
>> + .properties = bq256xx_battery_props,
>> + .num_properties = ARRAY_SIZE(bq256xx_battery_props),
>> + .property_is_writeable = bq256xx_property_is_writeable,
>> +};
>> +
>> +
>> +static bool bq256xx_is_volatile_reg(struct device *dev, unsigned int reg)
>> +{
>> + switch (reg) {
>> + case BQ256XX_INPUT_CURRENT_LIMIT:
>> + case BQ256XX_CHARGER_STATUS_0...BQ256XX_CHARGER_STATUS_2:
>> + return true;
>> + default:
>> + return false;
>> + }
>> +}
>> +
>> +static const struct regmap_config bq25600_regmap_config = {
>> + .reg_bits = 8,
>> + .val_bits = 8,
>> +
>> + .max_register = BQ256XX_PART_INFORMATION,
>> + .reg_defaults = bq2560x_reg_defs,
>> + .num_reg_defaults = ARRAY_SIZE(bq2560x_reg_defs),
>> + .cache_type = REGCACHE_RBTREE,
>> + .volatile_reg = bq256xx_is_volatile_reg,
>> +};
>> +
>> +static const struct regmap_config bq25611d_regmap_config = {
>> + .reg_bits = 8,
>> + .val_bits = 8,
>> +
>> + .max_register = BQ256XX_CHARGER_CONTROL_4,
>> + .reg_defaults = bq25611d_reg_defs,
>> + .num_reg_defaults = ARRAY_SIZE(bq25611d_reg_defs),
>> + .cache_type = REGCACHE_RBTREE,
>> + .volatile_reg = bq256xx_is_volatile_reg,
>> +};
>> +
>> +static const struct regmap_config bq25618_619_regmap_config = {
>> + .reg_bits = 8,
>> + .val_bits = 8,
>> +
>> + .max_register = BQ256XX_CHARGER_CONTROL_4,
>> + .reg_defaults = bq25618_619_reg_defs,
>> + .num_reg_defaults = ARRAY_SIZE(bq25618_619_reg_defs),
>> + .cache_type = REGCACHE_RBTREE,
> there are no holes in the register map, so it's better to use
> REGCACHE_FLAT to keep overhead small.
ACK
>
>> + .volatile_reg = bq256xx_is_volatile_reg,
>> +};
>> +
>> +static const struct bq256xx_chip_info bq256xx_chip_info_tbl[] = {
>> + [BQ25600] = {
>> + .model_id = BQ25600,
>> + .bq256xx_regmap_config = &bq25600_regmap_config,
>> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
>> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
>> + .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
>> + .bq256xx_get_iterm = bq256xx_get_term_curr,
>> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
>> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
>> +
>> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
>> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
>> + .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
>> + .bq256xx_set_iterm = bq256xx_set_term_curr,
>> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
>> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
>> +
>> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
>> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
>> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
>> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
>> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
>> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
>> +
>> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
>> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
>> +
>> + .has_usb_detect = false,
>> + },
>> +
>> + [BQ25600D] = {
>> + .model_id = BQ25600D,
>> + .bq256xx_regmap_config = &bq25600_regmap_config,
>> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
>> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
>> + .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
>> + .bq256xx_get_iterm = bq256xx_get_term_curr,
>> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
>> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
>> +
>> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
>> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
>> + .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
>> + .bq256xx_set_iterm = bq256xx_set_term_curr,
>> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
>> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
>> +
>> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
>> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
>> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
>> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
>> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
>> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
>> +
>> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
>> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
>> +
>> + .has_usb_detect = true,
>> + },
>> +
>> + [BQ25601] = {
>> + .model_id = BQ25601,
>> + .bq256xx_regmap_config = &bq25600_regmap_config,
>> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
>> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
>> + .bq256xx_get_vbatreg = bq2560x_get_chrg_volt,
>> + .bq256xx_get_iterm = bq256xx_get_term_curr,
>> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
>> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
>> +
>> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
>> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
>> + .bq256xx_set_vbatreg = bq2560x_set_chrg_volt,
>> + .bq256xx_set_iterm = bq256xx_set_term_curr,
>> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
>> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
>> +
>> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
>> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
>> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
>> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
>> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
>> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
>> +
>> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
>> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
>> +
>> + .has_usb_detect = false,
>> + },
>> +
>> + [BQ25601D] = {
>> + .model_id = BQ25601D,
>> + .bq256xx_regmap_config = &bq25600_regmap_config,
>> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
>> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
>> + .bq256xx_get_vbatreg = bq25601d_get_chrg_volt,
>> + .bq256xx_get_iterm = bq256xx_get_term_curr,
>> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
>> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
>> +
>> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
>> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
>> + .bq256xx_set_vbatreg = bq25601d_set_chrg_volt,
>> + .bq256xx_set_iterm = bq256xx_set_term_curr,
>> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
>> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
>> +
>> + .bq256xx_def_ichg = BQ2560X_ICHG_DEF_uA,
>> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
>> + .bq256xx_def_vbatreg = BQ2560X_VBATREG_DEF_uV,
>> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
>> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
>> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
>> +
>> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
>> + .bq256xx_max_vbatreg = BQ2560X_VBATREG_MAX_uV,
>> +
>> + .has_usb_detect = true,
>> + },
>> +
>> + [BQ25611D] = {
>> + .model_id = BQ25611D,
>> + .bq256xx_regmap_config = &bq25611d_regmap_config,
>> + .bq256xx_get_ichg = bq256xx_get_ichg_curr,
>> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
>> + .bq256xx_get_vbatreg = bq25611d_get_chrg_volt,
>> + .bq256xx_get_iterm = bq256xx_get_term_curr,
>> + .bq256xx_get_iprechg = bq256xx_get_prechrg_curr,
>> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
>> +
>> + .bq256xx_set_ichg = bq256xx_set_ichg_curr,
>> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
>> + .bq256xx_set_vbatreg = bq25611d_set_chrg_volt,
>> + .bq256xx_set_iterm = bq256xx_set_term_curr,
>> + .bq256xx_set_iprechg = bq256xx_set_prechrg_curr,
>> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
>> +
>> + .bq256xx_def_ichg = BQ25611D_ICHG_DEF_uA,
>> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
>> + .bq256xx_def_vbatreg = BQ25611D_VBATREG_DEF_uV,
>> + .bq256xx_def_iterm = BQ256XX_ITERM_DEF_uA,
>> + .bq256xx_def_iprechg = BQ256XX_IPRECHG_DEF_uA,
>> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
>> +
>> + .bq256xx_max_ichg = BQ256XX_ICHG_MAX_uA,
>> + .bq256xx_max_vbatreg = BQ25611D_VBATREG_MAX_uV,
>> +
>> + .has_usb_detect = true,
>> + },
>> +
>> + [BQ25618] = {
>> + .model_id = BQ25618,
>> + .bq256xx_regmap_config = &bq25618_619_regmap_config,
>> + .bq256xx_get_ichg = bq25618_619_get_ichg_curr,
>> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
>> + .bq256xx_get_vbatreg = bq25618_619_get_chrg_volt,
>> + .bq256xx_get_iterm = bq25618_619_get_term_curr,
>> + .bq256xx_get_iprechg = bq25618_619_get_prechrg_curr,
>> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
>> +
>> + .bq256xx_set_ichg = bq25618_619_set_ichg_curr,
>> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
>> + .bq256xx_set_vbatreg = bq25618_619_set_chrg_volt,
>> + .bq256xx_set_iterm = bq25618_619_set_term_curr,
>> + .bq256xx_set_iprechg = bq25618_619_set_prechrg_curr,
>> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
>> +
>> + .bq256xx_def_ichg = BQ25618_ICHG_DEF_uA,
>> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
>> + .bq256xx_def_vbatreg = BQ25618_VBATREG_DEF_uV,
>> + .bq256xx_def_iterm = BQ25618_ITERM_DEF_uA,
>> + .bq256xx_def_iprechg = BQ25618_IPRECHG_DEF_uA,
>> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
>> +
>> + .bq256xx_max_ichg = BQ25618_ICHG_MAX_uA,
>> + .bq256xx_max_vbatreg = BQ25618_VBATREG_MAX_uV,
>> +
>> + .has_usb_detect = false,
>> + },
>> +
>> + [BQ25619] = {
>> + .model_id = BQ25619,
>> + .bq256xx_regmap_config = &bq25618_619_regmap_config,
>> + .bq256xx_get_ichg = bq25618_619_get_ichg_curr,
>> + .bq256xx_get_iindpm = bq256xx_get_input_curr_lim,
>> + .bq256xx_get_vbatreg = bq25618_619_get_chrg_volt,
>> + .bq256xx_get_iterm = bq25618_619_get_term_curr,
>> + .bq256xx_get_iprechg = bq25618_619_get_prechrg_curr,
>> + .bq256xx_get_vindpm = bq256xx_get_input_volt_lim,
>> +
>> + .bq256xx_set_ichg = bq25618_619_set_ichg_curr,
>> + .bq256xx_set_iindpm = bq256xx_set_input_curr_lim,
>> + .bq256xx_set_vbatreg = bq25618_619_set_chrg_volt,
>> + .bq256xx_set_iterm = bq25618_619_set_term_curr,
>> + .bq256xx_set_iprechg = bq25618_619_set_prechrg_curr,
>> + .bq256xx_set_vindpm = bq256xx_set_input_volt_lim,
>> +
>> + .bq256xx_def_ichg = BQ25618_ICHG_DEF_uA,
>> + .bq256xx_def_iindpm = BQ256XX_IINDPM_DEF_uA,
>> + .bq256xx_def_vbatreg = BQ25618_VBATREG_DEF_uV,
>> + .bq256xx_def_iterm = BQ25618_ITERM_DEF_uA,
>> + .bq256xx_def_iprechg = BQ25618_IPRECHG_DEF_uA,
>> + .bq256xx_def_vindpm = BQ256XX_VINDPM_DEF_uV,
>> +
>> + .bq256xx_max_ichg = BQ25618_ICHG_MAX_uA,
>> + .bq256xx_max_vbatreg = BQ25618_VBATREG_MAX_uV,
>> +
>> + .has_usb_detect = false,
>> + },
>> +};
>> +
>> +static int bq256xx_power_supply_init(struct bq256xx_device *bq,
>> + struct device *dev)
>> +{
>> + struct power_supply_config psy_cfg = { .drv_data = bq,
>> + .of_node = dev->of_node, };
>> +
>> + psy_cfg.supplied_to = bq256xx_charger_supplied_to;
>> + psy_cfg.num_supplicants = ARRAY_SIZE(bq256xx_charger_supplied_to);
> Why do you initialize the supplied_to information?
> This should be initialized from DT.
ACK
>
>> + bq->charger = devm_power_supply_register(bq->dev,
>> + &bq256xx_power_supply_desc,
>> + &psy_cfg);
>> + if (IS_ERR(bq->charger))
>> + return -EINVAL;
>> +
>> + bq->battery = devm_power_supply_register(bq->dev,
>> + &bq256xx_battery_desc,
>> + &psy_cfg);
>> + if (IS_ERR(bq->battery))
>> + return -EINVAL;
>> +
>> + return 0;
>> +}
>> +
>> +static int bq256xx_hw_init(struct bq256xx_device *bq)
>> +{
>> + struct power_supply_battery_info bat_info = { };
>> + int wd_reg_val = BQ256XX_WATCHDOG_DIS;
>> + int ret = 0;
>> + int i;
>> +
>> + for (i = 0; i < BQ256XX_NUM_WD_VAL; i++) {
>> + if (bq->watchdog_timer > bq256xx_watchdog_time[i] &&
>> + bq->watchdog_timer < bq256xx_watchdog_time[i + 1])
>> + wd_reg_val = i;
>> + }
>> + ret = regmap_update_bits(bq->regmap, BQ256XX_CHARGER_CONTROL_1,
>> + BQ256XX_WATCHDOG_MASK, wd_reg_val <<
>> + BQ256XX_WDT_BIT_SHIFT);
>> +
>> + ret = power_supply_get_battery_info(bq->charger, &bat_info);
>> + if (ret) {
>> + dev_warn(bq->dev, "battery info missing, default values will be applied\n");
>> +
>> + bat_info.constant_charge_current_max_ua =
>> + bq->chip_info->bq256xx_def_ichg;
>> +
>> + bat_info.constant_charge_voltage_max_uv =
>> + bq->chip_info->bq256xx_def_vbatreg;
>> +
>> + bat_info.precharge_current_ua =
>> + bq->chip_info->bq256xx_def_iprechg;
>> +
>> + bat_info.charge_term_current_ua =
>> + bq->chip_info->bq256xx_def_iterm;
>> +
>> + bq->init_data.ichg_max =
>> + bq->chip_info->bq256xx_max_ichg;
>> +
>> + bq->init_data.vbatreg_max =
>> + bq->chip_info->bq256xx_max_vbatreg;
>> + } else {
>> + bq->init_data.ichg_max =
>> + bat_info.constant_charge_current_max_ua;
>> +
>> + bq->init_data.vbatreg_max =
>> + bat_info.constant_charge_voltage_max_uv;
>> + }
>> +
>> + ret = bq->chip_info->bq256xx_set_vindpm(bq, bq->init_data.vindpm);
>> + if (ret)
>> + goto err_out;
>> +
>> + ret = bq->chip_info->bq256xx_set_iindpm(bq, bq->init_data.iindpm);
>> + if (ret)
>> + goto err_out;
>> +
>> + ret = bq->chip_info->bq256xx_set_ichg(bq,
>> + bat_info.constant_charge_current_max_ua);
>> + if (ret)
>> + goto err_out;
>> +
>> + ret = bq->chip_info->bq256xx_set_iprechg(bq,
>> + bat_info.precharge_current_ua);
>> + if (ret)
>> + goto err_out;
>> +
>> + ret = bq->chip_info->bq256xx_set_vbatreg(bq,
>> + bat_info.constant_charge_voltage_max_uv);
>> + if (ret)
>> + goto err_out;
>> +
>> + ret = bq->chip_info->bq256xx_set_iterm(bq,
>> + bat_info.charge_term_current_ua);
>> + if (ret)
>> + goto err_out;
>> +
>> + power_supply_put_battery_info(bq->charger, &bat_info);
>> +
>> + return 0;
>> +
>> +err_out:
>> + return ret;
>> +}
>> +
>> +static int bq256xx_parse_dt(struct bq256xx_device *bq)
>> +{
>> + int ret = 0;
>> +
>> + ret = device_property_read_u32(bq->dev, "ti,watchdog-timeout-ms",
>> + &bq->watchdog_timer);
>> + if (ret)
>> + bq->watchdog_timer = BQ256XX_WATCHDOG_DIS;
>> +
>> + if (bq->watchdog_timer > BQ256XX_WATCHDOG_MAX ||
>> + bq->watchdog_timer < BQ256XX_WATCHDOG_DIS)
>> + return -EINVAL;
>> +
>> + ret = device_property_read_u32(bq->dev,
>> + "input-voltage-limit-microvolt",
>> + &bq->init_data.vindpm);
>> + if (ret)
>> + bq->init_data.vindpm = bq->chip_info->bq256xx_def_vindpm;
>> +
>> + ret = device_property_read_u32(bq->dev,
>> + "input-current-limit-microamp",
>> + &bq->init_data.iindpm);
>> + if (ret)
>> + bq->init_data.iindpm = bq->chip_info->bq256xx_def_iindpm;
>> +
>> + return 0;
>> +}
>> +
>> +static int bq256xx_probe(struct i2c_client *client,
>> + const struct i2c_device_id *id)
>> +{
>> + struct device *dev = &client->dev;
>> + struct bq256xx_device *bq;
>> + int ret;
>> +
>> + bq = devm_kzalloc(dev, sizeof(*bq), GFP_KERNEL);
>> + if (!bq)
>> + return -ENOMEM;
>> +
>> + bq->client = client;
>> + bq->dev = dev;
>> + bq->chip_info = &bq256xx_chip_info_tbl[id->driver_data];
>> +
>> + mutex_init(&bq->lock);
>> +
>> + strncpy(bq->model_name, id->name, I2C_NAME_SIZE);
>> +
>> + bq->regmap = devm_regmap_init_i2c(client,
>> + bq->chip_info->bq256xx_regmap_config);
>> +
>> + if (IS_ERR(bq->regmap)) {
>> + dev_err(dev, "Failed to allocate register map\n");
>> + return PTR_ERR(bq->regmap);
>> + }
>> +
>> + i2c_set_clientdata(client, bq);
>> +
>> + ret = bq256xx_parse_dt(bq);
>> + if (ret) {
>> + dev_err(dev, "Failed to read device tree properties%d\n", ret);
>> + return ret;
>> + }
>> +
>> + /* OTG reporting */
>> + bq->usb2_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2);
>> + if (!IS_ERR_OR_NULL(bq->usb2_phy)) {
>> + INIT_WORK(&bq->usb_work, bq256xx_usb_work);
>> + bq->usb_nb.notifier_call = bq256xx_usb_notifier;
>> + usb_register_notifier(bq->usb2_phy, &bq->usb_nb);
>> + }
>> +
>> + bq->usb3_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3);
>> + if (!IS_ERR_OR_NULL(bq->usb3_phy)) {
>> + INIT_WORK(&bq->usb_work, bq256xx_usb_work);
>> + bq->usb_nb.notifier_call = bq256xx_usb_notifier;
>> + usb_register_notifier(bq->usb3_phy, &bq->usb_nb);
>> + }
>> +
>> + if (client->irq) {
>> + ret = devm_request_threaded_irq(dev, client->irq, NULL,
>> + bq256xx_irq_handler_thread,
>> + IRQF_TRIGGER_FALLING |
>> + IRQF_ONESHOT,
>> + dev_name(&client->dev), bq);
>> + if (ret)
>> + goto error_out;
>> + }
>> +
>> + ret = devm_add_action_or_reset(dev, bq256xx_charger_reset, bq);
>> + if (ret)
>> + goto error_out;
>> +
>> + ret = bq256xx_power_supply_init(bq, dev);
>> + if (ret) {
>> + dev_err(dev, "Failed to register power supply\n");
>> + goto error_out;
>> + }
>> +
>> + ret = bq256xx_hw_init(bq);
>> + if (ret) {
>> + dev_err(dev, "Cannot initialize the chip.\n");
>> + goto error_out;
>> + }
>> +
>> + return ret;
>> +
>> +error_out:
>> + if (!IS_ERR_OR_NULL(bq->usb2_phy))
>> + usb_unregister_notifier(bq->usb2_phy, &bq->usb_nb);
>> +
>> + if (!IS_ERR_OR_NULL(bq->usb3_phy))
>> + usb_unregister_notifier(bq->usb3_phy, &bq->usb_nb);
>> + return ret;
>> +}
>> +
>> +static int bq256xx_remove(struct i2c_client *client)
>> +{
>> + struct bq256xx_device *bq = i2c_get_clientdata(client);
>> +
>> + power_supply_unregister(bq->charger);
> You are registering the charger with devm_power_supply_register,
> so this is not needed and actually wrong (results in double free).
ACK
>
>> + if (!IS_ERR_OR_NULL(bq->usb2_phy))
>> + usb_unregister_notifier(bq->usb2_phy, &bq->usb_nb);
>> +
>> + if (!IS_ERR_OR_NULL(bq->usb3_phy))
>> + usb_unregister_notifier(bq->usb3_phy, &bq->usb_nb);
> Do this via devm_add_action_or_reset, so that we do not need
> the code twice (in probe error path and on module removal).
> Alternatively implement devm_usb_register_notifier() and use
> that instead of usb_register_notifier().
ACK
>
>> + bq256xx_charger_reset(bq);
> This is also already handled automatically via the call you
> registered with devm_add_action_or_reset.
ACK
>
>> + return 0;
>> +}
>> +
>> +static const struct i2c_device_id bq256xx_i2c_ids[] = {
>> + { "bq25600", BQ25600 },
>> + { "bq25600d", BQ25600D },
>> + { "bq25601", BQ25601 },
>> + { "bq25601d", BQ25601D },
>> + { "bq25611d", BQ25611D },
>> + { "bq25618", BQ25618 },
>> + { "bq25619", BQ25619 },
>> + {},
>> +};
>> +MODULE_DEVICE_TABLE(i2c, bq256xx_i2c_ids);
>> +
>> +static const struct of_device_id bq256xx_of_match[] = {
>> + { .compatible = "ti,bq25600", .data = (void *)BQ25600 },
>> + { .compatible = "ti,bq25600d", .data = (void *)BQ25600D },
>> + { .compatible = "ti,bq25601", .data = (void *)BQ25601 },
>> + { .compatible = "ti,bq25601d", .data = (void *)BQ25601D },
>> + { .compatible = "ti,bq25611d", .data = (void *)BQ25611D },
>> + { .compatible = "ti,bq25618", .data = (void *)BQ25618 },
>> + { .compatible = "ti,bq25619", .data = (void *)BQ25619 },
>> + { },
>> +};
>> +MODULE_DEVICE_TABLE(of, bq256xx_of_match);
>> +
>> +static const struct acpi_device_id bq256xx_acpi_match[] = {
>> + { "bq25600", BQ25600 },
>> + { "bq25600d", BQ25600D },
>> + { "bq25601", BQ25601 },
>> + { "bq25601d", BQ25601D },
>> + { "bq25611d", BQ25611D },
>> + { "bq25618", BQ25618 },
>> + { "bq25619", BQ25619 },
>> + {},
>> +};
>> +MODULE_DEVICE_TABLE(acpi, bq256xx_acpi_match);
>> +
>> +static struct i2c_driver bq256xx_driver = {
>> + .driver = {
>> + .name = "bq256xx-charger",
>> + .of_match_table = bq256xx_of_match,
>> + .acpi_match_table = ACPI_PTR(bq256xx_acpi_match),
>> + },
>> + .probe = bq256xx_probe,
>> + .remove = bq256xx_remove,
>> + .id_table = bq256xx_i2c_ids,
>> +};
>> +module_i2c_driver(bq256xx_driver);
>> +
>> +MODULE_AUTHOR("Ricardo Rivera-Matos <[email protected]>");
>> +MODULE_DESCRIPTION("bq256xx charger driver");
>> +MODULE_LICENSE("GPL v2");
>> --
>> 2.28.0
>>
Ricardo