[mirror_ubuntu-hirsute-kernel.git] / drivers / power / supply / sbs-manager.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Driver for SBS compliant Smart Battery System Managers
 *
 * The device communicates via i2c at address 0x0a and multiplexes access to up
 * to four smart batteries at address 0x0b.
 *
 * Via sysfs interface the online state and charge type are presented.
 *
 * Datasheet SBSM:    http://sbs-forum.org/specs/sbsm100b.pdf
 * Datasheet LTC1760: http://cds.linear.com/docs/en/datasheet/1760fb.pdf
 *
 * Karl-Heinz Schneider <karl-heinz@schneider-inet.de>
 */

#include <linux/gpio.h>
#include <linux/module.h>
#include <linux/i2c.h>
#include <linux/i2c-mux.h>
#include <linux/power_supply.h>
#include <linux/property.h>

#define SBSM_MAX_BATS  4
#define SBSM_RETRY_CNT 3

/* registers addresses */
#define SBSM_CMD_BATSYSSTATE     0x01
#define SBSM_CMD_BATSYSSTATECONT 0x02
#define SBSM_CMD_BATSYSINFO      0x04
#define SBSM_CMD_LTC             0x3c

#define SBSM_MASK_BAT_SUPPORTED  GENMASK(3, 0)
#define SBSM_MASK_CHARGE_BAT     GENMASK(7, 4)
#define SBSM_BIT_AC_PRESENT      BIT(0)
#define SBSM_BIT_TURBO           BIT(7)

#define SBSM_SMB_BAT_OFFSET      11
struct sbsm_data {
	struct i2c_client *client;
	struct i2c_mux_core *muxc;

	struct power_supply *psy;

	u8 cur_chan;          /* currently selected channel */
	struct gpio_chip chip;
	bool is_ltc1760;      /* special capabilities */

	unsigned int supported_bats;
	unsigned int last_state;
	unsigned int last_state_cont;
};

static enum power_supply_property sbsm_props[] = {
	POWER_SUPPLY_PROP_ONLINE,
	POWER_SUPPLY_PROP_CHARGE_TYPE,
};

static int sbsm_read_word(struct i2c_client *client, u8 address)
{
	int reg, retries;

	for (retries = SBSM_RETRY_CNT; retries > 0; retries--) {
		reg = i2c_smbus_read_word_data(client, address);
		if (reg >= 0)
			break;
	}

	if (reg < 0) {
		dev_err(&client->dev, "failed to read register 0x%02x\n",
			address);
	}

	return reg;
}

static int sbsm_write_word(struct i2c_client *client, u8 address, u16 word)
{
	int ret, retries;

	for (retries = SBSM_RETRY_CNT; retries > 0; retries--) {
		ret = i2c_smbus_write_word_data(client, address, word);
		if (ret >= 0)
			break;
	}
	if (ret < 0)
		dev_err(&client->dev, "failed to write to register 0x%02x\n",
			address);

	return ret;
}

static int sbsm_get_property(struct power_supply *psy,
			     enum power_supply_property psp,
			     union power_supply_propval *val)
{
	struct sbsm_data *data = power_supply_get_drvdata(psy);
	int regval = 0;

	switch (psp) {
	case POWER_SUPPLY_PROP_ONLINE:
		regval = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATECONT);
		if (regval < 0)
			return regval;
		val->intval = !!(regval & SBSM_BIT_AC_PRESENT);
		break;

	case POWER_SUPPLY_PROP_CHARGE_TYPE:
		regval = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE);
		if (regval < 0)
			return regval;

		if ((regval & SBSM_MASK_CHARGE_BAT) == 0) {
			val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
			return 0;
		}
		val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;

		if (data->is_ltc1760) {
			/* charge mode fast if turbo is active */
			regval = sbsm_read_word(data->client, SBSM_CMD_LTC);
			if (regval < 0)
				return regval;
			else if (regval & SBSM_BIT_TURBO)
				val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST;
		}
		break;

	default:
		return -EINVAL;
	}

	return 0;
}

static int sbsm_prop_is_writeable(struct power_supply *psy,
				  enum power_supply_property psp)
{
	struct sbsm_data *data = power_supply_get_drvdata(psy);

	return (psp == POWER_SUPPLY_PROP_CHARGE_TYPE) && data->is_ltc1760;
}

