Hi, On Sun, Aug 23, 2020 at 05:08:42PM +0300, Dmitry Osipenko wrote: > This patch adds battery gauge driver for Acer Iconia Tab A500 device. > The battery gauge function is provided via the Embedded Controller, > which is found on the Acer A500. > > Signed-off-by: Dmitry Osipenko > --- > drivers/power/supply/Kconfig | 6 + > drivers/power/supply/Makefile | 1 + > drivers/power/supply/acer_a500_battery.c | 369 +++++++++++++++++++++++ > 3 files changed, 376 insertions(+) > create mode 100644 drivers/power/supply/acer_a500_battery.c > > diff --git a/drivers/power/supply/Kconfig b/drivers/power/supply/Kconfig > index faf2830aa152..dff5e5a7383f 100644 > --- a/drivers/power/supply/Kconfig > +++ b/drivers/power/supply/Kconfig > @@ -752,4 +752,10 @@ config CHARGER_WILCO > information can be found in > Documentation/ABI/testing/sysfs-class-power-wilco > > +config BATTERY_ACER_A500 > + tristate "Acer Iconia Tab A500 battery driver" > + depends on MFD_ACER_A500_EC > + help > + Say Y to include support for Acer Iconia Tab A500 battery fuel gauge. > + > endif # POWER_SUPPLY > diff --git a/drivers/power/supply/Makefile b/drivers/power/supply/Makefile > index b3c694a65114..08a5b49e2936 100644 > --- a/drivers/power/supply/Makefile > +++ b/drivers/power/supply/Makefile > @@ -96,3 +96,4 @@ obj-$(CONFIG_CHARGER_UCS1002) += ucs1002_power.o > obj-$(CONFIG_CHARGER_BD70528) += bd70528-charger.o > obj-$(CONFIG_CHARGER_BD99954) += bd99954-charger.o > obj-$(CONFIG_CHARGER_WILCO) += wilco-charger.o > +obj-$(CONFIG_BATTERY_ACER_A500) += acer_a500_battery.o > diff --git a/drivers/power/supply/acer_a500_battery.c b/drivers/power/supply/acer_a500_battery.c > new file mode 100644 > index 000000000000..933101e1261e > --- /dev/null > +++ b/drivers/power/supply/acer_a500_battery.c > @@ -0,0 +1,369 @@ > +// SPDX-License-Identifier: GPL-2.0+ > +/* > + * Battery driver for Acer Iconia Tab A500. > + * > + * Copyright 2020 GRATE-driver project. > + * > + * Based on downstream driver from Acer Inc. > + * Based on NVIDIA Gas Gauge driver for SBS Compliant Batteries. > + * > + * Copyright (c) 2010, NVIDIA Corporation. > + */ > + > +#include > +#include > +#include > +#include > +#include > +#include > + > +#include > + > +#define BATTERY_SERIAL_LEN 22 > + > +enum { > + REG_CAPACITY, > + REG_VOLTAGE, > + REG_CURRENT, > + REG_DESIGN_CAPACITY, > + REG_TEMPERATURE, > + REG_SERIAL_NUMBER, > +}; > + > +#define EC_DATA(_cmd, _delay, _psp) { \ > + .psp = POWER_SUPPLY_PROP_ ## _psp, \ > + .cmd = { \ > + .cmd = _cmd, \ > + .post_delay = _delay \ > + }, \ > +} > + > +static const struct chip_data { > + enum power_supply_property psp; > + struct a500_ec_cmd cmd; > +} ec_data[] = { > + [REG_CAPACITY] = EC_DATA(0x00, 0, CAPACITY), > + [REG_VOLTAGE] = EC_DATA(0x01, 0, VOLTAGE_NOW), > + [REG_CURRENT] = EC_DATA(0x03, 10, CURRENT_NOW), > + [REG_DESIGN_CAPACITY] = EC_DATA(0x08, 0, CHARGE_FULL_DESIGN), > + [REG_TEMPERATURE] = EC_DATA(0x0a, 0, TEMP), > + [REG_SERIAL_NUMBER] = EC_DATA(0x6a, 0, SERIAL_NUMBER), > +}; > + > +static const enum power_supply_property a500_battery_properties[] = { > + POWER_SUPPLY_PROP_CAPACITY, > + POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, > + POWER_SUPPLY_PROP_CURRENT_NOW, > + POWER_SUPPLY_PROP_PRESENT, > + POWER_SUPPLY_PROP_SERIAL_NUMBER, > + POWER_SUPPLY_PROP_STATUS, > + POWER_SUPPLY_PROP_TECHNOLOGY, > + POWER_SUPPLY_PROP_TEMP, > + POWER_SUPPLY_PROP_VOLTAGE_NOW, > +}; > + > +struct a500_battery { > + struct delayed_work poll_work; > + struct power_supply *psy; > + struct a500_ec *ec_chip; > + unsigned int capacity; > + char serial[BATTERY_SERIAL_LEN + 1]; > +}; > + > +static int a500_battery_get_presence(struct a500_battery *bat, > + union power_supply_propval *val) > +{ > + s32 ret; > + > + /* > + * DESIGN_CAPACITY register always returns a non-zero value if > + * battery is connected and zero if disconnected. > + */ > + ret = a500_ec_read(bat->ec_chip, &ec_data[REG_DESIGN_CAPACITY].cmd); > + if (ret <= 0) > + val->intval = 0; > + else > + val->intval = 1; > + > + return 0; > +} > + > +static bool a500_battery_update_capacity(struct a500_battery *bat) > +{ > + unsigned int capacity; > + s32 ret; > + > + ret = a500_ec_read(bat->ec_chip, &ec_data[REG_CAPACITY].cmd); > + if (ret < 0) > + return false; > + > + /* capacity can be >100% even if max value is 100% */ > + capacity = min(ret, 100); > + > + if (bat->capacity != capacity) { > + bat->capacity = capacity; > + return true; > + } > + > + return false; > +} > + > +static void a500_battery_get_status(struct a500_battery *bat, > + union power_supply_propval *val) > +{ > + if (bat->capacity < 100) { > + if (power_supply_am_i_supplied(bat->psy)) > + val->intval = POWER_SUPPLY_STATUS_CHARGING; > + else > + val->intval = POWER_SUPPLY_STATUS_DISCHARGING; > + } else { > + val->intval = POWER_SUPPLY_STATUS_FULL; > + } > +} > + > +static void a500_battery_unit_adjustment(struct device *dev, > + enum power_supply_property psp, > + union power_supply_propval *val) > +{ > + const unsigned int base_unit_conversion = 1000; > + const unsigned int temp_kelvin_to_celsius = 2731; > + > + switch (psp) { > + case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: > + case POWER_SUPPLY_PROP_CURRENT_NOW: > + case POWER_SUPPLY_PROP_VOLTAGE_NOW: > + val->intval *= base_unit_conversion; > + break; > + > + case POWER_SUPPLY_PROP_TEMP: > + val->intval -= temp_kelvin_to_celsius; > + break; > + > + default: > + dev_dbg(dev, > + "%s: no need for unit conversion %d\n", __func__, psp); > + } > +} > + > +static int a500_battery_get_serial_number(struct a500_battery *bat, > + union power_supply_propval *val) > +{ > + unsigned int i; > + s32 ret = 0; > + > + if (bat->serial[0]) > + goto done; > + > + a500_ec_lock(bat->ec_chip); > + for (i = 0; i < BATTERY_SERIAL_LEN / 2; i++) { > + ret = a500_ec_read_locked(bat->ec_chip, > + &ec_data[REG_SERIAL_NUMBER].cmd); > + if (ret < 0) { > + bat->serial[0] = '\0'; > + break; > + } > + > + bat->serial[i * 2 + 0] = (ret >> 0) & 0xff; > + bat->serial[i * 2 + 1] = (ret >> 8) & 0xff; > + } > + a500_ec_unlock(bat->ec_chip); > +done: > + val->strval = bat->serial; > + > + return ret; > +} If battery is swapped, this will keep the old serial. > +static int a500_battery_get_ec_data_index(struct device *dev, > + enum power_supply_property psp) > +{ > + unsigned int i; > + > + for (i = 0; i < ARRAY_SIZE(ec_data); i++) > + if (psp == ec_data[i].psp) > + return i; > + > + dev_dbg(dev, "%s: invalid property %u\n", __func__, psp); > + > + return -EINVAL; > +} > + > +static int a500_battery_get_simple_property(struct a500_battery *bat, > + union power_supply_propval *val, > + unsigned int ec_idx) > +{ > + s32 ret; > + > + ret = a500_ec_read(bat->ec_chip, &ec_data[ec_idx].cmd); > + if (ret < 0) > + return ret; > + > + val->intval = (u16)ret; > + > + return 0; > +} > + > +static int a500_battery_get_property(struct power_supply *psy, > + enum power_supply_property psp, > + union power_supply_propval *val) > +{ > + struct a500_battery *bat = power_supply_get_drvdata(psy); > + struct device *dev = psy->dev.parent; > + int ret = 0; > + > + switch (psp) { > + case POWER_SUPPLY_PROP_SERIAL_NUMBER: > + ret = a500_battery_get_serial_number(bat, val); > + break; > + > + case POWER_SUPPLY_PROP_PRESENT: > + ret = a500_battery_get_presence(bat, val); > + break; > + > + case POWER_SUPPLY_PROP_STATUS: > + a500_battery_get_status(bat, val); > + break; > + > + case POWER_SUPPLY_PROP_TECHNOLOGY: > + val->intval = POWER_SUPPLY_TECHNOLOGY_LION; > + break; > + > + case POWER_SUPPLY_PROP_CAPACITY: > + a500_battery_update_capacity(bat); > + val->intval = bat->capacity; > + break; > + > + case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: > + case POWER_SUPPLY_PROP_CURRENT_NOW: > + case POWER_SUPPLY_PROP_VOLTAGE_NOW: > + case POWER_SUPPLY_PROP_TEMP: > + ret = a500_battery_get_ec_data_index(dev, psp); > + if (ret < 0) > + break; > + > + ret = a500_battery_get_simple_property(bat, val, ret); > + break; > + > + default: > + dev_err(dev, "%s: invalid property %u\n", __func__, psp); > + return -EINVAL; > + } > + > + if (!ret) { > + /* convert units to match requirements for power supply class */ > + a500_battery_unit_adjustment(dev, psp, val); > + } > + > + dev_dbg(dev, "%s: property = %d, value = %x\n", > + __func__, psp, val->intval); > + > + /* return NODATA for properties if battery not presents */ > + if (ret) > + return -ENODATA; > + > + return 0; > +} > + > +static void a500_battery_delayed_work(struct work_struct *work) > +{ > + struct a500_battery *bat; > + bool capacity_changed; > + > + bat = container_of(work, struct a500_battery, poll_work.work); > + capacity_changed = a500_battery_update_capacity(bat); > + > + if (capacity_changed) > + power_supply_changed(bat->psy); > + > + /* continuously send uevent notification */ > + schedule_delayed_work(&bat->poll_work, 30 * HZ); > +} > + > +static const struct power_supply_desc a500_battery_desc = { > + .name = "ec-battery", > + .type = POWER_SUPPLY_TYPE_BATTERY, > + .properties = a500_battery_properties, > + .get_property = a500_battery_get_property, > + .num_properties = ARRAY_SIZE(a500_battery_properties), > + .external_power_changed = power_supply_changed, > +}; > + > +static int a500_battery_probe(struct platform_device *pdev) > +{ > + struct power_supply_config psy_cfg = {}; > + struct a500_battery *bat; > + int err; > + > + bat = devm_kzalloc(&pdev->dev, sizeof(*bat), GFP_KERNEL); > + if (!bat) > + return -ENOMEM; > + > + platform_set_drvdata(pdev, bat); > + > + psy_cfg.of_node = pdev->dev.parent->of_node; > + psy_cfg.drv_data = bat; > + > + bat->ec_chip = dev_get_drvdata(pdev->dev.parent); > + > + bat->psy = devm_power_supply_register_no_ws(&pdev->dev, > + &a500_battery_desc, > + &psy_cfg); > + err = PTR_ERR_OR_ZERO(bat->psy); > + if (err) { > + if (err == -EPROBE_DEFER) > + dev_dbg(&pdev->dev, "failed to register battery, deferring probe\n"); > + else > + dev_err(&pdev->dev, "failed to register battery: %d\n", > + err); > + return err; > + } if (IS_ERR(bat->psy)) return dev_err_probe(&pdev->dev, PTR_ERR(err), "failed to register battery\n"); > + > + INIT_DELAYED_WORK(&bat->poll_work, a500_battery_delayed_work); > + schedule_delayed_work(&bat->poll_work, HZ); > + > + return 0; > +} > + > +static int a500_battery_remove(struct platform_device *pdev) > +{ > + struct a500_battery *bat = dev_get_drvdata(&pdev->dev); > + > + cancel_delayed_work_sync(&bat->poll_work); > + > + return 0; > +} > + > +static int __maybe_unused a500_battery_suspend(struct device *dev) > +{ > + struct a500_battery *bat = dev_get_drvdata(dev); > + > + cancel_delayed_work_sync(&bat->poll_work); > + > + return 0; > +} > + > +static int __maybe_unused a500_battery_resume(struct device *dev) > +{ > + struct a500_battery *bat = dev_get_drvdata(dev); > + > + schedule_delayed_work(&bat->poll_work, HZ); > + > + return 0; > +} > + > +static SIMPLE_DEV_PM_OPS(a500_battery_pm_ops, > + a500_battery_suspend, a500_battery_resume); > + > +static struct platform_driver a500_battery_driver = { > + .driver = { > + .name = "acer-a500-iconia-battery", > + .pm = &a500_battery_pm_ops, > + }, > + .probe = a500_battery_probe, > + .remove = a500_battery_remove, > +}; > +module_platform_driver(a500_battery_driver); > + > +MODULE_DESCRIPTION("Battery gauge driver for Acer Iconia Tab A500"); > +MODULE_AUTHOR("Dmitry Osipenko "); > +MODULE_ALIAS("platform:acer-a500-iconia-battery"); > +MODULE_LICENSE("GPL v2"); MODULE_LICENSE("GPL"); Otherwise looks good to me. -- Sebastian