Merge tag 'block-5.11-2021-01-10' of git://git.kernel.dk/linux-block
[linux/fpc-iii.git] / drivers / power / supply / sbs-manager.c
blob666243d9dd593139286d59331ec4ad49013af6e3
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Driver for SBS compliant Smart Battery System Managers
5 * The device communicates via i2c at address 0x0a and multiplexes access to up
6 * to four smart batteries at address 0x0b.
8 * Via sysfs interface the online state and charge type are presented.
10 * Datasheet SBSM: http://sbs-forum.org/specs/sbsm100b.pdf
11 * Datasheet LTC1760: http://cds.linear.com/docs/en/datasheet/1760fb.pdf
13 * Karl-Heinz Schneider <karl-heinz@schneider-inet.de>
16 #include <linux/gpio.h>
17 #include <linux/module.h>
18 #include <linux/i2c.h>
19 #include <linux/i2c-mux.h>
20 #include <linux/power_supply.h>
21 #include <linux/property.h>
23 #define SBSM_MAX_BATS 4
24 #define SBSM_RETRY_CNT 3
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
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)
37 #define SBSM_SMB_BAT_OFFSET 11
38 struct sbsm_data {
39 struct i2c_client *client;
40 struct i2c_mux_core *muxc;
42 struct power_supply *psy;
44 u8 cur_chan; /* currently selected channel */
45 struct gpio_chip chip;
46 bool is_ltc1760; /* special capabilities */
48 unsigned int supported_bats;
49 unsigned int last_state;
50 unsigned int last_state_cont;
53 static enum power_supply_property sbsm_props[] = {
54 POWER_SUPPLY_PROP_ONLINE,
55 POWER_SUPPLY_PROP_CHARGE_TYPE,
58 static int sbsm_read_word(struct i2c_client *client, u8 address)
60 int reg, retries;
62 for (retries = SBSM_RETRY_CNT; retries > 0; retries--) {
63 reg = i2c_smbus_read_word_data(client, address);
64 if (reg >= 0)
65 break;
68 if (reg < 0) {
69 dev_err(&client->dev, "failed to read register 0x%02x\n",
70 address);
73 return reg;
76 static int sbsm_write_word(struct i2c_client *client, u8 address, u16 word)
78 int ret, retries;
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;
85 if (ret < 0)
86 dev_err(&client->dev, "failed to write to register 0x%02x\n",
87 address);
89 return ret;
92 static int sbsm_get_property(struct power_supply *psy,
93 enum power_supply_property psp,
94 union power_supply_propval *val)
96 struct sbsm_data *data = power_supply_get_drvdata(psy);
97 int regval = 0;
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;
107 case POWER_SUPPLY_PROP_CHARGE_TYPE:
108 regval = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE);
109 if (regval < 0)
110 return regval;
112 if ((regval & SBSM_MASK_CHARGE_BAT) == 0) {
113 val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
114 return 0;
116 val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
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;
126 break;
128 default:
129 return -EINVAL;
132 return 0;
135 static int sbsm_prop_is_writeable(struct power_supply *psy,
136 enum power_supply_property psp)
138 struct sbsm_data *data = power_supply_get_drvdata(psy);
140 return (psp == POWER_SUPPLY_PROP_CHARGE_TYPE) && data->is_ltc1760;
143 static int sbsm_set_property(struct power_supply *psy,
144 enum power_supply_property psp,
145 const union power_supply_propval *val)
147 struct sbsm_data *data = power_supply_get_drvdata(psy);
148 int ret = -EINVAL;
149 u16 regval;
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;
161 default:
162 break;
165 return ret;
169 * Switch to battery
170 * Parameter chan is directly the content of SMB_BAT* nibble
172 static int sbsm_select(struct i2c_mux_core *muxc, u32 chan)
174 struct sbsm_data *data = i2c_mux_priv(muxc);
175 struct device *dev = &data->client->dev;
176 int ret = 0;
177 u16 reg;
179 if (data->cur_chan == chan)
180 return ret;
182 /* chan goes from 1 ... 4 */
183 reg = BIT(SBSM_SMB_BAT_OFFSET + chan);
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;
190 return ret;
193 static int sbsm_gpio_get_value(struct gpio_chip *gc, unsigned int off)
195 struct sbsm_data *data = gpiochip_get_data(gc);
196 int ret;
198 ret = sbsm_read_word(data->client, SBSM_CMD_BATSYSSTATE);
199 if (ret < 0)
200 return ret;
202 return ret & BIT(off);
206 * This needs to be defined or the GPIO lib fails to register the pin.
207 * But the 'gpio' is always an input.
209 static int sbsm_gpio_direction_input(struct gpio_chip *gc, unsigned int off)
211 return 0;
214 static int sbsm_do_alert(struct device *dev, void *d)
216 struct i2c_client *client = i2c_verify_client(dev);
217 struct i2c_driver *driver;
219 if (!client || client->addr != 0x0b)
220 return 0;
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");
229 } else {
230 dev_dbg(&client->dev, "alert with no driver\n");
232 device_unlock(dev);
234 return -EBUSY;
237 static void sbsm_alert(struct i2c_client *client, enum i2c_alert_protocol prot,
238 unsigned int d)
240 struct sbsm_data *sbsm = i2c_get_clientdata(client);
242 int ret, i, irq_bat = 0, state = 0;
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;
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);
257 sbsm->last_state_cont = ret;
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);
267 static int sbsm_gpio_setup(struct sbsm_data *data)
269 struct gpio_chip *gc = &data->chip;
270 struct i2c_client *client = data->client;
271 struct device *dev = &client->dev;
272 int ret;
274 if (!device_property_present(dev, "gpio-controller"))
275 return 0;
277 ret = sbsm_read_word(client, SBSM_CMD_BATSYSSTATE);
278 if (ret < 0)
279 return ret;
280 data->last_state = ret;
282 ret = sbsm_read_word(client, SBSM_CMD_BATSYSSTATECONT);
283 if (ret < 0)
284 return ret;
285 data->last_state_cont = ret;
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;
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;
302 return ret;
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,
314 static int sbsm_probe(struct i2c_client *client,
315 const struct i2c_device_id *id)
317 struct i2c_adapter *adapter = client->adapter;
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 = {};
322 int ret = 0, i;
324 /* Device listens only at address 0x0a */
325 if (client->addr != 0x0a)
326 return -EINVAL;
328 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA))
329 return -EPFNOSUPPORT;
331 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
332 if (!data)
333 return -ENOMEM;
335 i2c_set_clientdata(client, data);
337 data->client = client;
338 data->is_ltc1760 = !!strstr(id->name, "ltc1760");
340 ret = sbsm_read_word(client, SBSM_CMD_BATSYSINFO);
341 if (ret < 0)
342 return ret;
343 data->supported_bats = ret & SBSM_MASK_BAT_SUPPORTED;
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;
351 data->muxc->priv = data;
353 /* register muxed i2c channels. One for each supported battery */
354 for (i = 0; i < SBSM_MAX_BATS; ++i) {
355 if (data->supported_bats & BIT(i)) {
356 ret = i2c_mux_add_adapter(data->muxc, 0, i + 1, 0);
357 if (ret)
358 break;
361 if (ret) {
362 dev_err(dev, "failed to register i2c mux channel %d\n", i + 1);
363 goto err_mux_register;
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;
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;
380 ret = sbsm_gpio_setup(data);
381 if (ret < 0)
382 goto err_psy;
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;
394 return 0;
396 err_psy:
397 err_mux_register:
398 i2c_mux_del_adapters(data->muxc);
400 err_mux_alloc:
401 return ret;
404 static int sbsm_remove(struct i2c_client *client)
406 struct sbsm_data *data = i2c_get_clientdata(client);
408 i2c_mux_del_adapters(data->muxc);
409 return 0;
412 static const struct i2c_device_id sbsm_ids[] = {
413 { "sbs-manager", 0 },
414 { "ltc1760", 0 },
417 MODULE_DEVICE_TABLE(i2c, sbsm_ids);
419 #ifdef CONFIG_OF
420 static const struct of_device_id sbsm_dt_ids[] = {
421 { .compatible = "sbs,sbs-manager" },
422 { .compatible = "lltc,ltc1760" },
425 MODULE_DEVICE_TABLE(of, sbsm_dt_ids);
426 #endif
428 static struct i2c_driver sbsm_driver = {
429 .driver = {
430 .name = "sbsm",
431 .of_match_table = of_match_ptr(sbsm_dt_ids),
433 .probe = sbsm_probe,
434 .remove = sbsm_remove,
435 .alert = sbsm_alert,
436 .id_table = sbsm_ids
438 module_i2c_driver(sbsm_driver);
440 MODULE_LICENSE("GPL");
441 MODULE_AUTHOR("Karl-Heinz Schneider <karl-heinz@schneider-inet.de>");
442 MODULE_DESCRIPTION("SBSM Smart Battery System Manager");