static int sbsm_set_property(struct power_supply *psy,
			     enum power_supply_property psp,
			     const union power_supply_propval *val)
{
	struct sbsm_data *data = power_supply_get_drvdata(psy);
	int ret = -EINVAL;
	u16 regval;

	switch (psp) {
	case POWER_SUPPLY_PROP_CHARGE_TYPE:
		/* write 1 to TURBO if type fast is given */
		if (!data->is_ltc1760)
			break;
		regval = val->intval ==
			 POWER_SUPPLY_CHARGE_TYPE_FAST ? SBSM_BIT_TURBO : 0;
		ret = sbsm_write_word(data->client, SBSM_CMD_LTC, regval);
		break;

	default:
		break;
	}

	return ret;
}

/*
 * Switch to battery
 * Parameter chan is directly the content of SMB_BAT* nibble
 */
static int sbsm_select(struct i2c_mux_core *muxc, u32 chan)
{
	struct sbsm_data *data = i2c_mux_priv(muxc);
	struct device *dev = &data->client->dev;
	int ret = 0;
	u16 reg;

	if (data->cur_chan == chan)
		return ret;

	/* chan goes from 1 ... 4 */
	reg = BIT(SBSM_SMB_BAT_OFFSET + chan);
	ret = sbsm_write_word(data->client, SBSM_CMD_BATSYSSTATE, reg);
	if (ret)
		dev_err(dev, "Failed to select channel %i\n", chan);
	else
		data->cur_chan = chan;

	return ret;
}

static int sbsm_gpio_get_value(struct gpio_chip *gc, unsigned int off)
{
	struct sbsm_data *data = gpiochip_get_data(gc);
	int ret;

	ret = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE);
	if (ret < 0)
		return ret;

	return ret & BIT(off);
}

/*
 * This needs to be defined or the GPIO lib fails to register the pin.
 * But the 'gpio' is always an input.
 */
static int sbsm_gpio_direction_input(struct gpio_chip *gc, unsigned int off)
{
	return 0;
}

static int sbsm_do_alert(struct device *dev, void *d)
{
	struct i2c_client *client = i2c_verify_client(dev);
	struct i2c_driver *driver;

	if (!client || client->addr != 0x0b)
		return 0;

	device_lock(dev);
	if (client->dev.driver) {
		driver = to_i2c_driver(client->dev.driver);
		if (driver->alert)
			driver->alert(client, I2C_PROTOCOL_SMBUS_ALERT, 0);
		else
			dev_warn(&client->dev, "no driver alert()!\n");
	} else {
		dev_dbg(&client->dev, "alert with no driver\n");
	}
	device_unlock(dev);

	return -EBUSY;
}

static void sbsm_alert(struct i2c_client *client, enum i2c_alert_protocol prot,
		       unsigned int d)
{
	struct sbsm_data *sbsm = i2c_get_clientdata(client);

	int ret, i, irq_bat = 0, state = 0;

	ret = sbsm_read_word(sbsm->client, SBSM_CMD_BATSYSSTATE);
	if (ret >= 0) {
		irq_bat = ret ^ sbsm->last_state;
		sbsm->last_state = ret;
		state = ret;
	}

	ret = sbsm_read_word(sbsm->client, SBSM_CMD_BATSYSSTATECONT);
	if ((ret >= 0) &&
	    ((ret ^ sbsm->last_state_cont) & SBSM_BIT_AC_PRESENT)) {
		irq_bat |= sbsm->supported_bats & state;
		power_supply_changed(sbsm->psy);
	}
	sbsm->last_state_cont = ret;

	for (i = 0; i < SBSM_MAX_BATS; i++) {
		if (irq_bat & BIT(i)) {
			device_for_each_child(&sbsm->muxc->adapter[i]->dev,
					      NULL, sbsm_do_alert);
		}
	}
}

static int sbsm_gpio_setup(struct sbsm_data *data)
{
	struct gpio_chip *gc = &data->chip;
	struct i2c_client *client = data->client;
	struct device *dev = &client->dev;
	int ret;

	if (!device_property_present(dev, "gpio-controller"))
		return 0;

	ret  = sbsm_read_word(client, SBSM_CMD_BATSYSSTATE);
	if (ret < 0)
		return ret;
	data->last_state = ret;

	ret  = sbsm_read_word(client, SBSM_CMD_BATSYSSTATECONT);
	if (ret < 0)
		return ret;
	data->last_state_cont = ret;

	gc->get = sbsm_gpio_get_value;
	gc->direction_input  = sbsm_gpio_direction_input;
	gc->can_sleep = true;
	gc->base = -1;
	gc->ngpio = SBSM_MAX_BATS;
	gc->label = client->name;
	gc->parent = dev;
	gc->owner = THIS_MODULE;

	ret = devm_gpiochip_add_data(dev, gc, data);
	if (ret) {
		dev_err(dev, "devm_gpiochip_add_data failed: %d\n", ret);
		return ret;
	}

	return ret;
}

static const struct power_supply_desc sbsm_default_psy_desc = {
	.type = POWER_SUPPLY_TYPE_MAINS,
	.properties = sbsm_props,
	.num_properties = ARRAY_SIZE(sbsm_props),
	.get_property = &sbsm_get_property,
	.set_property = &sbsm_set_property,
	.property_is_writeable = &sbsm_prop_is_writeable,
};

static int sbsm_probe(struct i2c_client *client,
		      const struct i2c_device_id *id)
{
	struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
	struct sbsm_data *data;
	struct device *dev = &client->dev;
	struct power_supply_desc *psy_desc;
	struct power_supply_config psy_cfg = {};
	int ret = 0, i;

	/* Device listens only at address 0x0a */
	if (client->addr != 0x0a)
		return -EINVAL;

	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA))
		return -EPFNOSUPPORT;

	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
	if (!data)
		return -ENOMEM;

	i2c_set_clientdata(client, data);

	data->client = client;
	data->is_ltc1760 = !!strstr(id->name, "ltc1760");

	ret  = sbsm_read_word(client, SBSM_CMD_BATSYSINFO);
	if (ret < 0)
		return ret;
	data->supported_bats = ret & SBSM_MASK_BAT_SUPPORTED;
	data->muxc = i2c_mux_alloc(adapter, dev, SBSM_MAX_BATS, 0,
				   I2C_MUX_LOCKED, &sbsm_select, NULL);
	if (!data->muxc) {
		dev_err(dev, "failed to alloc i2c mux\n");
		ret = -ENOMEM;
		goto err_mux_alloc;
	}
	data->muxc->priv = data;

	/* register muxed i2c channels. One for each supported battery */
	for (i = 0; i < SBSM_MAX_BATS; ++i) {
		if (data->supported_bats & BIT(i)) {
			ret = i2c_mux_add_adapter(data->muxc, 0, i + 1, 0);
			if (ret)
				break;
		}
	}
	if (ret) {
		dev_err(dev, "failed to register i2c mux channel %d\n", i + 1);
		goto err_mux_register;
	}

	psy_desc = devm_kmemdup(dev, &sbsm_default_psy_desc,
				sizeof(struct power_supply_desc),
				GFP_KERNEL);
	if (!psy_desc) {
		ret = -ENOMEM;
		goto err_psy;
	}

	psy_desc->name = devm_kasprintf(dev, GFP_KERNEL, "sbsm-%s",
					dev_name(&client->dev));
	if (!psy_desc->name) {
		ret = -ENOMEM;
		goto err_psy;
	}
	ret = sbsm_gpio_setup(data);
	if (ret < 0)
		goto err_psy;

	psy_cfg.drv_data = data;
	psy_cfg.of_node = dev->of_node;
	data->psy = devm_power_supply_register(dev, psy_desc, &psy_cfg);
	if (IS_ERR(data->psy)) {
		ret = PTR_ERR(data->psy);
		dev_err(dev, "failed to register power supply %s\n",
			psy_desc->name);
		goto err_psy;
	}

	return 0;

err_psy:
err_mux_register:
	i2c_mux_del_adapters(data->muxc);

err_mux_alloc:
	return ret;
}

static int sbsm_remove(struct i2c_client *client)
{
	struct sbsm_data *data = i2c_get_clientdata(client);

	i2c_mux_del_adapters(data->muxc);
	return 0;
}

