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