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 <dig...@gmail.com>
> ---
>  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 <linux/module.h>
> +#include <linux/platform_device.h>
> +#include <linux/power_supply.h>
> +#include <linux/sched.h>
> +#include <linux/slab.h>
> +#include <linux/workqueue.h>
> +
> +#include <linux/mfd/acer-ec-a500.h>
> +
> +#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 <dig...@gmail.com>");
> +MODULE_ALIAS("platform:acer-a500-iconia-battery");
> +MODULE_LICENSE("GPL v2");

MODULE_LICENSE("GPL");

Otherwise looks good to me.

-- Sebastian

Attachment: signature.asc
Description: PGP signature

Reply via email to