static const struct i2c_device_id sbsm_ids[] = {
	{ "sbs-manager", 0 },
	{ "ltc1760",     0 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, sbsm_ids);

#ifdef CONFIG_OF
static const struct of_device_id sbsm_dt_ids[] = {
	{ .compatible = "sbs,sbs-manager" },
	{ .compatible = "lltc,ltc1760" },
	{ }
};
MODULE_DEVICE_TABLE(of, sbsm_dt_ids);
#endif

static struct i2c_driver sbsm_driver = {
	.driver = {
		.name = "sbsm",
		.of_match_table = of_match_ptr(sbsm_dt_ids),
	},
	.probe		= sbsm_probe,
	.remove		= sbsm_remove,
	.alert		= sbsm_alert,
	.id_table	= sbsm_ids
};
module_i2c_driver(sbsm_driver);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Karl-Heinz Schneider <karl-heinz@schneider-inet.de>");
MODULE_DESCRIPTION("SBSM Smart Battery System Manager");
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
dbc4deda KHS	2	/*
	3	* Driver for SBS compliant Smart Battery System Managers
	4	*
	5	* The device communicates via i2c at address 0x0a and multiplexes access to up
	6	* to four smart batteries at address 0x0b.
	7	*
	8	* Via sysfs interface the online state and charge type are presented.
	9	*
	10	* Datasheet SBSM: http://sbs-forum.org/specs/sbsm100b.pdf
	11	* Datasheet LTC1760: http://cds.linear.com/docs/en/datasheet/1760fb.pdf
	12	*
	13	* Karl-Heinz Schneider <karl-heinz@schneider-inet.de>
dbc4deda KHS	14	*/
dbc4deda KHS	15
a0b8839e	16	#include <linux/gpio.h>
dbc4deda KHS	17	#include <linux/module.h>
	18	#include <linux/i2c.h>
	19	#include <linux/i2c-mux.h>
	20	#include <linux/power_supply.h>
a0b8839e	21	#include <linux/property.h>
dbc4deda KHS	22
	23	#define SBSM_MAX_BATS 4
	24	#define SBSM_RETRY_CNT 3
	25
	26	/* registers addresses */
	27	#define SBSM_CMD_BATSYSSTATE 0x01
	28	#define SBSM_CMD_BATSYSSTATECONT 0x02
	29	#define SBSM_CMD_BATSYSINFO 0x04
	30	#define SBSM_CMD_LTC 0x3c
	31
	32	#define SBSM_MASK_BAT_SUPPORTED GENMASK(3, 0)
	33	#define SBSM_MASK_CHARGE_BAT GENMASK(7, 4)
	34	#define SBSM_BIT_AC_PRESENT BIT(0)
	35	#define SBSM_BIT_TURBO BIT(7)
	36
	37	#define SBSM_SMB_BAT_OFFSET 11
	38	struct sbsm_data {
	39	struct i2c_client *client;
	40	struct i2c_mux_core *muxc;
	41
	42	struct power_supply *psy;
	43
	44	u8 cur_chan; /* currently selected channel */
a0b8839e	45	struct gpio_chip chip;
dbc4deda	46	bool is_ltc1760; /* special capabilities */
a0b8839e PR	47
	48	unsigned int supported_bats;
	49	unsigned int last_state;
	50	unsigned int last_state_cont;
dbc4deda KHS	51	};
	52
	53	static enum power_supply_property sbsm_props[] = {
	54	POWER_SUPPLY_PROP_ONLINE,
	55	POWER_SUPPLY_PROP_CHARGE_TYPE,
	56	};
	57
	58	static int sbsm_read_word(struct i2c_client *client, u8 address)
	59	{
	60	int reg, retries;
	61
	62	for (retries = SBSM_RETRY_CNT; retries > 0; retries--) {
	63	reg = i2c_smbus_read_word_data(client, address);
	64	if (reg >= 0)
	65	break;
	66	}
	67
	68	if (reg < 0) {
	69	dev_err(&client->dev, "failed to read register 0x%02x\n",
	70	address);
	71	}
	72
	73	return reg;
	74	}
	75
	76	static int sbsm_write_word(struct i2c_client *client, u8 address, u16 word)
	77	{
	78	int ret, retries;
	79
	80	for (retries = SBSM_RETRY_CNT; retries > 0; retries--) {
	81	ret = i2c_smbus_write_word_data(client, address, word);
	82	if (ret >= 0)
	83	break;
	84	}
	85	if (ret < 0)
	86	dev_err(&client->dev, "failed to write to register 0x%02x\n",
	87	address);
	88
	89	return ret;
	90	}
	91
	92	static int sbsm_get_property(struct power_supply *psy,
	93	enum power_supply_property psp,
	94	union power_supply_propval *val)
	95	{
	96	struct sbsm_data *data = power_supply_get_drvdata(psy);
	97	int regval = 0;
	98
	99	switch (psp) {
	100	case POWER_SUPPLY_PROP_ONLINE:
	101	regval = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATECONT);
	102	if (regval < 0)
	103	return regval;
	104	val->intval = !!(regval & SBSM_BIT_AC_PRESENT);
	105	break;
	106
	107	case POWER_SUPPLY_PROP_CHARGE_TYPE:
	108	regval = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE);
	109	if (regval < 0)
	110	return regval;
	111
	112	if ((regval & SBSM_MASK_CHARGE_BAT) == 0) {
	113	val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
	114	return 0;
115	}
116	val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
117
118	if (data->is_ltc1760) {
119	/* charge mode fast if turbo is active */
120	regval = sbsm_read_word(data->client, SBSM_CMD_LTC);
121	if (regval < 0)
122	return regval;
123	else if (regval & SBSM_BIT_TURBO)
124	val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST;
125	}
126	break;
127
128	default:
129	return -EINVAL;
130	}
131
132	return 0;
133	}
134
135	static int sbsm_prop_is_writeable(struct power_supply *psy,
136	enum power_supply_property psp)
137	{
138	struct sbsm_data *data = power_supply_get_drvdata(psy);
139
140	return (psp == POWER_SUPPLY_PROP_CHARGE_TYPE) && data->is_ltc1760;
141	}
142
143	static int sbsm_set_property(struct power_supply *psy,
144	enum power_supply_property psp,
145	const union power_supply_propval *val)
146	{
147	struct sbsm_data *data = power_supply_get_drvdata(psy);
148	int ret = -EINVAL;
149	u16 regval;
150
151	switch (psp) {
152	case POWER_SUPPLY_PROP_CHARGE_TYPE:
153	/* write 1 to TURBO if type fast is given */
154	if (!data->is_ltc1760)
155	break;
156	regval = val->intval ==
157	POWER_SUPPLY_CHARGE_TYPE_FAST ? SBSM_BIT_TURBO : 0;
158	ret = sbsm_write_word(data->client, SBSM_CMD_LTC, regval);
159	break;
160
161	default:
162	break;
163	}
164
165	return ret;
166	}
167
168	/*
169	* Switch to battery
170	* Parameter chan is directly the content of SMB_BAT* nibble
171	*/
172	static int sbsm_select(struct i2c_mux_core *muxc, u32 chan)
173	{
174	struct sbsm_data *data = i2c_mux_priv(muxc);
175	struct device *dev = &data->client->dev;
176	int ret = 0;
177	u16 reg;
178
179	if (data->cur_chan == chan)
180	return ret;
181
182	/* chan goes from 1 ... 4 */
7d54d0d3	183	reg = BIT(SBSM_SMB_BAT_OFFSET + chan);
dbc4deda KHS	184	ret = sbsm_write_word(data->client, SBSM_CMD_BATSYSSTATE, reg);
	185	if (ret)
	186	dev_err(dev, "Failed to select channel %i\n", chan);
	187	else
	188	data->cur_chan = chan;
	189
	190	return ret;
	191	}
	192
