From mboxrd@z Thu Jan 1 00:00:00 1970 From: maxime.ripard@free-electrons.com (Maxime Ripard) Date: Thu, 23 Oct 2014 11:29:17 +0200 Subject: [RFC Patch 2/4] mfd: AXP20x: Add power supply sub-driver In-Reply-To: <20141022083013.6b90be7e@pluto.restena.lu> References: <20141020221959.2f312906@neptune.home> <20141020223320.2b4ecba9@neptune.home> <20141021202715.GC7893@lukather> <20141022083013.6b90be7e@pluto.restena.lu> Message-ID: <20141023092917.GK7893@lukather> To: linux-arm-kernel@lists.infradead.org List-Id: linux-arm-kernel.lists.infradead.org Hi, On Wed, Oct 22, 2014 at 08:30:13AM +0200, Bruno Pr?mont wrote: > > > + > > > +static int axp20x_power_poll(struct axp20x_power *devdata, int init) > > > +{ > > > + struct axp20x_dev *axp20x = devdata->axp20x; > > > + struct timespec ts; > > > + int ret, status1, status2, vbusmgt, adc_cfg, bpercent; > > > + uint8_t adc[19]; > > > + > > > + getnstimeofday(&ts); > > > + /* only query hardware if our data is stale */ > > > > Is it called that often? > > Pretty often yes. > When accessing /sys/class/power_supply/*/uevent it's one call per > property, for the property specific sysfs files its one per file read. > > Notifying power_supply subsystem about changes also triggers one access > per defined property. > > Initially I tried without caching data and it caused quite severe > latencies (would have to redo the tests for proper quantifying). Hmmm, it's odd, I would have expected that the framework would have some kind of rate limiting. > I looked at regmap's caching feature but it seems not possible to tell > it to flush (part of) its cache. I think regcache_drop_region is here just for that. > > > > + spin_lock(&devdata->lock); > > > + if (!init && !(ts.tv_sec > devdata->next_check.tv_sec || > > > + ts.tv_nsec > devdata->next_check.tv_sec)) { > > > + spin_unlock(&devdata->lock); > > > + return 0; > > > + } > > > + spin_unlock(&devdata->lock); > > > + > > > + ret = regmap_read(axp20x->regmap, AXP20X_PWR_INPUT_STATUS, &status1); > > > + if (ret) > > > + return ret; > > > + ret = regmap_read(axp20x->regmap, AXP20X_PWR_OP_MODE, &status2); > > > + if (ret) > > > + return ret; > > > + > > > + ret = regmap_read(axp20x->regmap, AXP20X_ADC_RATE, &adc_cfg); > > > + if (ret) > > > + return ret; > > > + > > > + if (init == 2) { > > > + int reg = AXP20X_ADC_EN1_VBUS_V | AXP20X_ADC_EN1_VBUS_C; > > > + > > > + if (!(status1 & AXP20X_PWR_STATUS_AC_VBUS_SHORT)) > > > + reg |= AXP20X_ADC_EN1_ACIN_V | AXP20X_ADC_EN1_ACIN_C; > > > + if (devdata->battery_name[0]) > > > + reg |= AXP20X_ADC_EN1_BATT_V | AXP20X_ADC_EN1_BATT_C; > > > + if (devdata->battery_name[0] && > > > + !(adc_cfg & AXP20X_ADR_TS_UNRELATED)) > > > + reg |= AXP20X_ADC_EN1_TEMP; > > > + > > > + regmap_update_bits(axp20x->regmap, AXP20X_ADC_EN1, > > > + AXP20X_ADC_EN1_ACIN_V | AXP20X_ADC_EN1_ACIN_C | > > > + AXP20X_ADC_EN1_VBUS_V | AXP20X_ADC_EN1_VBUS_C | > > > + AXP20X_ADC_EN1_BATT_V | AXP20X_ADC_EN1_BATT_C | > > > + AXP20X_ADC_EN1_TEMP, reg); > > > + } > > > + > > > + ret = regmap_read(axp20x->regmap, AXP20X_VBUS_IPSOUT_MGMT, &vbusmgt); > > > + if (ret) > > > + return ret; > > > + > > > + ret = regmap_bulk_read(axp20x->regmap, AXP20X_ACIN_V_ADC_H, adc, 8); > > > + if (ret) > > > + return ret; > > > + if (devdata->battery_name[0] && !(adc_cfg & AXP20X_ADR_TS_UNRELATED)) { > > > + ret = regmap_bulk_read(axp20x->regmap, AXP20X_TS_IN_H, adc+8, 2); > > > + if (ret) > > > + return ret; > > > + } > > > + if (devdata->battery_name[0]) { > > > + ret = regmap_bulk_read(axp20x->regmap, AXP20X_PWR_BATT_H, adc+10, 3); > > > + if (ret) > > > + return ret; > > > + ret = regmap_bulk_read(axp20x->regmap, AXP20X_BATT_V_H, adc+13, 6); > > > + if (ret) > > > + return ret; > > > + ret = regmap_read(axp20x->regmap, AXP20X_FG_RES, &bpercent); > > > + if (ret) > > > + return ret; > > > + } > > > + > > > + switch (adc_cfg & AXP20X_ADR_RATE_MASK) { > > > + case AXP20X_ADR_RATE_200Hz: > > > + timespec_add_ns(&ts, 5000000); break; > > > + case AXP20X_ADR_RATE_100Hz: > > > + timespec_add_ns(&ts, 10000000); break; > > > + case AXP20X_ADR_RATE_50Hz: > > > + timespec_add_ns(&ts, 20000000); break; > > > + case AXP20X_ADR_RATE_25Hz: > > > + default: > > > + timespec_add_ns(&ts, 40000000); > > > + } > > > + > > > + ret = devdata->status1 | (devdata->status2 << 8) | > > > + ((devdata->batt_percent & 0x7f) << 16); > > > + if (init == 2) > > > + timespec_add_ns(&ts, 200000000); > > > + spin_lock(&devdata->lock); > > > + devdata->vac = ((adc[0] << 4) | (adc[1] & 0x0f)) * 1700; > > > + devdata->iac = ((adc[2] << 4) | (adc[3] & 0x0f)) * 625; > > > + devdata->vvbus = ((adc[4] << 4) | (adc[5] & 0x0f)) * 1700; > > > + devdata->ivbus = ((adc[6] << 4) | (adc[7] & 0x0f)) * 375; > > > + devdata->next_check = ts; > > > + devdata->vbusmgt = vbusmgt; > > > + devdata->status1 = status1; > > > + devdata->status2 = status2; > > > + if (devdata->battery_name[0] && !(adc_cfg & AXP20X_ADR_TS_UNRELATED)) > > > + devdata->tbatt = ((adc[8] << 4) | (adc[9] & 0x0f)) * 800; > > > + if (devdata->battery_name[0]) { > > > + devdata->vbatt = ((adc[13] << 4) | (adc[14] & 0x0f)) * 1100; > > > + if (status1 & AXP20X_PWR_STATUS_BAT_CHARGING) > > > + devdata->ibatt = ((adc[15] << 4) | (adc[16] & 0x0f)); > > > + else > > > + devdata->ibatt = ((adc[17] << 4) | (adc[18] & 0x0f)); > > > + devdata->ibatt *= 500; > > > + devdata->pbatt = ((adc[10] << 16) | (adc[11] << 8) | adc[12]) * > > > + 55 / 100; > > > + devdata->batt_percent = bpercent & 0x7f; > > > + } > > > + spin_unlock(&devdata->lock); > > > + > > > + if (init == 2 || init == 0) > > > + return 0; > > > + > > > + if ((ret ^ status1) & (AXP20X_PWR_STATUS_VBUS_PRESENT | > > > + AXP20X_PWR_STATUS_VBUS_AVAILABLE)) > > > + power_supply_changed(&devdata->vbus); > > > + if (devdata->ac_name[0]) { > > > + } else if ((ret ^ status1) & (AXP20X_PWR_STATUS_AC_PRESENT | > > > + AXP20X_PWR_STATUS_AC_AVAILABLE)) > > > + power_supply_changed(&devdata->ac); > > > + if (!devdata->battery_name[0]) { > > > + } else if ((ret ^ status1) & AXP20X_PWR_STATUS_BAT_CHARGING) { > > > + power_supply_changed(&devdata->battery); > > > + } else if (((ret >> 8) ^ status2) & (AXP20X_PWR_OP_CHARGING | > > > + AXP20X_PWR_OP_BATT_PRESENT | AXP20X_PWR_OP_BATT_ACTIVATED | > > > + AXP20X_PWR_OP_BATT_CHG_CURRENT_LOW)) { > > > + power_supply_changed(&devdata->battery); > > > + } else if (((ret >> 16) & 0x7f) != (bpercent & 0x7f)) { > > > + power_supply_changed(&devdata->battery); > > > + } > > > + return 0; > > > +} > > > + > > > +static void axp20x_power_monitor(struct work_struct *work) > > > +{ > > > + struct axp20x_power *devdata = container_of(work, > > > + struct axp20x_power, work); > > > + > > > + axp20x_power_poll(devdata, 1); > > > + > > > + /* TODO: check status for consitency > > > + * adjust battery charging parameters as needed > > > + */ > > > +} > > > + > > > +/* ********************************************** * > > > + * *** RTC / Backup battery charger *** * > > > + * ********************************************** */ > > > + > > > +/* Fields of AXP20X_CHRG_BAK_CTRL */ > > > +#define AXP20X_BACKUP_ENABLE (0x01 << 7) > > > +#define AXP20X_BACKUP_VOLTAGE_MASK (0x03 << 5) > > > +#define AXP20X_BACKUP_VOLTAGE_3_1V (0x00 << 5) > > > +#define AXP20X_BACKUP_VOLTAGE_3_0V (0x01 << 5) > > > +#define AXP20X_BACKUP_VOLTAGE_3_6V (0x02 << 5) > > > +#define AXP20X_BACKUP_VOLTAGE_2_5V (0x03 << 5) > > > +#define AXP20X_BACKUP_CURRENT_MASK 0x03 > > > +#define AXP20X_BACKUP_CURRENT_50uA 0x00 > > > +#define AXP20X_BACKUP_CURRENT_100uA 0x01 > > > +#define AXP20X_BACKUP_CURRENT_200uA 0x02 > > > +#define AXP20X_BACKUP_CURRENT_400uA 0x03 > > > + > > > +static int axp20x_backup_config(struct platform_device *pdev, > > > + struct axp20x_dev *axp20x) > > > +{ > > > + struct device_node *np; > > > + int ret = 0, reg, new_reg = 0; > > > + u32 lim[2]; > > > + > > > + ret = regmap_read(axp20x->regmap, AXP20X_CHRG_BAK_CTRL, ®); > > > + if (ret) > > > + return ret; > > > + > > > + np = of_node_get(axp20x->dev->of_node); > > > + if (!np) > > > + return -ENODEV; > > > + > > > + ret = of_property_read_u32_array(np, "backup", lim, 2); > > > + if (ret != 0) > > > + goto err; > > > + > > > + switch (lim[0]) { > > > + case 2500000: > > > + new_reg |= AXP20X_BACKUP_VOLTAGE_2_5V; > > > + break; > > > + case 3000000: > > > + new_reg |= AXP20X_BACKUP_VOLTAGE_3_0V; > > > + break; > > > + case 3100000: > > > + new_reg |= AXP20X_BACKUP_VOLTAGE_3_1V; > > > + break; > > > + case 3600000: > > > + new_reg |= AXP20X_BACKUP_VOLTAGE_3_6V; > > > + break; > > > + default: > > > + dev_warn(&pdev->dev, "Invalid backup DT voltage limit %u\n", lim[0]); > > > + ret = -EINVAL; > > > + goto err; > > > + } > > > + switch (lim[1]) { > > > + case 50: > > > + new_reg |= AXP20X_BACKUP_CURRENT_50uA; > > > + break; > > > + case 100: > > > + new_reg |= AXP20X_BACKUP_CURRENT_100uA; > > > + break; > > > + case 200: > > > + new_reg |= AXP20X_BACKUP_CURRENT_200uA; > > > + break; > > > + case 400: > > > + new_reg |= AXP20X_BACKUP_CURRENT_400uA; > > > + break; > > > + default: > > > + dev_warn(&pdev->dev, "Invalid backup DT current limit %u\n", lim[1]); > > > + ret = -EINVAL; > > > + goto err; > > > + } > > > + new_reg |= AXP20X_BACKUP_ENABLE; > > > + > > > + ret = regmap_update_bits(axp20x->regmap, AXP20X_CHRG_BAK_CTRL, > > > + AXP20X_BACKUP_ENABLE | AXP20X_BACKUP_VOLTAGE_MASK | > > > + AXP20X_BACKUP_CURRENT_MASK, new_reg); > > > + if (ret) > > > + dev_warn(&pdev->dev, "Failed to adjust backup battery settings: %d\n", ret); > > > + > > > +err: > > > + of_node_put(np); > > > + return ret; > > > +} > > > + > > > +static int axp20x_backup_get_prop(struct power_supply *psy, > > > + enum power_supply_property psp, > > > + union power_supply_propval *val) > > > +{ > > > + struct axp20x_power *devdata = dev_get_drvdata(psy->dev->parent); > > > + int ret = 0, reg; > > > + > > > + ret = regmap_read(devdata->axp20x->regmap, AXP20X_CHRG_BAK_CTRL, ®); > > > + if (ret < 0) > > > + return ret; > > > + > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_STATUS: > > > + if ((reg & AXP20X_BACKUP_ENABLE)) > > > + val->intval = POWER_SUPPLY_STATUS_CHARGING; > > > + else > > > + val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE: > > > + switch ((reg & AXP20X_BACKUP_VOLTAGE_MASK)) { > > > + case AXP20X_BACKUP_VOLTAGE_2_5V: > > > + val->intval = 2500000; break; > > > + case AXP20X_BACKUP_VOLTAGE_3_0V: > > > + val->intval = 3000000; break; > > > + case AXP20X_BACKUP_VOLTAGE_3_1V: > > > + val->intval = 3100000; break; > > > + case AXP20X_BACKUP_VOLTAGE_3_6V: > > > + val->intval = 3600000; break; > > > + default: > > > + val->intval = 0; > > > + } > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT: > > > + switch ((reg & AXP20X_BACKUP_CURRENT_MASK)) { > > > + case AXP20X_BACKUP_CURRENT_50uA: > > > + val->intval = 50; break; > > > + case AXP20X_BACKUP_CURRENT_100uA: > > > + val->intval = 100; break; > > > + case AXP20X_BACKUP_CURRENT_200uA: > > > + val->intval = 200; break; > > > + case AXP20X_BACKUP_CURRENT_400uA: > > > + val->intval = 400; break; > > > + default: > > > + val->intval = 0; > > > + } > > > + break; > > > + > > > + default: > > > + ret = -EINVAL; > > > + break; > > > + } > > > + > > > + return ret; > > > +} > > > + > > > +static int axp20x_backup_set_prop(struct power_supply *psy, > > > + enum power_supply_property psp, > > > + const union power_supply_propval *val) > > > +{ > > > + struct axp20x_power *devdata = dev_get_drvdata(psy->dev->parent); > > > + int ret; > > > + > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_STATUS: > > > + if (val->intval == POWER_SUPPLY_STATUS_CHARGING) > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_CHRG_BAK_CTRL, > > > + AXP20X_BACKUP_ENABLE, > > > + AXP20X_BACKUP_ENABLE); > > > + else if (val->intval == POWER_SUPPLY_STATUS_NOT_CHARGING) > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_CHRG_BAK_CTRL, > > > + AXP20X_BACKUP_ENABLE, 0); > > > + else > > > + ret = -EINVAL; > > > + break; > > > + > > > + default: > > > + ret = -EINVAL; > > > + } > > > + return ret; > > > +} > > > + > > > +static int axp20x_backup_prop_writeable(struct power_supply *psy, > > > + enum power_supply_property psp) > > > +{ > > > + return psp == POWER_SUPPLY_PROP_STATUS; > > > +} > > > + > > > +static enum power_supply_property axp20x_backup_props[] = { > > > + POWER_SUPPLY_PROP_STATUS, > > > + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE, > > > + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT, > > > +}; > > > + > > > +/* ********************************************** * > > > + * *** ACIN power supply *** * > > > + * ********************************************** */ > > > + > > > +static int axp20x_ac_get_prop(struct power_supply *psy, > > > + enum power_supply_property psp, > > > + union power_supply_propval *val) > > > +{ > > > + struct axp20x_power *devdata = dev_get_drvdata(psy->dev->parent); > > > + int ret; > > > + > > > + ret = axp20x_power_poll(devdata, 0); > > > + if (ret) > > > + return ret; > > > + > > > + spin_lock(&devdata->lock); > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_PRESENT: > > > + val->intval = !!(devdata->status1 & AXP20X_PWR_STATUS_AC_PRESENT); > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_ONLINE: > > > + val->intval = !!(devdata->status1 & AXP20X_PWR_STATUS_AC_AVAILABLE); > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_NOW: > > > + val->intval = devdata->vac; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CURRENT_NOW: > > > + val->intval = devdata->iac; > > > + break; > > > + > > > + default: > > > + ret = -EINVAL; > > > + } > > > + spin_unlock(&devdata->lock); > > > + > > > + return ret; > > > +} > > > + > > > +static enum power_supply_property axp20x_ac_props[] = { > > > + POWER_SUPPLY_PROP_PRESENT, > > > + POWER_SUPPLY_PROP_ONLINE, > > > + POWER_SUPPLY_PROP_VOLTAGE_NOW, > > > + POWER_SUPPLY_PROP_CURRENT_NOW, > > > +}; > > > + > > > +/* ********************************************** * > > > + * *** VBUS power supply *** * > > > + * ********************************************** */ > > > + > > > +static int axp20x_vbus_get_prop(struct power_supply *psy, > > > + enum power_supply_property psp, > > > + union power_supply_propval *val) > > > +{ > > > + struct axp20x_power *devdata = dev_get_drvdata(psy->dev->parent); > > > + int ret; > > > + > > > + ret = axp20x_power_poll(devdata, 0); > > > + if (ret) > > > + return ret; > > > + > > > + spin_lock(&devdata->lock); > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_PRESENT: > > > + val->intval = !!(devdata->status1 & AXP20X_PWR_STATUS_VBUS_PRESENT); > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_ONLINE: > > > + val->intval = !!(devdata->status1 & AXP20X_PWR_STATUS_VBUS_AVAILABLE); > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_NOW: > > > + val->intval = devdata->vvbus; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CURRENT_NOW: > > > + val->intval = devdata->ivbus; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CURRENT_MAX: > > > + switch (devdata->vbusmgt & AXP20X_VBUS_CLIMIT_MASK) { > > > + case AXP20X_VBUC_CLIMIT_100mA: > > > + val->intval = 100000; break; > > > + case AXP20X_VBUC_CLIMIT_500mA: > > > + val->intval = 500000; break; > > > + case AXP20X_VBUC_CLIMIT_900mA: > > > + val->intval = 900000; break; > > > + case AXP20X_VBUC_CLIMIT_NONE: > > > + default: > > > + val->intval = -1; > > > + } > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_MIN: > > > + val->intval = AXP20X_VBUS_VHOLD_mV(devdata->vbusmgt); > > > + break; > > > + > > > + default: > > > + ret = -EINVAL; > > > + } > > > + spin_unlock(&devdata->lock); > > > + > > > + return ret; > > > +} > > > + > > > +static int axp20x_vbus_set_prop(struct power_supply *psy, > > > + enum power_supply_property psp, > > > + const union power_supply_propval *val) > > > +{ > > > + struct axp20x_power *devdata = dev_get_drvdata(psy->dev->parent); > > > + int ret, reg; > > > + > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_CURRENT_MAX: > > > + if (val->intval == 100000) > > > + reg = AXP20X_VBUC_CLIMIT_100mA; > > > + else if (val->intval == 500000) > > > + reg = AXP20X_VBUC_CLIMIT_500mA; > > > + else if (val->intval == 900000) > > > + reg = AXP20X_VBUC_CLIMIT_900mA; > > > + else if (val->intval == -1) > > > + reg = AXP20X_VBUC_CLIMIT_NONE; > > > + else { > > > + ret = -EINVAL; > > > + break; > > > + } > > > + regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_VBUS_IPSOUT_MGMT, > > > + AXP20X_VBUS_CLIMIT_MASK, reg); > > > + spin_lock(&devdata->lock); > > > + devdata->vbusmgt = (devdata->vbusmgt & ~AXP20X_VBUS_CLIMIT_MASK) | > > > + (reg & AXP20X_VBUS_CLIMIT_MASK); > > > + spin_unlock(&devdata->lock); > > > + ret = 0; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_MIN: > > > + if (val->intval < 4000000) { > > > + ret = -EINVAL; > > > + break; > > > + } else > > > + reg = val->intval / 100000; > > > + if ((reg & 7) != reg) { > > > + ret = -EINVAL; > > > + break; > > > + } else > > > + reg = reg << 3; > > > + regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_VBUS_IPSOUT_MGMT, > > > + AXP20X_VBUS_VHOLD_MASK, reg); > > > + spin_lock(&devdata->lock); > > > + devdata->vbusmgt = (devdata->vbusmgt & ~AXP20X_VBUS_VHOLD_MASK) | > > > + (reg & AXP20X_VBUS_VHOLD_MASK); > > > + spin_unlock(&devdata->lock); > > > + ret = 0; > > > + break; > > > + > > > + default: > > > + ret = -EINVAL; > > > + } > > > + return ret; > > > +} > > > + > > > +static enum power_supply_property axp20x_vbus_props[] = { > > > + POWER_SUPPLY_PROP_PRESENT, > > > + POWER_SUPPLY_PROP_ONLINE, > > > + POWER_SUPPLY_PROP_VOLTAGE_NOW, > > > + POWER_SUPPLY_PROP_CURRENT_NOW, > > > + POWER_SUPPLY_PROP_VOLTAGE_MIN, > > > + POWER_SUPPLY_PROP_CURRENT_MAX, > > > +}; > > > + > > > +static int axp20x_vbus_prop_writeable(struct power_supply *psy, > > > + enum power_supply_property psp) > > > +{ > > > + return psp == POWER_SUPPLY_PROP_VOLTAGE_MIN || > > > + psp == POWER_SUPPLY_PROP_CURRENT_MAX; > > > +} > > > + > > > + > > > +/* ********************************************** * > > > + * *** main battery charger *** * > > > + * ********************************************** */ > > > + > > > +static void axp20x_battery_chg_reconfig(struct power_supply *psy); > > > + > > > +static int axp20x_battery_config(struct platform_device *pdev, > > > + struct axp20x_power *devdata, > > > + struct axp20x_dev *axp20x) > > > +{ > > > + struct device_node *np; > > > + int i, ret = 0, reg, new_reg = 0; > > > + u32 ocv[16], temp[3], rdc, capa; > > > + > > > + ret = regmap_read(axp20x->regmap, AXP20X_PWR_OP_MODE, ®); > > > + if (ret) > > > + return ret; > > > + > > > + np = of_node_get(axp20x->dev->of_node); > > > + if (!np) > > > + return -ENODEV; > > > + > > > + ret = of_property_read_u32_array(np, "battery.ocv", ocv, 16); > > > + for (i = 0; ret == 0 && i < ARRAY_SIZE(ocv); i++) > > > + if (ocv[i] > 100) { > > > + dev_warn(&pdev->dev, "OCV[%d] %u > 100\n", i, ocv[i]); > > > + ret = -EINVAL; > > > + goto err; > > > + } > > > + > > > + ret = of_property_read_u32_array(np, "battery.resistance", &rdc, 1); > > > + if (ret != 0) > > > + rdc = 100; > > > + > > > + ret = of_property_read_u32_array(np, "battery.capacity", &capa, 1); > > > + if (ret != 0) > > > + capa = 0; > > > + > > > + ret = of_property_read_u32_array(np, "battery.temp_sensor", temp, 3); > > > + if (ret != 0) > > > + memset(temp, 0, sizeof(temp)); > > > + else if (temp[0] != 20 && temp[0] != 40 && temp[0] != 60 && > > > + temp[0] != 80) { > > > + dev_warn(&pdev->dev, "Invalid battery temperature sensor current setting\n"); > > > + ret = -EINVAL; > > > + memset(temp, 0, sizeof(temp)); > > > + } > > > + > > > + dev_info(&pdev->dev, "FDT settings: capacity=%d, resistance=%d, temp_sensor=<%d %d %d>\n", capa, rdc, temp[0], temp[1], temp[2]); > > > + /* apply settings */ > > > + devdata->batt_health = POWER_SUPPLY_HEALTH_UNKNOWN; > > > + regmap_update_bits(axp20x->regmap, AXP20X_FG_RES, AXP20X_FG_ENABLE, 0x00); > > > + regmap_update_bits(axp20x->regmap, AXP20X_RDC_H, 0x80, 0x00); > > > + regmap_update_bits(axp20x->regmap, AXP20X_RDC_L, 0xff, (rdc * 10000 + 5371) / 10742); > > > + regmap_update_bits(axp20x->regmap, AXP20X_RDC_H, 0x1f, ((rdc * 10000 + 5371) / 10742) >> 8); > > > + if (of_find_property(np, "battery.ocv", NULL)) > > > + for (i = 0; i < ARRAY_SIZE(ocv); i++) { > > > + ret = regmap_update_bits(axp20x->regmap, AXP20X_OCV(i), > > > + 0xff, ocv[i]); > > > + if (ret) > > > + dev_warn(&pdev->dev, > > > + "Failed to store OCV[%d] setting: %d\n", > > > + i, ret); > > > + } > > > + regmap_update_bits(axp20x->regmap, AXP20X_FG_RES, AXP20X_FG_ENABLE, AXP20X_FG_ENABLE); > > > + > > > + if (capa == 0 && !(reg & AXP20X_PWR_OP_BATT_PRESENT)) { > > > + /* No battery present or configured -> disable */ > > > + regmap_update_bits(axp20x->regmap, AXP20X_CHRG_CTRL1, AXP20X_CHRG_CTRL1_ENABLE, 0x00); > > > + regmap_update_bits(axp20x->regmap, AXP20X_OFF_CTRL, AXP20X_OFF_CTRL_BATT_MON, 0x00); > > > + dev_info(&pdev->dev, "No battery, disabling charger\n"); > > > + ret = -ENODEV; > > > + goto err; > > > + } > > > + > > > + if (temp[0] == 0) { > > > + regmap_update_bits(axp20x->regmap, AXP20X_ADC_RATE, > > > + AXP20X_ADR_TS_WHEN_MASK | > > > + AXP20X_ADR_TS_UNRELATED, > > > + AXP20X_ADR_TS_UNRELATED | > > > + AXP20X_ADR_TS_WHEN_OFF); > > > + } else { > > > + devdata->tbatt_min = temp[1]; > > > + devdata->tbatt_max = temp[2]; > > > + switch (temp[0]) { > > > + case 20: > > > + regmap_update_bits(axp20x->regmap, AXP20X_ADC_RATE, > > > + AXP20X_ADR_TS_CURR_MASK | > > > + AXP20X_ADR_TS_WHEN_MASK | > > > + AXP20X_ADR_TS_UNRELATED, > > > + AXP20X_ADR_TS_CURR_20uA | > > > + AXP20X_ADR_TS_WHEN_ADC); > > > + break; > > > + case 40: > > > + regmap_update_bits(axp20x->regmap, AXP20X_ADC_RATE, > > > + AXP20X_ADR_TS_CURR_MASK | > > > + AXP20X_ADR_TS_WHEN_MASK | > > > + AXP20X_ADR_TS_UNRELATED, > > > + AXP20X_ADR_TS_CURR_40uA | > > > + AXP20X_ADR_TS_WHEN_ADC); > > > + break; > > > + case 60: > > > + regmap_update_bits(axp20x->regmap, AXP20X_ADC_RATE, > > > + AXP20X_ADR_TS_CURR_MASK | > > > + AXP20X_ADR_TS_WHEN_MASK | > > > + AXP20X_ADR_TS_UNRELATED, > > > + AXP20X_ADR_TS_CURR_60uA | > > > + AXP20X_ADR_TS_WHEN_ADC); > > > + break; > > > + case 80: > > > + regmap_update_bits(axp20x->regmap, AXP20X_ADC_RATE, > > > + AXP20X_ADR_TS_CURR_MASK | > > > + AXP20X_ADR_TS_WHEN_MASK | > > > + AXP20X_ADR_TS_UNRELATED, > > > + AXP20X_ADR_TS_CURR_80uA | > > > + AXP20X_ADR_TS_WHEN_ADC); > > > + break; > > > + } > > > + new_reg = temp[1] / (0x10 * 800); > > > + regmap_update_bits(axp20x->regmap, AXP20X_V_HTF_CHRG, 0xff, > > > + new_reg); > > > + regmap_update_bits(axp20x->regmap, AXP20X_V_HTF_DISCHRG, 0xff, > > > + new_reg); > > > + new_reg = temp[2] / (0x10 * 800); > > > + regmap_update_bits(axp20x->regmap, AXP20X_V_LTF_CHRG, 0xff, > > > + new_reg); > > > + regmap_update_bits(axp20x->regmap, AXP20X_V_LTF_DISCHRG, 0xff, > > > + new_reg); > > > + } > > > + devdata->batt_capacity = capa * 1000; > > > + devdata->batt_user_imax = (capa < 300 ? 300 : capa) * 1000; > > > + /* Prefer longer battery life over longer runtime. */ > > > + regmap_update_bits(devdata->axp20x->regmap, AXP20X_CHRG_CTRL1, > > > + AXP20X_CHRG_CTRL1_TGT_VOLT, > > > + AXP20X_CHRG_CTRL1_TGT_4_15V); > > > + > > > + /* TODO: configure CHGLED? */ > > > + > > > + /* Default to about 5% capacity, about 3.5V */ > > > + regmap_update_bits(axp20x->regmap, AXP20X_APS_WARN_L1, 0xff, > > > + (3500000 - 2867200) / 4 / 1400); > > > + regmap_update_bits(axp20x->regmap, AXP20X_APS_WARN_L2, 0xff, > > > + (3304000 - 2867200) / 4 / 1400); > > > + /* RDC - disable capacity monitor, reconfigure, re-enable */ > > > + regmap_update_bits(axp20x->regmap, AXP20X_FG_RES, 0x80, 0x80); > > > + regmap_update_bits(axp20x->regmap, AXP20X_RDC_H, 0x80, 0x00); > > > + regmap_update_bits(axp20x->regmap, AXP20X_RDC_H, 0x1f, ((rdc * 10000 + 5371) / 10742) >> 8); > > > + regmap_update_bits(axp20x->regmap, AXP20X_RDC_L, 0xff, (rdc * 10000 + 5371) / 10742); > > > + regmap_update_bits(axp20x->regmap, AXP20X_FG_RES, 0x80, 0x00); > > > + regmap_update_bits(axp20x->regmap, AXP20X_OFF_CTRL, AXP20X_OFF_CTRL_BATT_MON, AXP20X_OFF_CTRL_BATT_MON); > > > + axp20x_battery_chg_reconfig(&devdata->battery); > > > + ret = 0; > > > + > > > +err: > > > + of_node_put(np); > > > + return ret; > > > +} > > > + > > > +static int axp20x_battery_uv_to_temp(struct axp20x_power *devdata, int uv) > > > +{ > > > + /* TODO: convert ?V to ?C */ > > > + return uv; > > > +} > > > + > > > +static int axp20x_battery_get_prop(struct power_supply *psy, > > > + enum power_supply_property psp, > > > + union power_supply_propval *val) > > > +{ > > > + struct axp20x_power *devdata = dev_get_drvdata(psy->dev->parent); > > > + int ret, reg; > > > + > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_CURRENT_MAX: > > > + ret = regmap_read(devdata->axp20x->regmap, AXP20X_CHRG_CTRL1, > > > + ®); > > > + if (ret) > > > + return ret; > > > + val->intval = (reg & AXP20X_CHRG_CTRL1_TGT_CURR) * 100000 + > > > + 300000; > > > + return 0; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: > > > + ret = regmap_read(devdata->axp20x->regmap, AXP20X_CHRG_CTRL1, > > > + ®); > > > + if (ret) > > > + return ret; > > > + switch (reg & AXP20X_CHRG_CTRL1_TGT_VOLT) { > > > + case AXP20X_CHRG_CTRL1_TGT_4_1V: > > > + val->intval = 4100000; > > > + break; > > > + case AXP20X_CHRG_CTRL1_TGT_4_15V: > > > + val->intval = 4150000; > > > + break; > > > + case AXP20X_CHRG_CTRL1_TGT_4_2V: > > > + val->intval = 4200000; > > > + break; > > > + case AXP20X_CHRG_CTRL1_TGT_4_36V: > > > + val->intval = 4360000; > > > + break; > > > + default: > > > + ret = -EINVAL; > > > + } > > > + return 0; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: > > > + ret = regmap_read(devdata->axp20x->regmap, AXP20X_APS_WARN_L2, > > > + ®); > > > + if (ret) > > > + return ret; > > > + val->intval = 2867200 + 1400 * reg * 4; > > > + return 0; > > > + > > > + case POWER_SUPPLY_PROP_TECHNOLOGY: > > > + val->intval = POWER_SUPPLY_TECHNOLOGY_LION; > > > + return 0; > > > + > > > + default: > > > + break; > > > + } > > > + > > > + ret = axp20x_power_poll(devdata, 0); > > > + if (ret) > > > + return ret; > > > + > > > + spin_lock(&devdata->lock); > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_PRESENT: > > > + case POWER_SUPPLY_PROP_ONLINE: > > > + val->intval = !!(devdata->status2 & AXP20X_PWR_OP_BATT_PRESENT); > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_STATUS: > > > + if (devdata->status1 & AXP20X_PWR_STATUS_BAT_CHARGING) > > > + val->intval = POWER_SUPPLY_STATUS_CHARGING; > > > + else if (devdata->ibatt == 0 && devdata->batt_percent == 100) > > > + val->intval = POWER_SUPPLY_STATUS_FULL; > > > + else if (devdata->ibatt == 0) > > > + val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING; > > > + else > > > + val->intval = POWER_SUPPLY_STATUS_DISCHARGING; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CURRENT_NOW: > > > + val->intval = devdata->ibatt; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_HEALTH: > > > + val->intval = POWER_SUPPLY_HEALTH_UNKNOWN; > > > + // POWER_SUPPLY_HEALTH_GOOD, POWER_SUPPLY_HEALTH_OVERHEAT, POWER_SUPPLY_HEALTH_DEAD, POWER_SUPPLY_HEALTH_OVERVOLTAGE, POWER_SUPPLY_HEALTH_UNSPEC_FAILURE, POWER_SUPPLY_HEALTH_COLD, POWER_SUPPLY_HEALTH_SAFETY_TIMER_EXPIRE > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_NOW: > > > + val->intval = devdata->vbatt; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_POWER_NOW: > > > + val->intval = devdata->pbatt; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: > > > + val->intval = devdata->batt_capacity; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CHARGE_NOW: > > > + /* TODO */ > > > + val->intval = 12345; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_CAPACITY: > > > + val->intval = devdata->batt_percent; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_TEMP: > > > + val->intval = axp20x_battery_uv_to_temp(devdata, > > > + devdata->tbatt); > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_TEMP_ALERT_MIN: > > > + val->intval = axp20x_battery_uv_to_temp(devdata, > > > + devdata->tbatt_min); > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_TEMP_ALERT_MAX: > > > + val->intval = axp20x_battery_uv_to_temp(devdata, > > > + devdata->tbatt_max); > > > + break; > > > + > > > + default: > > > + ret = -EINVAL; > > > + } > > > + spin_unlock(&devdata->lock); > > > + > > > + return ret; > > > +} > > > + > > > +static int axp20x_battery_max_chg_current(struct axp20x_power *devdata) > > > +{ > > > + if ((devdata->status1 & AXP20X_PWR_STATUS_AC_PRESENT) && > > > + (devdata->status1 & AXP20X_PWR_STATUS_AC_AVAILABLE)) { > > > + /* AC available - unrestricted power */ > > > + return devdata->batt_capacity / 2; > > > + } else if ((devdata->status1 & AXP20X_PWR_STATUS_VBUS_PRESENT) && > > > + (devdata->status1 & AXP20X_PWR_STATUS_VBUS_AVAILABLE)) { > > > + /* VBUS available - limited power */ > > > + switch (devdata->vbusmgt & AXP20X_VBUS_CLIMIT_MASK) { > > > + case AXP20X_VBUC_CLIMIT_100mA: > > > + return 0; > > > + case AXP20X_VBUC_CLIMIT_500mA: > > > + return 300000; > > > + case AXP20X_VBUC_CLIMIT_900mA: > > > + return 600000; > > > + case AXP20X_VBUC_CLIMIT_NONE: > > > + return devdata->batt_capacity / 2; > > > + default: > > > + return 0; > > > + } > > > + } else { > > > + /* on-battery */ > > > + return 0; > > > + } > > > +} > > > + > > > +static int axp20x_battery_set_prop(struct power_supply *psy, > > > + enum power_supply_property psp, > > > + const union power_supply_propval *val) > > > +{ > > > + struct axp20x_power *devdata = dev_get_drvdata(psy->dev->parent); > > > + int ret; > > > + > > > + switch (psp) { > > > + case POWER_SUPPLY_PROP_STATUS: > > > + if (val->intval == POWER_SUPPLY_STATUS_CHARGING) { > > > + ret = axp20x_battery_max_chg_current(devdata); > > > + if (ret == 0) { > > > + ret = -EBUSY; > > > + break; > > > + } > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_PWR_OP_MODE, > > > + AXP20X_PWR_OP_CHARGING, > > > + AXP20X_PWR_OP_CHARGING); > > > + if (ret == 0) > > > + axp20x_battery_chg_reconfig(&devdata->battery); > > > + } else if (val->intval == POWER_SUPPLY_STATUS_NOT_CHARGING) { > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_PWR_OP_MODE, > > > + AXP20X_PWR_OP_CHARGING, 0); > > > + } else > > > + ret = -EINVAL; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: > > > + /* TODO: adjust AXP20X_APS_WARN_L1 and AXP20X_APS_WARN_L2 accordingly */ > > > + ret = -EINVAL; > > > + break; > > > + > > > + case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN: > > > + switch (val->intval) { > > > + case 4100000: > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_CHRG_CTRL1, > > > + AXP20X_CHRG_CTRL1_TGT_VOLT, > > > + AXP20X_CHRG_CTRL1_TGT_4_1V); > > > + break; > > > + case 4150000: > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_CHRG_CTRL1, > > > + AXP20X_CHRG_CTRL1_TGT_VOLT, > > > + AXP20X_CHRG_CTRL1_TGT_4_15V); > > > + break; > > > + case 4200000: > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_CHRG_CTRL1, > > > + AXP20X_CHRG_CTRL1_TGT_VOLT, > > > + AXP20X_CHRG_CTRL1_TGT_4_2V); > > > + break; > > > + case 4360000: > > > + /* refuse this as it's too much for Li-ion! */ > > > + default: > > > + ret = -EINVAL; > > > + } > > > + break; > > > + case POWER_SUPPLY_PROP_CURRENT_MAX: > > > + if (((val->intval - 300000) / 100000) > 0x0f) > > > + ret = -EINVAL; > > > + else if (val->intval < 300000) > > > + ret = -EINVAL; > > > + else { > > > + devdata->batt_user_imax = val->intval; > > > + axp20x_battery_chg_reconfig(&devdata->battery); > > > + ret = 0; > > > + } > > > + break; > > > + > > > + default: > > > + ret = -EINVAL; > > > + } > > > + return ret; > > > +} > > > + > > > +static enum power_supply_property axp20x_battery_props[] = { > > > + POWER_SUPPLY_PROP_PRESENT, > > > + POWER_SUPPLY_PROP_ONLINE, > > > + POWER_SUPPLY_PROP_STATUS, > > > + POWER_SUPPLY_PROP_VOLTAGE_NOW, > > > + POWER_SUPPLY_PROP_CURRENT_NOW, > > > + POWER_SUPPLY_PROP_CURRENT_MAX, > > > + POWER_SUPPLY_PROP_HEALTH, > > > + POWER_SUPPLY_PROP_TECHNOLOGY, > > > + POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, > > > + POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, > > > + POWER_SUPPLY_PROP_POWER_NOW, > > > + POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, > > > + /* POWER_SUPPLY_PROP_CHARGE_NOW, */ > > > + POWER_SUPPLY_PROP_CAPACITY, > > > + POWER_SUPPLY_PROP_TEMP, > > > + POWER_SUPPLY_PROP_TEMP_ALERT_MIN, > > > + POWER_SUPPLY_PROP_TEMP_ALERT_MAX, > > > +}; > > > + > > > +static int axp20x_battery_prop_writeable(struct power_supply *psy, > > > + enum power_supply_property psp) > > > +{ > > > + return psp == POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN || > > > + psp == POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN || > > > + psp == POWER_SUPPLY_PROP_CURRENT_MAX || > > > + psp == POWER_SUPPLY_PROP_STATUS; > > > +} > > > + > > > +static void axp20x_battery_chg_reconfig(struct power_supply *psy) > > > +{ > > > + struct axp20x_power *devdata = container_of(psy, > > > + struct axp20x_power, battery); > > > + int charge_max, ret; > > > + > > > + ret = axp20x_power_poll(devdata, 0); > > > + if (ret) > > > + return; > > > + > > > + charge_max = axp20x_battery_max_chg_current(devdata); > > > + > > > + if (charge_max == 0) { > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_PWR_OP_MODE, > > > + AXP20X_PWR_OP_CHARGING, 0); > > > + } else { > > > + if (devdata->batt_user_imax < charge_max) > > > + charge_max = devdata->batt_user_imax; > > > + if (((charge_max - 300000) / 100000) > 0x0f) > > > + charge_max = 300000 + 0x0f * 100000; > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_CHRG_CTRL1, > > > + AXP20X_CHRG_CTRL1_TGT_CURR, > > > + (charge_max - 300000) / 100000); > > > + ret = regmap_update_bits(devdata->axp20x->regmap, > > > + AXP20X_PWR_OP_MODE, > > > + AXP20X_PWR_OP_CHARGING, > > > + AXP20X_PWR_OP_CHARGING); > > > + } > > > +} > > > + > > > + > > > + > > > +/* ********************************************** * > > > + * *** IRQ handlers *** * > > > + * ********************************************** */ > > > + > > > +static irqreturn_t axp20x_irq_ac_over_v(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_warn(&pdev->dev, "IRQ#%d AC over voltage\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_ac_plugin(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d AC connected\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_ac_removal(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d AC disconnected\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_vbus_over_v(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_warn(&pdev->dev, "IRQ#%d VBUS over voltage\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_vbus_plugin(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d VBUS connected\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_vbus_removal(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d VBUS disconnected\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_vbus_v_low(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_warn(&pdev->dev, "IRQ#%d VBUS low voltage\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_batt_plugin(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d Battery connected\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_removal(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d Battery disconnected\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_activation(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d Battery activation started\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_activated(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d Battery activation completed\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_charging(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d Battery charging\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_charged(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_info(&pdev->dev, "IRQ#%d Battery charged\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_high_temp(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_warn(&pdev->dev, "IRQ#%d Battery temperature high\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_low_temp(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_warn(&pdev->dev, "IRQ#%d Battery temperature low\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_batt_chg_curr_low(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_warn(&pdev->dev, "IRQ#%d External power too weak for target charging current!\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +static irqreturn_t axp20x_irq_power_low(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_warn(&pdev->dev, "IRQ#%d System power running out soon\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > +static irqreturn_t axp20x_irq_power_low_crit(int irq, void *pwr) > > > +{ > > > + struct platform_device *pdev = pwr; > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + dev_crit(&pdev->dev, "IRQ#%d System power running out now!\n", irq); > > > + schedule_work(&devdata->work); > > > + return IRQ_HANDLED; > > > +} > > > + > > > +/* ********************************************** * > > > + * *** Platform driver code *** * > > > + * ********************************************** */ > > > + > > > +static int axp20x_init_irq(struct platform_device *pdev, > > > + struct axp20x_dev *axp20x, const char *irq_name, > > > + const char *dev_name, irq_handler_t handler) > > > +{ > > > + int irq = platform_get_irq_byname(pdev, irq_name); > > > + int ret; > > > + > > > + if (irq < 0) { > > > + dev_warn(&pdev->dev, "No IRQ for %s: %d\n", irq_name, irq); > > > + return irq; > > > + } > > > + irq = regmap_irq_get_virq(axp20x->regmap_irqc, irq); > > > + > > > + ret = devm_request_any_context_irq(&pdev->dev, irq, handler, 0, > > > + dev_name, pdev); > > > + if (ret < 0) > > > + dev_warn(&pdev->dev, "Failed to request %s IRQ#%d: %d\n", irq_name, irq, ret); > > > + return ret; > > > +} > > > + > > > +static int axp20x_power_suspend(struct platform_device *pdev, pm_message_t state) > > > +{ > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + cancel_work_sync(&devdata->work); > > > + return 0; > > > +} > > > + > > > +static int axp20x_power_resume(struct platform_device *pdev) > > > +{ > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + axp20x_power_poll(devdata, 1); > > > + return 0; > > > +} > > > + > > > +static void axp20x_power_shutdown(struct platform_device *pdev) > > > +{ > > > + struct axp20x_power *devdata = platform_get_drvdata(pdev); > > > + > > > + cancel_work_sync(&devdata->work); > > > +} > > > + > > > +static int axp20x_power_probe(struct platform_device *pdev) > > > +{ > > > + struct axp20x_dev *axp20x = dev_get_drvdata(pdev->dev.parent); > > > + struct axp20x_power *devdata; > > > + struct power_supply *ac, *vbus, *backup, *battery; > > > + int ret; > > > + > > > + devdata = devm_kzalloc(&pdev->dev, sizeof(struct axp20x_power), > > > + GFP_KERNEL); > > > + if (devdata == NULL) > > > + return -ENOMEM; > > > + > > > + spin_lock_init(&devdata->lock); > > > + devdata->axp20x = axp20x; > > > + platform_set_drvdata(pdev, devdata); > > > + > > > + backup = &devdata->backup; > > > + snprintf(devdata->backup_name, sizeof(devdata->backup_name), "axp20x-backup"); > > > + backup->name = devdata->backup_name; > > > + backup->type = POWER_SUPPLY_TYPE_BATTERY; > > > + backup->properties = axp20x_backup_props; > > > + backup->num_properties = ARRAY_SIZE(axp20x_backup_props); > > > + backup->property_is_writeable = axp20x_backup_prop_writeable; > > > + backup->get_property = axp20x_backup_get_prop; > > > + backup->set_property = axp20x_backup_set_prop; > > > + > > > + ac = &devdata->ac; > > > + snprintf(devdata->ac_name, sizeof(devdata->ac_name), "axp20x-ac"); > > > + ac->name = devdata->ac_name; > > > + ac->type = POWER_SUPPLY_TYPE_MAINS; > > > + ac->properties = axp20x_ac_props; > > > + ac->num_properties = ARRAY_SIZE(axp20x_ac_props); > > > + ac->get_property = axp20x_ac_get_prop; > > > + > > > + vbus = &devdata->vbus; > > > + snprintf(devdata->vbus_name, sizeof(devdata->vbus_name), "axp20x-usb"); > > > + vbus->name = devdata->vbus_name; > > > + vbus->type = POWER_SUPPLY_TYPE_USB; > > > + vbus->properties = axp20x_vbus_props; > > > + vbus->num_properties = ARRAY_SIZE(axp20x_vbus_props); > > > + vbus->property_is_writeable = axp20x_vbus_prop_writeable; > > > + vbus->get_property = axp20x_vbus_get_prop; > > > + vbus->set_property = axp20x_vbus_set_prop; > > > + > > > + devdata->battery_supplies[0] = devdata->vbus_name; > > > + devdata->battery_supplies[1] = devdata->ac_name; > > > + battery = &devdata->battery; > > > + snprintf(devdata->battery_name, sizeof(devdata->battery_name), "axp20x-battery"); > > > + battery->name = devdata->battery_name; > > > + battery->type = POWER_SUPPLY_TYPE_BATTERY; > > > + battery->properties = axp20x_battery_props; > > > + battery->num_properties = ARRAY_SIZE(axp20x_battery_props); > > > + battery->property_is_writeable = axp20x_battery_prop_writeable; > > > + battery->get_property = axp20x_battery_get_prop; > > > + battery->set_property = axp20x_battery_set_prop; > > > + battery->supplied_from = devdata->battery_supplies; > > > + battery->num_supplies = 1; > > > + battery->external_power_changed = axp20x_battery_chg_reconfig; > > > + > > > + /* configure hardware and check FDT params */ > > > + regmap_update_bits(axp20x->regmap, AXP20X_ADC_RATE, > > > + AXP20X_ADR_RATE_MASK, AXP20X_ADR_RATE_50Hz); > > > + > > > + ret = axp20x_backup_config(pdev, axp20x); > > > + if (ret) > > > + devdata->backup_name[0] = '\0'; > > > + > > > + ret = axp20x_battery_config(pdev, devdata, axp20x); > > > + if (ret) > > > + devdata->battery_name[0] = '\0'; > > > + else if (devdata->tbatt_min == 0 && devdata->tbatt_max == 0) > > > + battery->num_properties -= 3; > > > + > > > + ret = axp20x_power_poll(devdata, 2); > > > + if (ret) > > > + return ret; > > > + > > > + if (devdata->status1 & AXP20X_PWR_STATUS_AC_VBUS_SHORT) > > > + devdata->ac_name[0] = '\0'; > > > + else > > > + battery->num_supplies = 2; > > > + > > > + /* register present supplies */ > > > + ret = power_supply_register(&pdev->dev, backup); > > > + if (ret) > > > + return ret; > > > + > > > + ret = power_supply_register(&pdev->dev, vbus); > > > + if (ret) > > > + goto err_unreg_backup; > > > + power_supply_changed(&devdata->vbus); > > > + > > > + if (devdata->ac_name[0]) { > > > + ret = power_supply_register(&pdev->dev, ac); > > > + if (ret) > > > + goto err_unreg_vbus; > > > + power_supply_changed(&devdata->ac); > > > + } > > > + > > > + if (devdata->battery_name[0]) { > > > + ret = power_supply_register(&pdev->dev, battery); > > > + if (ret) > > > + goto err_unreg_ac; > > > + power_supply_changed(&devdata->battery); > > > + } > > > > It looks like there's a lot more than just one driver here. Would it > > make sense to split this into smaller drivers? > > There are 4 parts - AC, VBUS, backup/RTC battery and main battery. > > Splitting it into four parts would be possible though there are some > interactions between them: > - AC and VBUS/OTG need to trigger charge current reconfiguration for > battery charger (due to current supply limit on VBUS/OTG) > > In addition, some of supply information is presented in registers shared > with the other supplies which would make caching management harder > unless regmap caching could be controlled in a better way. Yeah, regmap can be used for that, but whatever works best for you and the maintainers. Maxime -- Maxime Ripard, Free Electrons Embedded Linux, Kernel and Android engineering http://free-electrons.com -------------- next part -------------- A non-text attachment was scrubbed... Name: signature.asc Type: application/pgp-signature Size: 819 bytes Desc: Digital signature URL: