162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Driver for SBS compliant Smart Battery System Managers 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * The device communicates via i2c at address 0x0a and multiplexes access to up 662306a36Sopenharmony_ci * to four smart batteries at address 0x0b. 762306a36Sopenharmony_ci * 862306a36Sopenharmony_ci * Via sysfs interface the online state and charge type are presented. 962306a36Sopenharmony_ci * 1062306a36Sopenharmony_ci * Datasheet SBSM: http://sbs-forum.org/specs/sbsm100b.pdf 1162306a36Sopenharmony_ci * Datasheet LTC1760: http://cds.linear.com/docs/en/datasheet/1760fb.pdf 1262306a36Sopenharmony_ci * 1362306a36Sopenharmony_ci * Karl-Heinz Schneider <karl-heinz@schneider-inet.de> 1462306a36Sopenharmony_ci */ 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#include <linux/gpio/driver.h> 1762306a36Sopenharmony_ci#include <linux/module.h> 1862306a36Sopenharmony_ci#include <linux/i2c.h> 1962306a36Sopenharmony_ci#include <linux/i2c-mux.h> 2062306a36Sopenharmony_ci#include <linux/power_supply.h> 2162306a36Sopenharmony_ci#include <linux/property.h> 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci#define SBSM_MAX_BATS 4 2462306a36Sopenharmony_ci#define SBSM_RETRY_CNT 3 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci/* registers addresses */ 2762306a36Sopenharmony_ci#define SBSM_CMD_BATSYSSTATE 0x01 2862306a36Sopenharmony_ci#define SBSM_CMD_BATSYSSTATECONT 0x02 2962306a36Sopenharmony_ci#define SBSM_CMD_BATSYSINFO 0x04 3062306a36Sopenharmony_ci#define SBSM_CMD_LTC 0x3c 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci#define SBSM_MASK_BAT_SUPPORTED GENMASK(3, 0) 3362306a36Sopenharmony_ci#define SBSM_MASK_CHARGE_BAT GENMASK(7, 4) 3462306a36Sopenharmony_ci#define SBSM_BIT_AC_PRESENT BIT(0) 3562306a36Sopenharmony_ci#define SBSM_BIT_TURBO BIT(7) 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci#define SBSM_SMB_BAT_OFFSET 11 3862306a36Sopenharmony_cistruct sbsm_data { 3962306a36Sopenharmony_ci struct i2c_client *client; 4062306a36Sopenharmony_ci struct i2c_mux_core *muxc; 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci struct power_supply *psy; 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci u8 cur_chan; /* currently selected channel */ 4562306a36Sopenharmony_ci struct gpio_chip chip; 4662306a36Sopenharmony_ci bool is_ltc1760; /* special capabilities */ 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci unsigned int supported_bats; 4962306a36Sopenharmony_ci unsigned int last_state; 5062306a36Sopenharmony_ci unsigned int last_state_cont; 5162306a36Sopenharmony_ci}; 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_cistatic enum power_supply_property sbsm_props[] = { 5462306a36Sopenharmony_ci POWER_SUPPLY_PROP_ONLINE, 5562306a36Sopenharmony_ci POWER_SUPPLY_PROP_CHARGE_TYPE, 5662306a36Sopenharmony_ci}; 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_cistatic int sbsm_read_word(struct i2c_client *client, u8 address) 5962306a36Sopenharmony_ci{ 6062306a36Sopenharmony_ci int reg, retries; 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci for (retries = SBSM_RETRY_CNT; retries > 0; retries--) { 6362306a36Sopenharmony_ci reg = i2c_smbus_read_word_data(client, address); 6462306a36Sopenharmony_ci if (reg >= 0) 6562306a36Sopenharmony_ci break; 6662306a36Sopenharmony_ci } 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci if (reg < 0) { 6962306a36Sopenharmony_ci dev_err(&client->dev, "failed to read register 0x%02x\n", 7062306a36Sopenharmony_ci address); 7162306a36Sopenharmony_ci } 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ci return reg; 7462306a36Sopenharmony_ci} 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_cistatic int sbsm_write_word(struct i2c_client *client, u8 address, u16 word) 7762306a36Sopenharmony_ci{ 7862306a36Sopenharmony_ci int ret, retries; 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_ci for (retries = SBSM_RETRY_CNT; retries > 0; retries--) { 8162306a36Sopenharmony_ci ret = i2c_smbus_write_word_data(client, address, word); 8262306a36Sopenharmony_ci if (ret >= 0) 8362306a36Sopenharmony_ci break; 8462306a36Sopenharmony_ci } 8562306a36Sopenharmony_ci if (ret < 0) 8662306a36Sopenharmony_ci dev_err(&client->dev, "failed to write to register 0x%02x\n", 8762306a36Sopenharmony_ci address); 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_ci return ret; 9062306a36Sopenharmony_ci} 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_cistatic int sbsm_get_property(struct power_supply *psy, 9362306a36Sopenharmony_ci enum power_supply_property psp, 9462306a36Sopenharmony_ci union power_supply_propval *val) 9562306a36Sopenharmony_ci{ 9662306a36Sopenharmony_ci struct sbsm_data *data = power_supply_get_drvdata(psy); 9762306a36Sopenharmony_ci int regval = 0; 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci switch (psp) { 10062306a36Sopenharmony_ci case POWER_SUPPLY_PROP_ONLINE: 10162306a36Sopenharmony_ci regval = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATECONT); 10262306a36Sopenharmony_ci if (regval < 0) 10362306a36Sopenharmony_ci return regval; 10462306a36Sopenharmony_ci val->intval = !!(regval & SBSM_BIT_AC_PRESENT); 10562306a36Sopenharmony_ci break; 10662306a36Sopenharmony_ci 10762306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_TYPE: 10862306a36Sopenharmony_ci regval = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE); 10962306a36Sopenharmony_ci if (regval < 0) 11062306a36Sopenharmony_ci return regval; 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_ci if ((regval & SBSM_MASK_CHARGE_BAT) == 0) { 11362306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE; 11462306a36Sopenharmony_ci return 0; 11562306a36Sopenharmony_ci } 11662306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE; 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_ci if (data->is_ltc1760) { 11962306a36Sopenharmony_ci /* charge mode fast if turbo is active */ 12062306a36Sopenharmony_ci regval = sbsm_read_word(data->client, SBSM_CMD_LTC); 12162306a36Sopenharmony_ci if (regval < 0) 12262306a36Sopenharmony_ci return regval; 12362306a36Sopenharmony_ci else if (regval & SBSM_BIT_TURBO) 12462306a36Sopenharmony_ci val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST; 12562306a36Sopenharmony_ci } 12662306a36Sopenharmony_ci break; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci default: 12962306a36Sopenharmony_ci return -EINVAL; 13062306a36Sopenharmony_ci } 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_ci return 0; 13362306a36Sopenharmony_ci} 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_cistatic int sbsm_prop_is_writeable(struct power_supply *psy, 13662306a36Sopenharmony_ci enum power_supply_property psp) 13762306a36Sopenharmony_ci{ 13862306a36Sopenharmony_ci struct sbsm_data *data = power_supply_get_drvdata(psy); 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_ci return (psp == POWER_SUPPLY_PROP_CHARGE_TYPE) && data->is_ltc1760; 14162306a36Sopenharmony_ci} 14262306a36Sopenharmony_ci 14362306a36Sopenharmony_cistatic int sbsm_set_property(struct power_supply *psy, 14462306a36Sopenharmony_ci enum power_supply_property psp, 14562306a36Sopenharmony_ci const union power_supply_propval *val) 14662306a36Sopenharmony_ci{ 14762306a36Sopenharmony_ci struct sbsm_data *data = power_supply_get_drvdata(psy); 14862306a36Sopenharmony_ci int ret = -EINVAL; 14962306a36Sopenharmony_ci u16 regval; 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci switch (psp) { 15262306a36Sopenharmony_ci case POWER_SUPPLY_PROP_CHARGE_TYPE: 15362306a36Sopenharmony_ci /* write 1 to TURBO if type fast is given */ 15462306a36Sopenharmony_ci if (!data->is_ltc1760) 15562306a36Sopenharmony_ci break; 15662306a36Sopenharmony_ci regval = val->intval == 15762306a36Sopenharmony_ci POWER_SUPPLY_CHARGE_TYPE_FAST ? SBSM_BIT_TURBO : 0; 15862306a36Sopenharmony_ci ret = sbsm_write_word(data->client, SBSM_CMD_LTC, regval); 15962306a36Sopenharmony_ci break; 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_ci default: 16262306a36Sopenharmony_ci break; 16362306a36Sopenharmony_ci } 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci return ret; 16662306a36Sopenharmony_ci} 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci/* 16962306a36Sopenharmony_ci * Switch to battery 17062306a36Sopenharmony_ci * Parameter chan is directly the content of SMB_BAT* nibble 17162306a36Sopenharmony_ci */ 17262306a36Sopenharmony_cistatic int sbsm_select(struct i2c_mux_core *muxc, u32 chan) 17362306a36Sopenharmony_ci{ 17462306a36Sopenharmony_ci struct sbsm_data *data = i2c_mux_priv(muxc); 17562306a36Sopenharmony_ci struct device *dev = &data->client->dev; 17662306a36Sopenharmony_ci int ret = 0; 17762306a36Sopenharmony_ci u16 reg; 17862306a36Sopenharmony_ci 17962306a36Sopenharmony_ci if (data->cur_chan == chan) 18062306a36Sopenharmony_ci return ret; 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_ci /* chan goes from 1 ... 4 */ 18362306a36Sopenharmony_ci reg = BIT(SBSM_SMB_BAT_OFFSET + chan); 18462306a36Sopenharmony_ci ret = sbsm_write_word(data->client, SBSM_CMD_BATSYSSTATE, reg); 18562306a36Sopenharmony_ci if (ret) 18662306a36Sopenharmony_ci dev_err(dev, "Failed to select channel %i\n", chan); 18762306a36Sopenharmony_ci else 18862306a36Sopenharmony_ci data->cur_chan = chan; 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_ci return ret; 19162306a36Sopenharmony_ci} 19262306a36Sopenharmony_ci 19362306a36Sopenharmony_cistatic int sbsm_gpio_get_value(struct gpio_chip *gc, unsigned int off) 19462306a36Sopenharmony_ci{ 19562306a36Sopenharmony_ci struct sbsm_data *data = gpiochip_get_data(gc); 19662306a36Sopenharmony_ci int ret; 19762306a36Sopenharmony_ci 19862306a36Sopenharmony_ci ret = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE); 19962306a36Sopenharmony_ci if (ret < 0) 20062306a36Sopenharmony_ci return ret; 20162306a36Sopenharmony_ci 20262306a36Sopenharmony_ci return ret & BIT(off); 20362306a36Sopenharmony_ci} 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci/* 20662306a36Sopenharmony_ci * This needs to be defined or the GPIO lib fails to register the pin. 20762306a36Sopenharmony_ci * But the 'gpio' is always an input. 20862306a36Sopenharmony_ci */ 20962306a36Sopenharmony_cistatic int sbsm_gpio_direction_input(struct gpio_chip *gc, unsigned int off) 21062306a36Sopenharmony_ci{ 21162306a36Sopenharmony_ci return 0; 21262306a36Sopenharmony_ci} 21362306a36Sopenharmony_ci 21462306a36Sopenharmony_cistatic int sbsm_do_alert(struct device *dev, void *d) 21562306a36Sopenharmony_ci{ 21662306a36Sopenharmony_ci struct i2c_client *client = i2c_verify_client(dev); 21762306a36Sopenharmony_ci struct i2c_driver *driver; 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ci if (!client || client->addr != 0x0b) 22062306a36Sopenharmony_ci return 0; 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_ci device_lock(dev); 22362306a36Sopenharmony_ci if (client->dev.driver) { 22462306a36Sopenharmony_ci driver = to_i2c_driver(client->dev.driver); 22562306a36Sopenharmony_ci if (driver->alert) 22662306a36Sopenharmony_ci driver->alert(client, I2C_PROTOCOL_SMBUS_ALERT, 0); 22762306a36Sopenharmony_ci else 22862306a36Sopenharmony_ci dev_warn(&client->dev, "no driver alert()!\n"); 22962306a36Sopenharmony_ci } else { 23062306a36Sopenharmony_ci dev_dbg(&client->dev, "alert with no driver\n"); 23162306a36Sopenharmony_ci } 23262306a36Sopenharmony_ci device_unlock(dev); 23362306a36Sopenharmony_ci 23462306a36Sopenharmony_ci return -EBUSY; 23562306a36Sopenharmony_ci} 23662306a36Sopenharmony_ci 23762306a36Sopenharmony_cistatic void sbsm_alert(struct i2c_client *client, enum i2c_alert_protocol prot, 23862306a36Sopenharmony_ci unsigned int d) 23962306a36Sopenharmony_ci{ 24062306a36Sopenharmony_ci struct sbsm_data *sbsm = i2c_get_clientdata(client); 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci int ret, i, irq_bat = 0, state = 0; 24362306a36Sopenharmony_ci 24462306a36Sopenharmony_ci ret = sbsm_read_word(sbsm->client, SBSM_CMD_BATSYSSTATE); 24562306a36Sopenharmony_ci if (ret >= 0) { 24662306a36Sopenharmony_ci irq_bat = ret ^ sbsm->last_state; 24762306a36Sopenharmony_ci sbsm->last_state = ret; 24862306a36Sopenharmony_ci state = ret; 24962306a36Sopenharmony_ci } 25062306a36Sopenharmony_ci 25162306a36Sopenharmony_ci ret = sbsm_read_word(sbsm->client, SBSM_CMD_BATSYSSTATECONT); 25262306a36Sopenharmony_ci if ((ret >= 0) && 25362306a36Sopenharmony_ci ((ret ^ sbsm->last_state_cont) & SBSM_BIT_AC_PRESENT)) { 25462306a36Sopenharmony_ci irq_bat |= sbsm->supported_bats & state; 25562306a36Sopenharmony_ci power_supply_changed(sbsm->psy); 25662306a36Sopenharmony_ci } 25762306a36Sopenharmony_ci sbsm->last_state_cont = ret; 25862306a36Sopenharmony_ci 25962306a36Sopenharmony_ci for (i = 0; i < SBSM_MAX_BATS; i++) { 26062306a36Sopenharmony_ci if (irq_bat & BIT(i)) { 26162306a36Sopenharmony_ci device_for_each_child(&sbsm->muxc->adapter[i]->dev, 26262306a36Sopenharmony_ci NULL, sbsm_do_alert); 26362306a36Sopenharmony_ci } 26462306a36Sopenharmony_ci } 26562306a36Sopenharmony_ci} 26662306a36Sopenharmony_ci 26762306a36Sopenharmony_cistatic int sbsm_gpio_setup(struct sbsm_data *data) 26862306a36Sopenharmony_ci{ 26962306a36Sopenharmony_ci struct gpio_chip *gc = &data->chip; 27062306a36Sopenharmony_ci struct i2c_client *client = data->client; 27162306a36Sopenharmony_ci struct device *dev = &client->dev; 27262306a36Sopenharmony_ci int ret; 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_ci if (!device_property_present(dev, "gpio-controller")) 27562306a36Sopenharmony_ci return 0; 27662306a36Sopenharmony_ci 27762306a36Sopenharmony_ci ret = sbsm_read_word(client, SBSM_CMD_BATSYSSTATE); 27862306a36Sopenharmony_ci if (ret < 0) 27962306a36Sopenharmony_ci return ret; 28062306a36Sopenharmony_ci data->last_state = ret; 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_ci ret = sbsm_read_word(client, SBSM_CMD_BATSYSSTATECONT); 28362306a36Sopenharmony_ci if (ret < 0) 28462306a36Sopenharmony_ci return ret; 28562306a36Sopenharmony_ci data->last_state_cont = ret; 28662306a36Sopenharmony_ci 28762306a36Sopenharmony_ci gc->get = sbsm_gpio_get_value; 28862306a36Sopenharmony_ci gc->direction_input = sbsm_gpio_direction_input; 28962306a36Sopenharmony_ci gc->can_sleep = true; 29062306a36Sopenharmony_ci gc->base = -1; 29162306a36Sopenharmony_ci gc->ngpio = SBSM_MAX_BATS; 29262306a36Sopenharmony_ci gc->label = client->name; 29362306a36Sopenharmony_ci gc->parent = dev; 29462306a36Sopenharmony_ci gc->owner = THIS_MODULE; 29562306a36Sopenharmony_ci 29662306a36Sopenharmony_ci ret = devm_gpiochip_add_data(dev, gc, data); 29762306a36Sopenharmony_ci if (ret) 29862306a36Sopenharmony_ci return dev_err_probe(dev, ret, "devm_gpiochip_add_data failed\n"); 29962306a36Sopenharmony_ci 30062306a36Sopenharmony_ci return ret; 30162306a36Sopenharmony_ci} 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_cistatic const struct power_supply_desc sbsm_default_psy_desc = { 30462306a36Sopenharmony_ci .type = POWER_SUPPLY_TYPE_MAINS, 30562306a36Sopenharmony_ci .properties = sbsm_props, 30662306a36Sopenharmony_ci .num_properties = ARRAY_SIZE(sbsm_props), 30762306a36Sopenharmony_ci .get_property = &sbsm_get_property, 30862306a36Sopenharmony_ci .set_property = &sbsm_set_property, 30962306a36Sopenharmony_ci .property_is_writeable = &sbsm_prop_is_writeable, 31062306a36Sopenharmony_ci}; 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_cistatic void sbsm_del_mux_adapter(void *data) 31362306a36Sopenharmony_ci{ 31462306a36Sopenharmony_ci struct sbsm_data *sbsm = data; 31562306a36Sopenharmony_ci i2c_mux_del_adapters(sbsm->muxc); 31662306a36Sopenharmony_ci} 31762306a36Sopenharmony_ci 31862306a36Sopenharmony_cistatic int sbsm_probe(struct i2c_client *client) 31962306a36Sopenharmony_ci{ 32062306a36Sopenharmony_ci const struct i2c_device_id *id = i2c_client_get_device_id(client); 32162306a36Sopenharmony_ci struct i2c_adapter *adapter = client->adapter; 32262306a36Sopenharmony_ci struct sbsm_data *data; 32362306a36Sopenharmony_ci struct device *dev = &client->dev; 32462306a36Sopenharmony_ci struct power_supply_desc *psy_desc; 32562306a36Sopenharmony_ci struct power_supply_config psy_cfg = {}; 32662306a36Sopenharmony_ci int ret = 0, i; 32762306a36Sopenharmony_ci 32862306a36Sopenharmony_ci /* Device listens only at address 0x0a */ 32962306a36Sopenharmony_ci if (client->addr != 0x0a) 33062306a36Sopenharmony_ci return -EINVAL; 33162306a36Sopenharmony_ci 33262306a36Sopenharmony_ci if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA)) 33362306a36Sopenharmony_ci return -EPFNOSUPPORT; 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); 33662306a36Sopenharmony_ci if (!data) 33762306a36Sopenharmony_ci return -ENOMEM; 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci i2c_set_clientdata(client, data); 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci data->client = client; 34262306a36Sopenharmony_ci data->is_ltc1760 = !!strstr(id->name, "ltc1760"); 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_ci ret = sbsm_read_word(client, SBSM_CMD_BATSYSINFO); 34562306a36Sopenharmony_ci if (ret < 0) 34662306a36Sopenharmony_ci return ret; 34762306a36Sopenharmony_ci data->supported_bats = ret & SBSM_MASK_BAT_SUPPORTED; 34862306a36Sopenharmony_ci data->muxc = i2c_mux_alloc(adapter, dev, SBSM_MAX_BATS, 0, 34962306a36Sopenharmony_ci I2C_MUX_LOCKED, &sbsm_select, NULL); 35062306a36Sopenharmony_ci if (!data->muxc) 35162306a36Sopenharmony_ci return dev_err_probe(dev, -ENOMEM, "failed to alloc i2c mux\n"); 35262306a36Sopenharmony_ci data->muxc->priv = data; 35362306a36Sopenharmony_ci 35462306a36Sopenharmony_ci ret = devm_add_action_or_reset(dev, sbsm_del_mux_adapter, data); 35562306a36Sopenharmony_ci if (ret) 35662306a36Sopenharmony_ci return ret; 35762306a36Sopenharmony_ci 35862306a36Sopenharmony_ci /* register muxed i2c channels. One for each supported battery */ 35962306a36Sopenharmony_ci for (i = 0; i < SBSM_MAX_BATS; ++i) { 36062306a36Sopenharmony_ci if (data->supported_bats & BIT(i)) { 36162306a36Sopenharmony_ci ret = i2c_mux_add_adapter(data->muxc, 0, i + 1, 0); 36262306a36Sopenharmony_ci if (ret) 36362306a36Sopenharmony_ci break; 36462306a36Sopenharmony_ci } 36562306a36Sopenharmony_ci } 36662306a36Sopenharmony_ci if (ret) 36762306a36Sopenharmony_ci return dev_err_probe(dev, ret, "failed to register i2c mux channel %d\n", i + 1); 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci psy_desc = devm_kmemdup(dev, &sbsm_default_psy_desc, sizeof(*psy_desc), GFP_KERNEL); 37062306a36Sopenharmony_ci if (!psy_desc) 37162306a36Sopenharmony_ci return -ENOMEM; 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_ci psy_desc->name = devm_kasprintf(dev, GFP_KERNEL, "sbsm-%s", dev_name(&client->dev)); 37462306a36Sopenharmony_ci if (!psy_desc->name) 37562306a36Sopenharmony_ci return -ENOMEM; 37662306a36Sopenharmony_ci 37762306a36Sopenharmony_ci ret = sbsm_gpio_setup(data); 37862306a36Sopenharmony_ci if (ret < 0) 37962306a36Sopenharmony_ci return ret; 38062306a36Sopenharmony_ci 38162306a36Sopenharmony_ci psy_cfg.drv_data = data; 38262306a36Sopenharmony_ci psy_cfg.of_node = dev->of_node; 38362306a36Sopenharmony_ci data->psy = devm_power_supply_register(dev, psy_desc, &psy_cfg); 38462306a36Sopenharmony_ci if (IS_ERR(data->psy)) 38562306a36Sopenharmony_ci return dev_err_probe(dev, PTR_ERR(data->psy), 38662306a36Sopenharmony_ci "failed to register power supply %s\n", psy_desc->name); 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_ci return 0; 38962306a36Sopenharmony_ci} 39062306a36Sopenharmony_ci 39162306a36Sopenharmony_cistatic const struct i2c_device_id sbsm_ids[] = { 39262306a36Sopenharmony_ci { "sbs-manager", 0 }, 39362306a36Sopenharmony_ci { "ltc1760", 0 }, 39462306a36Sopenharmony_ci { } 39562306a36Sopenharmony_ci}; 39662306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, sbsm_ids); 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci#ifdef CONFIG_OF 39962306a36Sopenharmony_cistatic const struct of_device_id sbsm_dt_ids[] = { 40062306a36Sopenharmony_ci { .compatible = "sbs,sbs-manager" }, 40162306a36Sopenharmony_ci { .compatible = "lltc,ltc1760" }, 40262306a36Sopenharmony_ci { } 40362306a36Sopenharmony_ci}; 40462306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, sbsm_dt_ids); 40562306a36Sopenharmony_ci#endif 40662306a36Sopenharmony_ci 40762306a36Sopenharmony_cistatic struct i2c_driver sbsm_driver = { 40862306a36Sopenharmony_ci .driver = { 40962306a36Sopenharmony_ci .name = "sbsm", 41062306a36Sopenharmony_ci .of_match_table = of_match_ptr(sbsm_dt_ids), 41162306a36Sopenharmony_ci }, 41262306a36Sopenharmony_ci .probe = sbsm_probe, 41362306a36Sopenharmony_ci .alert = sbsm_alert, 41462306a36Sopenharmony_ci .id_table = sbsm_ids 41562306a36Sopenharmony_ci}; 41662306a36Sopenharmony_cimodule_i2c_driver(sbsm_driver); 41762306a36Sopenharmony_ci 41862306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 41962306a36Sopenharmony_ciMODULE_AUTHOR("Karl-Heinz Schneider <karl-heinz@schneider-inet.de>"); 42062306a36Sopenharmony_ciMODULE_DESCRIPTION("SBSM Smart Battery System Manager"); 421