4cf419a2	193	static int sbsm_gpio_get_value(struct gpio_chip *gc, unsigned int off)
a0b8839e PR	194	{
	195	struct sbsm_data *data = gpiochip_get_data(gc);
	196	int ret;
	197
	198	ret = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE);
	199	if (ret < 0)
	200	return ret;
	201
	202	return ret & BIT(off);
	203	}
	204
	205	/*
	206	* This needs to be defined or the GPIO lib fails to register the pin.
	207	* But the 'gpio' is always an input.
	208	*/
4cf419a2	209	static int sbsm_gpio_direction_input(struct gpio_chip *gc, unsigned int off)
a0b8839e PR	210	{
	211	return 0;
	212	}
	213
	214	static int sbsm_do_alert(struct device dev, void d)
	215	{
	216	struct i2c_client *client = i2c_verify_client(dev);
	217	struct i2c_driver *driver;
	218
	219	if (!client \|\| client->addr != 0x0b)
	220	return 0;
	221
	222	device_lock(dev);
	223	if (client->dev.driver) {
	224	driver = to_i2c_driver(client->dev.driver);
	225	if (driver->alert)
	226	driver->alert(client, I2C_PROTOCOL_SMBUS_ALERT, 0);
	227	else
	228	dev_warn(&client->dev, "no driver alert()!\n");
4cf419a2	229	} else {
a0b8839e	230	dev_dbg(&client->dev, "alert with no driver\n");
4cf419a2	231	}
a0b8839e PR	232	device_unlock(dev);
	233
	234	return -EBUSY;
	235	}
	236
	237	static void sbsm_alert(struct i2c_client *client, enum i2c_alert_protocol prot,
	238	unsigned int d)
	239	{
	240	struct sbsm_data *sbsm = i2c_get_clientdata(client);
	241
	242	int ret, i, irq_bat = 0, state = 0;
	243
	244	ret = sbsm_read_word(sbsm->client, SBSM_CMD_BATSYSSTATE);
	245	if (ret >= 0) {
	246	irq_bat = ret ^ sbsm->last_state;
	247	sbsm->last_state = ret;
	248	state = ret;
	249	}
	250
	251	ret = sbsm_read_word(sbsm->client, SBSM_CMD_BATSYSSTATECONT);
	252	if ((ret >= 0) &&
	253	((ret ^ sbsm->last_state_cont) & SBSM_BIT_AC_PRESENT)) {
	254	irq_bat \|= sbsm->supported_bats & state;
	255	power_supply_changed(sbsm->psy);
	256	}
	257	sbsm->last_state_cont = ret;
	258
	259	for (i = 0; i < SBSM_MAX_BATS; i++) {
	260	if (irq_bat & BIT(i)) {
	261	device_for_each_child(&sbsm->muxc->adapter[i]->dev,
	262	NULL, sbsm_do_alert);
	263	}
	264	}
	265	}
	266
	267	static int sbsm_gpio_setup(struct sbsm_data *data)
	268	{
	269	struct gpio_chip *gc = &data->chip;
	270	struct i2c_client *client = data->client;
	271	struct device *dev = &client->dev;
	272	int ret;
	273
	274	if (!device_property_present(dev, "gpio-controller"))
	275	return 0;
	276
	277	ret = sbsm_read_word(client, SBSM_CMD_BATSYSSTATE);
	278	if (ret < 0)
	279	return ret;
	280	data->last_state = ret;
	281
	282	ret = sbsm_read_word(client, SBSM_CMD_BATSYSSTATECONT);
	283	if (ret < 0)
	284	return ret;
	285	data->last_state_cont = ret;
	286
	287	gc->get = sbsm_gpio_get_value;
	288	gc->direction_input = sbsm_gpio_direction_input;
	289	gc->can_sleep = true;
	290	gc->base = -1;
	291	gc->ngpio = SBSM_MAX_BATS;
	292	gc->label = client->name;
	293	gc->parent = dev;
	294	gc->owner = THIS_MODULE;
	295
296	ret = devm_gpiochip_add_data(dev, gc, data);
297	if (ret) {
298	dev_err(dev, "devm_gpiochip_add_data failed: %d\n", ret);
299	return ret;
300	}
301
302	return ret;
303	}
304
dbc4deda KHS	305	static const struct power_supply_desc sbsm_default_psy_desc = {
	306	.type = POWER_SUPPLY_TYPE_MAINS,
	307	.properties = sbsm_props,
	308	.num_properties = ARRAY_SIZE(sbsm_props),
	309	.get_property = &sbsm_get_property,
	310	.set_property = &sbsm_set_property,
	311	.property_is_writeable = &sbsm_prop_is_writeable,
	312	};
	313
	314	static int sbsm_probe(struct i2c_client *client,
	315	const struct i2c_device_id *id)
	316	{
	317	struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
	318	struct sbsm_data *data;
	319	struct device *dev = &client->dev;
	320	struct power_supply_desc *psy_desc;
	321	struct power_supply_config psy_cfg = {};
a0b8839e	322	int ret = 0, i;
dbc4deda KHS	323
	324	/* Device listens only at address 0x0a */
	325	if (client->addr != 0x0a)
	326	return -EINVAL;
	327
	328	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA))
	329	return -EPFNOSUPPORT;
	330
	331	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
	332	if (!data)
	333	return -ENOMEM;
	334
	335	i2c_set_clientdata(client, data);
	336
	337	data->client = client;
	338	data->is_ltc1760 = !!strstr(id->name, "ltc1760");
	339
	340	ret = sbsm_read_word(client, SBSM_CMD_BATSYSINFO);
	341	if (ret < 0)
	342	return ret;
a0b8839e	343	data->supported_bats = ret & SBSM_MASK_BAT_SUPPORTED;
dbc4deda KHS	344	data->muxc = i2c_mux_alloc(adapter, dev, SBSM_MAX_BATS, 0,
	345	I2C_MUX_LOCKED, &sbsm_select, NULL);
	346	if (!data->muxc) {
	347	dev_err(dev, "failed to alloc i2c mux\n");
	348	ret = -ENOMEM;
	349	goto err_mux_alloc;
	350	}
	351	data->muxc->priv = data;
	352
	353	/* register muxed i2c channels. One for each supported battery */
	354	for (i = 0; i < SBSM_MAX_BATS; ++i) {
a0b8839e	355	if (data->supported_bats & BIT(i)) {
dbc4deda KHS	356	ret = i2c_mux_add_adapter(data->muxc, 0, i + 1, 0);
	357	if (ret)
	358	break;
	359	}
	360	}
	361	if (ret) {
	362	dev_err(dev, "failed to register i2c mux channel %d\n", i + 1);
	363	goto err_mux_register;
	364	}
	365
	366	psy_desc = devm_kmemdup(dev, &sbsm_default_psy_desc,
	367	sizeof(struct power_supply_desc),
	368	GFP_KERNEL);
	369	if (!psy_desc) {
	370	ret = -ENOMEM;
	371	goto err_psy;
	372	}
	373
	374	psy_desc->name = devm_kasprintf(dev, GFP_KERNEL, "sbsm-%s",
	375	dev_name(&client->dev));
	376	if (!psy_desc->name) {
	377	ret = -ENOMEM;
	378	goto err_psy;
	379	}
a0b8839e PR	380	ret = sbsm_gpio_setup(data);
	381	if (ret < 0)
	382	goto err_psy;
dbc4deda KHS	383
	384	psy_cfg.drv_data = data;
	385	psy_cfg.of_node = dev->of_node;
	386	data->psy = devm_power_supply_register(dev, psy_desc, &psy_cfg);
	387	if (IS_ERR(data->psy)) {
	388	ret = PTR_ERR(data->psy);
	389	dev_err(dev, "failed to register power supply %s\n",
	390	psy_desc->name);
	391	goto err_psy;
	392	}
	393
	394	return 0;
	395
	396	err_psy:
	397	err_mux_register:
	398	i2c_mux_del_adapters(data->muxc);
	399
	400	err_mux_alloc:
	401	return ret;
	402	}
	403
	404	static int sbsm_remove(struct i2c_client *client)
	405	{
	406	struct sbsm_data *data = i2c_get_clientdata(client);
	407
	408	i2c_mux_del_adapters(data->muxc);
	409	return 0;
	410	}
	411
	412	static const struct i2c_device_id sbsm_ids[] = {
	413	{ "sbs-manager", 0 },
	414	{ "ltc1760", 0 },
	415	{ }
	416	};
	417	MODULE_DEVICE_TABLE(i2c, sbsm_ids);
	418
	419	#ifdef CONFIG_OF
	420	static const struct of_device_id sbsm_dt_ids[] = {
	421	{ .compatible = "sbs,sbs-manager" },
	422	{ .compatible = "lltc,ltc1760" },
	423	{ }
	424	};
	425	MODULE_DEVICE_TABLE(of, sbsm_dt_ids);
	426	#endif
	427
	428	static struct i2c_driver sbsm_driver = {
	429	.driver = {
	430	.name = "sbsm",
	431	.of_match_table = of_match_ptr(sbsm_dt_ids),
	432	},
	433	.probe = sbsm_probe,
	434	.remove = sbsm_remove,
a0b8839e	435	.alert = sbsm_alert,
dbc4deda KHS	436	.id_table = sbsm_ids
	437	};
	438	module_i2c_driver(sbsm_driver);
	439
	440	MODULE_LICENSE("GPL");
	441	MODULE_AUTHOR("Karl-Heinz Schneider <karl-heinz@schneider-inet.de>");
	442	MODULE_DESCRIPTION("SBSM Smart Battery System Manager");