1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * bq2415x charger driver
4  *
5  * Copyright (C) 2011-2013  Pali Rohár <pali@kernel.org>
6  *
7  * Datasheets:
8  * https://www.ti.com/product/bq24150
9  * https://www.ti.com/product/bq24150a
10  * https://www.ti.com/product/bq24152
11  * https://www.ti.com/product/bq24153
12  * https://www.ti.com/product/bq24153a
13  * https://www.ti.com/product/bq24155
14  * https://www.ti.com/product/bq24157s
15  * https://www.ti.com/product/bq24158
16  */
17 
18 #include <linux/kernel.h>
19 #include <linux/module.h>
20 #include <linux/param.h>
21 #include <linux/err.h>
22 #include <linux/workqueue.h>
23 #include <linux/sysfs.h>
24 #include <linux/platform_device.h>
25 #include <linux/power_supply.h>
26 #include <linux/idr.h>
27 #include <linux/i2c.h>
28 #include <linux/slab.h>
29 #include <linux/acpi.h>
30 
31 #include <linux/power/bq2415x_charger.h>
32 
33 /* timeout for resetting chip timer */
34 #define BQ2415X_TIMER_TIMEOUT		10
35 
36 #define BQ2415X_REG_STATUS		0x00
37 #define BQ2415X_REG_CONTROL		0x01
38 #define BQ2415X_REG_VOLTAGE		0x02
39 #define BQ2415X_REG_VENDER		0x03
40 #define BQ2415X_REG_CURRENT		0x04
41 
42 /* reset state for all registers */
43 #define BQ2415X_RESET_STATUS		BIT(6)
44 #define BQ2415X_RESET_CONTROL		(BIT(4)|BIT(5))
45 #define BQ2415X_RESET_VOLTAGE		(BIT(1)|BIT(3))
46 #define BQ2415X_RESET_CURRENT		(BIT(0)|BIT(3)|BIT(7))
47 
48 /* status register */
49 #define BQ2415X_BIT_TMR_RST		7
50 #define BQ2415X_BIT_OTG			7
51 #define BQ2415X_BIT_EN_STAT		6
52 #define BQ2415X_MASK_STAT		(BIT(4)|BIT(5))
53 #define BQ2415X_SHIFT_STAT		4
54 #define BQ2415X_BIT_BOOST		3
55 #define BQ2415X_MASK_FAULT		(BIT(0)|BIT(1)|BIT(2))
56 #define BQ2415X_SHIFT_FAULT		0
57 
58 /* control register */
59 #define BQ2415X_MASK_LIMIT		(BIT(6)|BIT(7))
60 #define BQ2415X_SHIFT_LIMIT		6
61 #define BQ2415X_MASK_VLOWV		(BIT(4)|BIT(5))
62 #define BQ2415X_SHIFT_VLOWV		4
63 #define BQ2415X_BIT_TE			3
64 #define BQ2415X_BIT_CE			2
65 #define BQ2415X_BIT_HZ_MODE		1
66 #define BQ2415X_BIT_OPA_MODE		0
67 
68 /* voltage register */
69 #define BQ2415X_MASK_VO		(BIT(2)|BIT(3)|BIT(4)|BIT(5)|BIT(6)|BIT(7))
70 #define BQ2415X_SHIFT_VO		2
71 #define BQ2415X_BIT_OTG_PL		1
72 #define BQ2415X_BIT_OTG_EN		0
73 
74 /* vender register */
75 #define BQ2415X_MASK_VENDER		(BIT(5)|BIT(6)|BIT(7))
76 #define BQ2415X_SHIFT_VENDER		5
77 #define BQ2415X_MASK_PN			(BIT(3)|BIT(4))
78 #define BQ2415X_SHIFT_PN		3
79 #define BQ2415X_MASK_REVISION		(BIT(0)|BIT(1)|BIT(2))
80 #define BQ2415X_SHIFT_REVISION		0
81 
82 /* current register */
83 #define BQ2415X_MASK_RESET		BIT(7)
84 #define BQ2415X_MASK_VI_CHRG		(BIT(4)|BIT(5)|BIT(6))
85 #define BQ2415X_SHIFT_VI_CHRG		4
86 /* N/A					BIT(3) */
87 #define BQ2415X_MASK_VI_TERM		(BIT(0)|BIT(1)|BIT(2))
88 #define BQ2415X_SHIFT_VI_TERM		0
89 
90 
91 enum bq2415x_command {
92 	BQ2415X_TIMER_RESET,
93 	BQ2415X_OTG_STATUS,
94 	BQ2415X_STAT_PIN_STATUS,
95 	BQ2415X_STAT_PIN_ENABLE,
96 	BQ2415X_STAT_PIN_DISABLE,
97 	BQ2415X_CHARGE_STATUS,
98 	BQ2415X_BOOST_STATUS,
99 	BQ2415X_FAULT_STATUS,
100 
101 	BQ2415X_CHARGE_TERMINATION_STATUS,
102 	BQ2415X_CHARGE_TERMINATION_ENABLE,
103 	BQ2415X_CHARGE_TERMINATION_DISABLE,
104 	BQ2415X_CHARGER_STATUS,
105 	BQ2415X_CHARGER_ENABLE,
106 	BQ2415X_CHARGER_DISABLE,
107 	BQ2415X_HIGH_IMPEDANCE_STATUS,
108 	BQ2415X_HIGH_IMPEDANCE_ENABLE,
109 	BQ2415X_HIGH_IMPEDANCE_DISABLE,
110 	BQ2415X_BOOST_MODE_STATUS,
111 	BQ2415X_BOOST_MODE_ENABLE,
112 	BQ2415X_BOOST_MODE_DISABLE,
113 
114 	BQ2415X_OTG_LEVEL,
115 	BQ2415X_OTG_ACTIVATE_HIGH,
116 	BQ2415X_OTG_ACTIVATE_LOW,
117 	BQ2415X_OTG_PIN_STATUS,
118 	BQ2415X_OTG_PIN_ENABLE,
119 	BQ2415X_OTG_PIN_DISABLE,
120 
121 	BQ2415X_VENDER_CODE,
122 	BQ2415X_PART_NUMBER,
123 	BQ2415X_REVISION,
124 };
125 
126 enum bq2415x_chip {
127 	BQUNKNOWN,
128 	BQ24150,
129 	BQ24150A,
130 	BQ24151,
131 	BQ24151A,
132 	BQ24152,
133 	BQ24153,
134 	BQ24153A,
135 	BQ24155,
136 	BQ24156,
137 	BQ24156A,
138 	BQ24157S,
139 	BQ24158,
140 };
141 
142 static char *bq2415x_chip_name[] = {
143 	"unknown",
144 	"bq24150",
145 	"bq24150a",
146 	"bq24151",
147 	"bq24151a",
148 	"bq24152",
149 	"bq24153",
150 	"bq24153a",
151 	"bq24155",
152 	"bq24156",
153 	"bq24156a",
154 	"bq24157s",
155 	"bq24158",
156 };
157 
158 struct bq2415x_device {
159 	struct device *dev;
160 	struct bq2415x_platform_data init_data;
161 	struct power_supply *charger;
162 	struct power_supply_desc charger_desc;
163 	struct delayed_work work;
164 	struct device_node *notify_node;
165 	struct notifier_block nb;
166 	enum bq2415x_mode reported_mode;/* mode reported by hook function */
167 	enum bq2415x_mode mode;		/* currently configured mode */
168 	enum bq2415x_chip chip;
169 	const char *timer_error;
170 	char *model;
171 	char *name;
172 	int autotimer;	/* 1 - if driver automatically reset timer, 0 - not */
173 	int automode;	/* 1 - enabled, 0 - disabled; -1 - not supported */
174 	int id;
175 };
176 
177 /* each registered chip must have unique id */
178 static DEFINE_IDR(bq2415x_id);
179 
180 static DEFINE_MUTEX(bq2415x_id_mutex);
181 static DEFINE_MUTEX(bq2415x_timer_mutex);
182 static DEFINE_MUTEX(bq2415x_i2c_mutex);
183 
184 /**** i2c read functions ****/
185 
186 /* read value from register */
bq2415x_i2c_read(struct bq2415x_device * bq,u8 reg)187 static int bq2415x_i2c_read(struct bq2415x_device *bq, u8 reg)
188 {
189 	struct i2c_client *client = to_i2c_client(bq->dev);
190 	struct i2c_msg msg[2];
191 	u8 val;
192 	int ret;
193 
194 	if (!client->adapter)
195 		return -ENODEV;
196 
197 	msg[0].addr = client->addr;
198 	msg[0].flags = 0;
199 	msg[0].buf = &reg;
200 	msg[0].len = sizeof(reg);
201 	msg[1].addr = client->addr;
202 	msg[1].flags = I2C_M_RD;
203 	msg[1].buf = &val;
204 	msg[1].len = sizeof(val);
205 
206 	mutex_lock(&bq2415x_i2c_mutex);
207 	ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
208 	mutex_unlock(&bq2415x_i2c_mutex);
209 
210 	if (ret < 0)
211 		return ret;
212 
213 	return val;
214 }
215 
216 /* read value from register, apply mask and right shift it */
bq2415x_i2c_read_mask(struct bq2415x_device * bq,u8 reg,u8 mask,u8 shift)217 static int bq2415x_i2c_read_mask(struct bq2415x_device *bq, u8 reg,
218 				 u8 mask, u8 shift)
219 {
220 	int ret;
221 
222 	if (shift > 8)
223 		return -EINVAL;
224 
225 	ret = bq2415x_i2c_read(bq, reg);
226 	if (ret < 0)
227 		return ret;
228 	return (ret & mask) >> shift;
229 }
230 
231 /* read value from register and return one specified bit */
bq2415x_i2c_read_bit(struct bq2415x_device * bq,u8 reg,u8 bit)232 static int bq2415x_i2c_read_bit(struct bq2415x_device *bq, u8 reg, u8 bit)
233 {
234 	if (bit > 8)
235 		return -EINVAL;
236 	return bq2415x_i2c_read_mask(bq, reg, BIT(bit), bit);
237 }
238 
239 /**** i2c write functions ****/
240 
241 /* write value to register */
bq2415x_i2c_write(struct bq2415x_device * bq,u8 reg,u8 val)242 static int bq2415x_i2c_write(struct bq2415x_device *bq, u8 reg, u8 val)
243 {
244 	struct i2c_client *client = to_i2c_client(bq->dev);
245 	struct i2c_msg msg[1];
246 	u8 data[2];
247 	int ret;
248 
249 	data[0] = reg;
250 	data[1] = val;
251 
252 	msg[0].addr = client->addr;
253 	msg[0].flags = 0;
254 	msg[0].buf = data;
255 	msg[0].len = ARRAY_SIZE(data);
256 
257 	mutex_lock(&bq2415x_i2c_mutex);
258 	ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
259 	mutex_unlock(&bq2415x_i2c_mutex);
260 
261 	/* i2c_transfer returns number of messages transferred */
262 	if (ret < 0)
263 		return ret;
264 	else if (ret != 1)
265 		return -EIO;
266 
267 	return 0;
268 }
269 
270 /* read value from register, change it with mask left shifted and write back */
bq2415x_i2c_write_mask(struct bq2415x_device * bq,u8 reg,u8 val,u8 mask,u8 shift)271 static int bq2415x_i2c_write_mask(struct bq2415x_device *bq, u8 reg, u8 val,
272 				  u8 mask, u8 shift)
273 {
274 	int ret;
275 
276 	if (shift > 8)
277 		return -EINVAL;
278 
279 	ret = bq2415x_i2c_read(bq, reg);
280 	if (ret < 0)
281 		return ret;
282 
283 	ret &= ~mask;
284 	ret |= val << shift;
285 
286 	return bq2415x_i2c_write(bq, reg, ret);
287 }
288 
289 /* change only one bit in register */
bq2415x_i2c_write_bit(struct bq2415x_device * bq,u8 reg,bool val,u8 bit)290 static int bq2415x_i2c_write_bit(struct bq2415x_device *bq, u8 reg,
291 				 bool val, u8 bit)
292 {
293 	if (bit > 8)
294 		return -EINVAL;
295 	return bq2415x_i2c_write_mask(bq, reg, val, BIT(bit), bit);
296 }
297 
298 /**** global functions ****/
299 
300 /* exec command function */
bq2415x_exec_command(struct bq2415x_device * bq,enum bq2415x_command command)301 static int bq2415x_exec_command(struct bq2415x_device *bq,
302 				enum bq2415x_command command)
303 {
304 	int ret;
305 
306 	switch (command) {
307 	case BQ2415X_TIMER_RESET:
308 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS,
309 				1, BQ2415X_BIT_TMR_RST);
310 	case BQ2415X_OTG_STATUS:
311 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
312 				BQ2415X_BIT_OTG);
313 	case BQ2415X_STAT_PIN_STATUS:
314 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
315 				BQ2415X_BIT_EN_STAT);
316 	case BQ2415X_STAT_PIN_ENABLE:
317 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 1,
318 				BQ2415X_BIT_EN_STAT);
319 	case BQ2415X_STAT_PIN_DISABLE:
320 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 0,
321 				BQ2415X_BIT_EN_STAT);
322 	case BQ2415X_CHARGE_STATUS:
323 		return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
324 				BQ2415X_MASK_STAT, BQ2415X_SHIFT_STAT);
325 	case BQ2415X_BOOST_STATUS:
326 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
327 				BQ2415X_BIT_BOOST);
328 	case BQ2415X_FAULT_STATUS:
329 		return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
330 			BQ2415X_MASK_FAULT, BQ2415X_SHIFT_FAULT);
331 
332 	case BQ2415X_CHARGE_TERMINATION_STATUS:
333 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
334 				BQ2415X_BIT_TE);
335 	case BQ2415X_CHARGE_TERMINATION_ENABLE:
336 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
337 				1, BQ2415X_BIT_TE);
338 	case BQ2415X_CHARGE_TERMINATION_DISABLE:
339 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
340 				0, BQ2415X_BIT_TE);
341 	case BQ2415X_CHARGER_STATUS:
342 		ret = bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
343 			BQ2415X_BIT_CE);
344 		if (ret < 0)
345 			return ret;
346 		return ret > 0 ? 0 : 1;
347 	case BQ2415X_CHARGER_ENABLE:
348 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
349 				0, BQ2415X_BIT_CE);
350 	case BQ2415X_CHARGER_DISABLE:
351 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
352 				1, BQ2415X_BIT_CE);
353 	case BQ2415X_HIGH_IMPEDANCE_STATUS:
354 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
355 				BQ2415X_BIT_HZ_MODE);
356 	case BQ2415X_HIGH_IMPEDANCE_ENABLE:
357 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
358 				1, BQ2415X_BIT_HZ_MODE);
359 	case BQ2415X_HIGH_IMPEDANCE_DISABLE:
360 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
361 				0, BQ2415X_BIT_HZ_MODE);
362 	case BQ2415X_BOOST_MODE_STATUS:
363 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
364 				BQ2415X_BIT_OPA_MODE);
365 	case BQ2415X_BOOST_MODE_ENABLE:
366 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
367 				1, BQ2415X_BIT_OPA_MODE);
368 	case BQ2415X_BOOST_MODE_DISABLE:
369 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
370 				0, BQ2415X_BIT_OPA_MODE);
371 
372 	case BQ2415X_OTG_LEVEL:
373 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
374 				BQ2415X_BIT_OTG_PL);
375 	case BQ2415X_OTG_ACTIVATE_HIGH:
376 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
377 				1, BQ2415X_BIT_OTG_PL);
378 	case BQ2415X_OTG_ACTIVATE_LOW:
379 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
380 				0, BQ2415X_BIT_OTG_PL);
381 	case BQ2415X_OTG_PIN_STATUS:
382 		return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
383 				BQ2415X_BIT_OTG_EN);
384 	case BQ2415X_OTG_PIN_ENABLE:
385 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
386 				1, BQ2415X_BIT_OTG_EN);
387 	case BQ2415X_OTG_PIN_DISABLE:
388 		return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
389 				0, BQ2415X_BIT_OTG_EN);
390 
391 	case BQ2415X_VENDER_CODE:
392 		return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
393 			BQ2415X_MASK_VENDER, BQ2415X_SHIFT_VENDER);
394 	case BQ2415X_PART_NUMBER:
395 		return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
396 				BQ2415X_MASK_PN, BQ2415X_SHIFT_PN);
397 	case BQ2415X_REVISION:
398 		return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
399 			BQ2415X_MASK_REVISION, BQ2415X_SHIFT_REVISION);
400 	}
401 	return -EINVAL;
402 }
403 
404 /* detect chip type */
bq2415x_detect_chip(struct bq2415x_device * bq)405 static enum bq2415x_chip bq2415x_detect_chip(struct bq2415x_device *bq)
406 {
407 	struct i2c_client *client = to_i2c_client(bq->dev);
408 	int ret = bq2415x_exec_command(bq, BQ2415X_PART_NUMBER);
409 
410 	if (ret < 0)
411 		return ret;
412 
413 	switch (client->addr) {
414 	case 0x6b:
415 		switch (ret) {
416 		case 0:
417 			if (bq->chip == BQ24151A)
418 				return bq->chip;
419 			return BQ24151;
420 		case 1:
421 			if (bq->chip == BQ24150A ||
422 				bq->chip == BQ24152 ||
423 				bq->chip == BQ24155)
424 				return bq->chip;
425 			return BQ24150;
426 		case 2:
427 			if (bq->chip == BQ24153A)
428 				return bq->chip;
429 			return BQ24153;
430 		default:
431 			return BQUNKNOWN;
432 		}
433 		break;
434 
435 	case 0x6a:
436 		switch (ret) {
437 		case 0:
438 			if (bq->chip == BQ24156A)
439 				return bq->chip;
440 			return BQ24156;
441 		case 2:
442 			if (bq->chip == BQ24157S)
443 				return bq->chip;
444 			return BQ24158;
445 		default:
446 			return BQUNKNOWN;
447 		}
448 		break;
449 	}
450 
451 	return BQUNKNOWN;
452 }
453 
454 /* detect chip revision */
bq2415x_detect_revision(struct bq2415x_device * bq)455 static int bq2415x_detect_revision(struct bq2415x_device *bq)
456 {
457 	int ret = bq2415x_exec_command(bq, BQ2415X_REVISION);
458 	int chip = bq2415x_detect_chip(bq);
459 
460 	if (ret < 0 || chip < 0)
461 		return -1;
462 
463 	switch (chip) {
464 	case BQ24150:
465 	case BQ24150A:
466 	case BQ24151:
467 	case BQ24151A:
468 	case BQ24152:
469 		if (ret >= 0 && ret <= 3)
470 			return ret;
471 		return -1;
472 	case BQ24153:
473 	case BQ24153A:
474 	case BQ24156:
475 	case BQ24156A:
476 	case BQ24157S:
477 	case BQ24158:
478 		if (ret == 3)
479 			return 0;
480 		else if (ret == 1)
481 			return 1;
482 		return -1;
483 	case BQ24155:
484 		if (ret == 3)
485 			return 3;
486 		return -1;
487 	case BQUNKNOWN:
488 		return -1;
489 	}
490 
491 	return -1;
492 }
493 
494 /* return chip vender code */
bq2415x_get_vender_code(struct bq2415x_device * bq)495 static int bq2415x_get_vender_code(struct bq2415x_device *bq)
496 {
497 	int ret;
498 
499 	ret = bq2415x_exec_command(bq, BQ2415X_VENDER_CODE);
500 	if (ret < 0)
501 		return 0;
502 
503 	/* convert to binary */
504 	return (ret & 0x1) +
505 	       ((ret >> 1) & 0x1) * 10 +
506 	       ((ret >> 2) & 0x1) * 100;
507 }
508 
509 /* reset all chip registers to default state */
bq2415x_reset_chip(struct bq2415x_device * bq)510 static void bq2415x_reset_chip(struct bq2415x_device *bq)
511 {
512 	bq2415x_i2c_write(bq, BQ2415X_REG_CURRENT, BQ2415X_RESET_CURRENT);
513 	bq2415x_i2c_write(bq, BQ2415X_REG_VOLTAGE, BQ2415X_RESET_VOLTAGE);
514 	bq2415x_i2c_write(bq, BQ2415X_REG_CONTROL, BQ2415X_RESET_CONTROL);
515 	bq2415x_i2c_write(bq, BQ2415X_REG_STATUS, BQ2415X_RESET_STATUS);
516 	bq->timer_error = NULL;
517 }
518 
519 /**** properties functions ****/
520 
521 /* set current limit in mA */
bq2415x_set_current_limit(struct bq2415x_device * bq,int mA)522 static int bq2415x_set_current_limit(struct bq2415x_device *bq, int mA)
523 {
524 	int val;
525 
526 	if (mA <= 100)
527 		val = 0;
528 	else if (mA <= 500)
529 		val = 1;
530 	else if (mA <= 800)
531 		val = 2;
532 	else
533 		val = 3;
534 
535 	return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
536 			BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
537 }
538 
539 /* get current limit in mA */
bq2415x_get_current_limit(struct bq2415x_device * bq)540 static int bq2415x_get_current_limit(struct bq2415x_device *bq)
541 {
542 	int ret;
543 
544 	ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
545 			BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
546 	if (ret < 0)
547 		return ret;
548 	else if (ret == 0)
549 		return 100;
550 	else if (ret == 1)
551 		return 500;
552 	else if (ret == 2)
553 		return 800;
554 	else if (ret == 3)
555 		return 1800;
556 	return -EINVAL;
557 }
558 
559 /* set weak battery voltage in mV */
bq2415x_set_weak_battery_voltage(struct bq2415x_device * bq,int mV)560 static int bq2415x_set_weak_battery_voltage(struct bq2415x_device *bq, int mV)
561 {
562 	int val;
563 
564 	/* round to 100mV */
565 	if (mV <= 3400 + 50)
566 		val = 0;
567 	else if (mV <= 3500 + 50)
568 		val = 1;
569 	else if (mV <= 3600 + 50)
570 		val = 2;
571 	else
572 		val = 3;
573 
574 	return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
575 			BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
576 }
577 
578 /* get weak battery voltage in mV */
bq2415x_get_weak_battery_voltage(struct bq2415x_device * bq)579 static int bq2415x_get_weak_battery_voltage(struct bq2415x_device *bq)
580 {
581 	int ret;
582 
583 	ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
584 			BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
585 	if (ret < 0)
586 		return ret;
587 	return 100 * (34 + ret);
588 }
589 
590 /* set battery regulation voltage in mV */
bq2415x_set_battery_regulation_voltage(struct bq2415x_device * bq,int mV)591 static int bq2415x_set_battery_regulation_voltage(struct bq2415x_device *bq,
592 						  int mV)
593 {
594 	int val = (mV/10 - 350) / 2;
595 
596 	/*
597 	 * According to datasheet, maximum battery regulation voltage is
598 	 * 4440mV which is b101111 = 47.
599 	 */
600 	if (val < 0)
601 		val = 0;
602 	else if (val > 47)
603 		return -EINVAL;
604 
605 	return bq2415x_i2c_write_mask(bq, BQ2415X_REG_VOLTAGE, val,
606 			BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
607 }
608 
609 /* get battery regulation voltage in mV */
bq2415x_get_battery_regulation_voltage(struct bq2415x_device * bq)610 static int bq2415x_get_battery_regulation_voltage(struct bq2415x_device *bq)
611 {
612 	int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_VOLTAGE,
613 			BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
614 
615 	if (ret < 0)
616 		return ret;
617 	return 10 * (350 + 2*ret);
618 }
619 
620 /* set charge current in mA (platform data must provide resistor sense) */
bq2415x_set_charge_current(struct bq2415x_device * bq,int mA)621 static int bq2415x_set_charge_current(struct bq2415x_device *bq, int mA)
622 {
623 	int val;
624 
625 	if (bq->init_data.resistor_sense <= 0)
626 		return -EINVAL;
627 
628 	val = (mA * bq->init_data.resistor_sense - 37400) / 6800;
629 	if (val < 0)
630 		val = 0;
631 	else if (val > 7)
632 		val = 7;
633 
634 	return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
635 			BQ2415X_MASK_VI_CHRG | BQ2415X_MASK_RESET,
636 			BQ2415X_SHIFT_VI_CHRG);
637 }
638 
639 /* get charge current in mA (platform data must provide resistor sense) */
bq2415x_get_charge_current(struct bq2415x_device * bq)640 static int bq2415x_get_charge_current(struct bq2415x_device *bq)
641 {
642 	int ret;
643 
644 	if (bq->init_data.resistor_sense <= 0)
645 		return -EINVAL;
646 
647 	ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
648 			BQ2415X_MASK_VI_CHRG, BQ2415X_SHIFT_VI_CHRG);
649 	if (ret < 0)
650 		return ret;
651 	return (37400 + 6800*ret) / bq->init_data.resistor_sense;
652 }
653 
654 /* set termination current in mA (platform data must provide resistor sense) */
bq2415x_set_termination_current(struct bq2415x_device * bq,int mA)655 static int bq2415x_set_termination_current(struct bq2415x_device *bq, int mA)
656 {
657 	int val;
658 
659 	if (bq->init_data.resistor_sense <= 0)
660 		return -EINVAL;
661 
662 	val = (mA * bq->init_data.resistor_sense - 3400) / 3400;
663 	if (val < 0)
664 		val = 0;
665 	else if (val > 7)
666 		val = 7;
667 
668 	return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
669 			BQ2415X_MASK_VI_TERM | BQ2415X_MASK_RESET,
670 			BQ2415X_SHIFT_VI_TERM);
671 }
672 
673 /* get termination current in mA (platform data must provide resistor sense) */
bq2415x_get_termination_current(struct bq2415x_device * bq)674 static int bq2415x_get_termination_current(struct bq2415x_device *bq)
675 {
676 	int ret;
677 
678 	if (bq->init_data.resistor_sense <= 0)
679 		return -EINVAL;
680 
681 	ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
682 			BQ2415X_MASK_VI_TERM, BQ2415X_SHIFT_VI_TERM);
683 	if (ret < 0)
684 		return ret;
685 	return (3400 + 3400*ret) / bq->init_data.resistor_sense;
686 }
687 
688 /* set default value of property */
689 #define bq2415x_set_default_value(bq, prop) \
690 	do { \
691 		int ret = 0; \
692 		if (bq->init_data.prop != -1) \
693 			ret = bq2415x_set_##prop(bq, bq->init_data.prop); \
694 		if (ret < 0) \
695 			return ret; \
696 	} while (0)
697 
698 /* set default values of all properties */
bq2415x_set_defaults(struct bq2415x_device * bq)699 static int bq2415x_set_defaults(struct bq2415x_device *bq)
700 {
701 	bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
702 	bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
703 	bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_DISABLE);
704 
705 	bq2415x_set_default_value(bq, current_limit);
706 	bq2415x_set_default_value(bq, weak_battery_voltage);
707 	bq2415x_set_default_value(bq, battery_regulation_voltage);
708 
709 	if (bq->init_data.resistor_sense > 0) {
710 		bq2415x_set_default_value(bq, charge_current);
711 		bq2415x_set_default_value(bq, termination_current);
712 		bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_ENABLE);
713 	}
714 
715 	bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
716 	return 0;
717 }
718 
719 /**** charger mode functions ****/
720 
721 /* set charger mode */
bq2415x_set_mode(struct bq2415x_device * bq,enum bq2415x_mode mode)722 static int bq2415x_set_mode(struct bq2415x_device *bq, enum bq2415x_mode mode)
723 {
724 	int ret = 0;
725 	int charger = 0;
726 	int boost = 0;
727 
728 	if (mode == BQ2415X_MODE_BOOST)
729 		boost = 1;
730 	else if (mode != BQ2415X_MODE_OFF)
731 		charger = 1;
732 
733 	if (!charger)
734 		ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
735 
736 	if (!boost)
737 		ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
738 
739 	if (ret < 0)
740 		return ret;
741 
742 	switch (mode) {
743 	case BQ2415X_MODE_OFF:
744 		dev_dbg(bq->dev, "changing mode to: Offline\n");
745 		ret = bq2415x_set_current_limit(bq, 100);
746 		break;
747 	case BQ2415X_MODE_NONE:
748 		dev_dbg(bq->dev, "changing mode to: N/A\n");
749 		ret = bq2415x_set_current_limit(bq, 100);
750 		break;
751 	case BQ2415X_MODE_HOST_CHARGER:
752 		dev_dbg(bq->dev, "changing mode to: Host/HUB charger\n");
753 		ret = bq2415x_set_current_limit(bq, 500);
754 		break;
755 	case BQ2415X_MODE_DEDICATED_CHARGER:
756 		dev_dbg(bq->dev, "changing mode to: Dedicated charger\n");
757 		ret = bq2415x_set_current_limit(bq, 1800);
758 		break;
759 	case BQ2415X_MODE_BOOST: /* Boost mode */
760 		dev_dbg(bq->dev, "changing mode to: Boost\n");
761 		ret = bq2415x_set_current_limit(bq, 100);
762 		break;
763 	}
764 
765 	if (ret < 0)
766 		return ret;
767 
768 	if (charger)
769 		ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
770 	else if (boost)
771 		ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_ENABLE);
772 
773 	if (ret < 0)
774 		return ret;
775 
776 	bq2415x_set_default_value(bq, weak_battery_voltage);
777 	bq2415x_set_default_value(bq, battery_regulation_voltage);
778 
779 	bq->mode = mode;
780 	sysfs_notify(&bq->charger->dev.kobj, NULL, "mode");
781 
782 	return 0;
783 
784 }
785 
bq2415x_update_reported_mode(struct bq2415x_device * bq,int mA)786 static bool bq2415x_update_reported_mode(struct bq2415x_device *bq, int mA)
787 {
788 	enum bq2415x_mode mode;
789 
790 	if (mA == 0)
791 		mode = BQ2415X_MODE_OFF;
792 	else if (mA < 500)
793 		mode = BQ2415X_MODE_NONE;
794 	else if (mA < 1800)
795 		mode = BQ2415X_MODE_HOST_CHARGER;
796 	else
797 		mode = BQ2415X_MODE_DEDICATED_CHARGER;
798 
799 	if (bq->reported_mode == mode)
800 		return false;
801 
802 	bq->reported_mode = mode;
803 	return true;
804 }
805 
bq2415x_notifier_call(struct notifier_block * nb,unsigned long val,void * v)806 static int bq2415x_notifier_call(struct notifier_block *nb,
807 		unsigned long val, void *v)
808 {
809 	struct bq2415x_device *bq =
810 		container_of(nb, struct bq2415x_device, nb);
811 	struct power_supply *psy = v;
812 	union power_supply_propval prop;
813 	int ret;
814 
815 	if (val != PSY_EVENT_PROP_CHANGED)
816 		return NOTIFY_OK;
817 
818 	/* Ignore event if it was not send by notify_node/notify_device */
819 	if (bq->notify_node) {
820 		if (!psy->dev.parent ||
821 		    psy->dev.parent->of_node != bq->notify_node)
822 			return NOTIFY_OK;
823 	} else if (bq->init_data.notify_device) {
824 		if (strcmp(psy->desc->name, bq->init_data.notify_device) != 0)
825 			return NOTIFY_OK;
826 	}
827 
828 	dev_dbg(bq->dev, "notifier call was called\n");
829 
830 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_CURRENT_MAX,
831 			&prop);
832 	if (ret != 0)
833 		return NOTIFY_OK;
834 
835 	if (!bq2415x_update_reported_mode(bq, prop.intval))
836 		return NOTIFY_OK;
837 
838 	/* if automode is not enabled do not tell about reported_mode */
839 	if (bq->automode < 1)
840 		return NOTIFY_OK;
841 
842 	schedule_delayed_work(&bq->work, 0);
843 
844 	return NOTIFY_OK;
845 }
846 
847 /**** timer functions ****/
848 
849 /* enable/disable auto resetting chip timer */
bq2415x_set_autotimer(struct bq2415x_device * bq,int state)850 static void bq2415x_set_autotimer(struct bq2415x_device *bq, int state)
851 {
852 	mutex_lock(&bq2415x_timer_mutex);
853 
854 	if (bq->autotimer == state) {
855 		mutex_unlock(&bq2415x_timer_mutex);
856 		return;
857 	}
858 
859 	bq->autotimer = state;
860 
861 	if (state) {
862 		schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
863 		bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
864 		bq->timer_error = NULL;
865 	} else {
866 		cancel_delayed_work_sync(&bq->work);
867 	}
868 
869 	mutex_unlock(&bq2415x_timer_mutex);
870 }
871 
872 /* called by bq2415x_timer_work on timer error */
bq2415x_timer_error(struct bq2415x_device * bq,const char * msg)873 static void bq2415x_timer_error(struct bq2415x_device *bq, const char *msg)
874 {
875 	bq->timer_error = msg;
876 	sysfs_notify(&bq->charger->dev.kobj, NULL, "timer");
877 	dev_err(bq->dev, "%s\n", msg);
878 	if (bq->automode > 0)
879 		bq->automode = 0;
880 	bq2415x_set_mode(bq, BQ2415X_MODE_OFF);
881 	bq2415x_set_autotimer(bq, 0);
882 }
883 
884 /* delayed work function for auto resetting chip timer */
bq2415x_timer_work(struct work_struct * work)885 static void bq2415x_timer_work(struct work_struct *work)
886 {
887 	struct bq2415x_device *bq = container_of(work, struct bq2415x_device,
888 						 work.work);
889 	int ret;
890 	int error;
891 	int boost;
892 
893 	if (bq->automode > 0 && (bq->reported_mode != bq->mode)) {
894 		sysfs_notify(&bq->charger->dev.kobj, NULL, "reported_mode");
895 		bq2415x_set_mode(bq, bq->reported_mode);
896 	}
897 
898 	if (!bq->autotimer)
899 		return;
900 
901 	ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
902 	if (ret < 0) {
903 		bq2415x_timer_error(bq, "Resetting timer failed");
904 		return;
905 	}
906 
907 	boost = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_STATUS);
908 	if (boost < 0) {
909 		bq2415x_timer_error(bq, "Unknown error");
910 		return;
911 	}
912 
913 	error = bq2415x_exec_command(bq, BQ2415X_FAULT_STATUS);
914 	if (error < 0) {
915 		bq2415x_timer_error(bq, "Unknown error");
916 		return;
917 	}
918 
919 	if (boost) {
920 		switch (error) {
921 		/* Non fatal errors, chip is OK */
922 		case 0: /* No error */
923 			break;
924 		case 6: /* Timer expired */
925 			dev_err(bq->dev, "Timer expired\n");
926 			break;
927 		case 3: /* Battery voltage too low */
928 			dev_err(bq->dev, "Battery voltage to low\n");
929 			break;
930 
931 		/* Fatal errors, disable and reset chip */
932 		case 1: /* Overvoltage protection (chip fried) */
933 			bq2415x_timer_error(bq,
934 				"Overvoltage protection (chip fried)");
935 			return;
936 		case 2: /* Overload */
937 			bq2415x_timer_error(bq, "Overload");
938 			return;
939 		case 4: /* Battery overvoltage protection */
940 			bq2415x_timer_error(bq,
941 				"Battery overvoltage protection");
942 			return;
943 		case 5: /* Thermal shutdown (too hot) */
944 			bq2415x_timer_error(bq,
945 					"Thermal shutdown (too hot)");
946 			return;
947 		case 7: /* N/A */
948 			bq2415x_timer_error(bq, "Unknown error");
949 			return;
950 		}
951 	} else {
952 		switch (error) {
953 		/* Non fatal errors, chip is OK */
954 		case 0: /* No error */
955 			break;
956 		case 2: /* Sleep mode */
957 			dev_err(bq->dev, "Sleep mode\n");
958 			break;
959 		case 3: /* Poor input source */
960 			dev_err(bq->dev, "Poor input source\n");
961 			break;
962 		case 6: /* Timer expired */
963 			dev_err(bq->dev, "Timer expired\n");
964 			break;
965 		case 7: /* No battery */
966 			dev_err(bq->dev, "No battery\n");
967 			break;
968 
969 		/* Fatal errors, disable and reset chip */
970 		case 1: /* Overvoltage protection (chip fried) */
971 			bq2415x_timer_error(bq,
972 				"Overvoltage protection (chip fried)");
973 			return;
974 		case 4: /* Battery overvoltage protection */
975 			bq2415x_timer_error(bq,
976 				"Battery overvoltage protection");
977 			return;
978 		case 5: /* Thermal shutdown (too hot) */
979 			bq2415x_timer_error(bq,
980 				"Thermal shutdown (too hot)");
981 			return;
982 		}
983 	}
984 
985 	schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
986 }
987 
988 /**** power supply interface code ****/
989 
990 static enum power_supply_property bq2415x_power_supply_props[] = {
991 	/* TODO: maybe add more power supply properties */
992 	POWER_SUPPLY_PROP_STATUS,
993 	POWER_SUPPLY_PROP_MODEL_NAME,
994 	POWER_SUPPLY_PROP_ONLINE,
995 };
996 
bq2415x_power_supply_get_property(struct power_supply * psy,enum power_supply_property psp,union power_supply_propval * val)997 static int bq2415x_power_supply_get_property(struct power_supply *psy,
998 					     enum power_supply_property psp,
999 					     union power_supply_propval *val)
1000 {
1001 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1002 	int ret;
1003 
1004 	switch (psp) {
1005 	case POWER_SUPPLY_PROP_STATUS:
1006 		ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS);
1007 		if (ret < 0)
1008 			return ret;
1009 		else if (ret == 0) /* Ready */
1010 			val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
1011 		else if (ret == 1) /* Charge in progress */
1012 			val->intval = POWER_SUPPLY_STATUS_CHARGING;
1013 		else if (ret == 2) /* Charge done */
1014 			val->intval = POWER_SUPPLY_STATUS_FULL;
1015 		else
1016 			val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
1017 		break;
1018 	case POWER_SUPPLY_PROP_MODEL_NAME:
1019 		val->strval = bq->model;
1020 		break;
1021 	case POWER_SUPPLY_PROP_ONLINE:
1022 		/* VBUS is present for all charging and fault states,
1023 		 * except the 'Ready' state.
1024 		 */
1025 		ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS);
1026 		if (ret < 0)
1027 			return ret;
1028 		val->intval = ret > 0;
1029 		break;
1030 	default:
1031 		return -EINVAL;
1032 	}
1033 	return 0;
1034 }
1035 
bq2415x_power_supply_exit(struct bq2415x_device * bq)1036 static void bq2415x_power_supply_exit(struct bq2415x_device *bq)
1037 {
1038 	bq->autotimer = 0;
1039 	if (bq->automode > 0)
1040 		bq->automode = 0;
1041 	cancel_delayed_work_sync(&bq->work);
1042 	power_supply_unregister(bq->charger);
1043 	kfree(bq->model);
1044 }
1045 
1046 /**** additional sysfs entries for power supply interface ****/
1047 
1048 /* show *_status entries */
bq2415x_sysfs_show_status(struct device * dev,struct device_attribute * attr,char * buf)1049 static ssize_t bq2415x_sysfs_show_status(struct device *dev,
1050 					 struct device_attribute *attr,
1051 					 char *buf)
1052 {
1053 	struct power_supply *psy = dev_get_drvdata(dev);
1054 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1055 	enum bq2415x_command command;
1056 	int ret;
1057 
1058 	if (strcmp(attr->attr.name, "otg_status") == 0)
1059 		command = BQ2415X_OTG_STATUS;
1060 	else if (strcmp(attr->attr.name, "charge_status") == 0)
1061 		command = BQ2415X_CHARGE_STATUS;
1062 	else if (strcmp(attr->attr.name, "boost_status") == 0)
1063 		command = BQ2415X_BOOST_STATUS;
1064 	else if (strcmp(attr->attr.name, "fault_status") == 0)
1065 		command = BQ2415X_FAULT_STATUS;
1066 	else
1067 		return -EINVAL;
1068 
1069 	ret = bq2415x_exec_command(bq, command);
1070 	if (ret < 0)
1071 		return ret;
1072 	return sysfs_emit(buf, "%d\n", ret);
1073 }
1074 
1075 /*
1076  * set timer entry:
1077  *    auto - enable auto mode
1078  *    off - disable auto mode
1079  *    (other values) - reset chip timer
1080  */
bq2415x_sysfs_set_timer(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1081 static ssize_t bq2415x_sysfs_set_timer(struct device *dev,
1082 				       struct device_attribute *attr,
1083 				       const char *buf,
1084 				       size_t count)
1085 {
1086 	struct power_supply *psy = dev_get_drvdata(dev);
1087 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1088 	int ret = 0;
1089 
1090 	if (strncmp(buf, "auto", 4) == 0)
1091 		bq2415x_set_autotimer(bq, 1);
1092 	else if (strncmp(buf, "off", 3) == 0)
1093 		bq2415x_set_autotimer(bq, 0);
1094 	else
1095 		ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
1096 
1097 	if (ret < 0)
1098 		return ret;
1099 	return count;
1100 }
1101 
1102 /* show timer entry (auto or off) */
bq2415x_sysfs_show_timer(struct device * dev,struct device_attribute * attr,char * buf)1103 static ssize_t bq2415x_sysfs_show_timer(struct device *dev,
1104 					struct device_attribute *attr,
1105 					char *buf)
1106 {
1107 	struct power_supply *psy = dev_get_drvdata(dev);
1108 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1109 
1110 	if (bq->timer_error)
1111 		return sysfs_emit(buf, "%s\n", bq->timer_error);
1112 
1113 	if (bq->autotimer)
1114 		return sysfs_emit(buf, "auto\n");
1115 	return sysfs_emit(buf, "off\n");
1116 }
1117 
1118 /*
1119  * set mode entry:
1120  *    auto - if automode is supported, enable it and set mode to reported
1121  *    none - disable charger and boost mode
1122  *    host - charging mode for host/hub chargers (current limit 500mA)
1123  *    dedicated - charging mode for dedicated chargers (unlimited current limit)
1124  *    boost - disable charger and enable boost mode
1125  */
bq2415x_sysfs_set_mode(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1126 static ssize_t bq2415x_sysfs_set_mode(struct device *dev,
1127 				      struct device_attribute *attr,
1128 				      const char *buf,
1129 				      size_t count)
1130 {
1131 	struct power_supply *psy = dev_get_drvdata(dev);
1132 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1133 	enum bq2415x_mode mode;
1134 	int ret = 0;
1135 
1136 	if (strncmp(buf, "auto", 4) == 0) {
1137 		if (bq->automode < 0)
1138 			return -EINVAL;
1139 		bq->automode = 1;
1140 		mode = bq->reported_mode;
1141 	} else if (strncmp(buf, "off", 3) == 0) {
1142 		if (bq->automode > 0)
1143 			bq->automode = 0;
1144 		mode = BQ2415X_MODE_OFF;
1145 	} else if (strncmp(buf, "none", 4) == 0) {
1146 		if (bq->automode > 0)
1147 			bq->automode = 0;
1148 		mode = BQ2415X_MODE_NONE;
1149 	} else if (strncmp(buf, "host", 4) == 0) {
1150 		if (bq->automode > 0)
1151 			bq->automode = 0;
1152 		mode = BQ2415X_MODE_HOST_CHARGER;
1153 	} else if (strncmp(buf, "dedicated", 9) == 0) {
1154 		if (bq->automode > 0)
1155 			bq->automode = 0;
1156 		mode = BQ2415X_MODE_DEDICATED_CHARGER;
1157 	} else if (strncmp(buf, "boost", 5) == 0) {
1158 		if (bq->automode > 0)
1159 			bq->automode = 0;
1160 		mode = BQ2415X_MODE_BOOST;
1161 	} else if (strncmp(buf, "reset", 5) == 0) {
1162 		bq2415x_reset_chip(bq);
1163 		bq2415x_set_defaults(bq);
1164 		if (bq->automode <= 0)
1165 			return count;
1166 		bq->automode = 1;
1167 		mode = bq->reported_mode;
1168 	} else {
1169 		return -EINVAL;
1170 	}
1171 
1172 	ret = bq2415x_set_mode(bq, mode);
1173 	if (ret < 0)
1174 		return ret;
1175 	return count;
1176 }
1177 
1178 /* show mode entry (auto, none, host, dedicated or boost) */
bq2415x_sysfs_show_mode(struct device * dev,struct device_attribute * attr,char * buf)1179 static ssize_t bq2415x_sysfs_show_mode(struct device *dev,
1180 				       struct device_attribute *attr,
1181 				       char *buf)
1182 {
1183 	struct power_supply *psy = dev_get_drvdata(dev);
1184 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1185 	ssize_t ret = 0;
1186 
1187 	if (bq->automode > 0)
1188 		ret += sysfs_emit_at(buf, ret, "auto (");
1189 
1190 	switch (bq->mode) {
1191 	case BQ2415X_MODE_OFF:
1192 		ret += sysfs_emit_at(buf, ret, "off");
1193 		break;
1194 	case BQ2415X_MODE_NONE:
1195 		ret += sysfs_emit_at(buf, ret, "none");
1196 		break;
1197 	case BQ2415X_MODE_HOST_CHARGER:
1198 		ret += sysfs_emit_at(buf, ret, "host");
1199 		break;
1200 	case BQ2415X_MODE_DEDICATED_CHARGER:
1201 		ret += sysfs_emit_at(buf, ret, "dedicated");
1202 		break;
1203 	case BQ2415X_MODE_BOOST:
1204 		ret += sysfs_emit_at(buf, ret, "boost");
1205 		break;
1206 	}
1207 
1208 	if (bq->automode > 0)
1209 		ret += sysfs_emit_at(buf, ret, ")");
1210 
1211 	ret += sysfs_emit_at(buf, ret, "\n");
1212 	return ret;
1213 }
1214 
1215 /* show reported_mode entry (none, host, dedicated or boost) */
bq2415x_sysfs_show_reported_mode(struct device * dev,struct device_attribute * attr,char * buf)1216 static ssize_t bq2415x_sysfs_show_reported_mode(struct device *dev,
1217 						struct device_attribute *attr,
1218 						char *buf)
1219 {
1220 	struct power_supply *psy = dev_get_drvdata(dev);
1221 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1222 
1223 	if (bq->automode < 0)
1224 		return -EINVAL;
1225 
1226 	switch (bq->reported_mode) {
1227 	case BQ2415X_MODE_OFF:
1228 		return sysfs_emit(buf, "off\n");
1229 	case BQ2415X_MODE_NONE:
1230 		return sysfs_emit(buf, "none\n");
1231 	case BQ2415X_MODE_HOST_CHARGER:
1232 		return sysfs_emit(buf, "host\n");
1233 	case BQ2415X_MODE_DEDICATED_CHARGER:
1234 		return sysfs_emit(buf, "dedicated\n");
1235 	case BQ2415X_MODE_BOOST:
1236 		return sysfs_emit(buf, "boost\n");
1237 	}
1238 
1239 	return -EINVAL;
1240 }
1241 
1242 /* directly set raw value to chip register, format: 'register value' */
bq2415x_sysfs_set_registers(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1243 static ssize_t bq2415x_sysfs_set_registers(struct device *dev,
1244 					   struct device_attribute *attr,
1245 					   const char *buf,
1246 					   size_t count)
1247 {
1248 	struct power_supply *psy = dev_get_drvdata(dev);
1249 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1250 	ssize_t ret = 0;
1251 	unsigned int reg;
1252 	unsigned int val;
1253 
1254 	if (sscanf(buf, "%x %x", &reg, &val) != 2)
1255 		return -EINVAL;
1256 
1257 	if (reg > 4 || val > 255)
1258 		return -EINVAL;
1259 
1260 	ret = bq2415x_i2c_write(bq, reg, val);
1261 	if (ret < 0)
1262 		return ret;
1263 	return count;
1264 }
1265 
1266 /* print value of chip register, format: 'register=value' */
bq2415x_sysfs_print_reg(struct bq2415x_device * bq,u8 reg,char * buf)1267 static ssize_t bq2415x_sysfs_print_reg(struct bq2415x_device *bq,
1268 				       u8 reg,
1269 				       char *buf)
1270 {
1271 	int ret = bq2415x_i2c_read(bq, reg);
1272 
1273 	if (ret < 0)
1274 		return sysfs_emit(buf, "%#.2x=error %d\n", reg, ret);
1275 	return sysfs_emit(buf, "%#.2x=%#.2x\n", reg, ret);
1276 }
1277 
1278 /* show all raw values of chip register, format per line: 'register=value' */
bq2415x_sysfs_show_registers(struct device * dev,struct device_attribute * attr,char * buf)1279 static ssize_t bq2415x_sysfs_show_registers(struct device *dev,
1280 					    struct device_attribute *attr,
1281 					    char *buf)
1282 {
1283 	struct power_supply *psy = dev_get_drvdata(dev);
1284 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1285 	ssize_t ret = 0;
1286 
1287 	ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_STATUS, buf+ret);
1288 	ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CONTROL, buf+ret);
1289 	ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VOLTAGE, buf+ret);
1290 	ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VENDER, buf+ret);
1291 	ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CURRENT, buf+ret);
1292 	return ret;
1293 }
1294 
1295 /* set current and voltage limit entries (in mA or mV) */
bq2415x_sysfs_set_limit(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1296 static ssize_t bq2415x_sysfs_set_limit(struct device *dev,
1297 				       struct device_attribute *attr,
1298 				       const char *buf,
1299 				       size_t count)
1300 {
1301 	struct power_supply *psy = dev_get_drvdata(dev);
1302 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1303 	long val;
1304 	int ret;
1305 
1306 	if (kstrtol(buf, 10, &val) < 0)
1307 		return -EINVAL;
1308 
1309 	if (strcmp(attr->attr.name, "current_limit") == 0)
1310 		ret = bq2415x_set_current_limit(bq, val);
1311 	else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1312 		ret = bq2415x_set_weak_battery_voltage(bq, val);
1313 	else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1314 		ret = bq2415x_set_battery_regulation_voltage(bq, val);
1315 	else if (strcmp(attr->attr.name, "charge_current") == 0)
1316 		ret = bq2415x_set_charge_current(bq, val);
1317 	else if (strcmp(attr->attr.name, "termination_current") == 0)
1318 		ret = bq2415x_set_termination_current(bq, val);
1319 	else
1320 		return -EINVAL;
1321 
1322 	if (ret < 0)
1323 		return ret;
1324 	return count;
1325 }
1326 
1327 /* show current and voltage limit entries (in mA or mV) */
bq2415x_sysfs_show_limit(struct device * dev,struct device_attribute * attr,char * buf)1328 static ssize_t bq2415x_sysfs_show_limit(struct device *dev,
1329 					struct device_attribute *attr,
1330 					char *buf)
1331 {
1332 	struct power_supply *psy = dev_get_drvdata(dev);
1333 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1334 	int ret;
1335 
1336 	if (strcmp(attr->attr.name, "current_limit") == 0)
1337 		ret = bq2415x_get_current_limit(bq);
1338 	else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1339 		ret = bq2415x_get_weak_battery_voltage(bq);
1340 	else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1341 		ret = bq2415x_get_battery_regulation_voltage(bq);
1342 	else if (strcmp(attr->attr.name, "charge_current") == 0)
1343 		ret = bq2415x_get_charge_current(bq);
1344 	else if (strcmp(attr->attr.name, "termination_current") == 0)
1345 		ret = bq2415x_get_termination_current(bq);
1346 	else
1347 		return -EINVAL;
1348 
1349 	if (ret < 0)
1350 		return ret;
1351 	return sysfs_emit(buf, "%d\n", ret);
1352 }
1353 
1354 /* set *_enable entries */
bq2415x_sysfs_set_enable(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1355 static ssize_t bq2415x_sysfs_set_enable(struct device *dev,
1356 					struct device_attribute *attr,
1357 					const char *buf,
1358 					size_t count)
1359 {
1360 	struct power_supply *psy = dev_get_drvdata(dev);
1361 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1362 	enum bq2415x_command command;
1363 	long val;
1364 	int ret;
1365 
1366 	if (kstrtol(buf, 10, &val) < 0)
1367 		return -EINVAL;
1368 
1369 	if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1370 		command = val ? BQ2415X_CHARGE_TERMINATION_ENABLE :
1371 			BQ2415X_CHARGE_TERMINATION_DISABLE;
1372 	else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1373 		command = val ? BQ2415X_HIGH_IMPEDANCE_ENABLE :
1374 			BQ2415X_HIGH_IMPEDANCE_DISABLE;
1375 	else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1376 		command = val ? BQ2415X_OTG_PIN_ENABLE :
1377 			BQ2415X_OTG_PIN_DISABLE;
1378 	else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1379 		command = val ? BQ2415X_STAT_PIN_ENABLE :
1380 			BQ2415X_STAT_PIN_DISABLE;
1381 	else
1382 		return -EINVAL;
1383 
1384 	ret = bq2415x_exec_command(bq, command);
1385 	if (ret < 0)
1386 		return ret;
1387 	return count;
1388 }
1389 
1390 /* show *_enable entries */
bq2415x_sysfs_show_enable(struct device * dev,struct device_attribute * attr,char * buf)1391 static ssize_t bq2415x_sysfs_show_enable(struct device *dev,
1392 					 struct device_attribute *attr,
1393 					 char *buf)
1394 {
1395 	struct power_supply *psy = dev_get_drvdata(dev);
1396 	struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1397 	enum bq2415x_command command;
1398 	int ret;
1399 
1400 	if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1401 		command = BQ2415X_CHARGE_TERMINATION_STATUS;
1402 	else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1403 		command = BQ2415X_HIGH_IMPEDANCE_STATUS;
1404 	else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1405 		command = BQ2415X_OTG_PIN_STATUS;
1406 	else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1407 		command = BQ2415X_STAT_PIN_STATUS;
1408 	else
1409 		return -EINVAL;
1410 
1411 	ret = bq2415x_exec_command(bq, command);
1412 	if (ret < 0)
1413 		return ret;
1414 	return sysfs_emit(buf, "%d\n", ret);
1415 }
1416 
1417 static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO,
1418 		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1419 static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO,
1420 		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1421 static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO,
1422 		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1423 static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO,
1424 		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1425 static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO,
1426 		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1427 
1428 static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO,
1429 		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1430 static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO,
1431 		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1432 static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO,
1433 		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1434 static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO,
1435 		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1436 
1437 static DEVICE_ATTR(reported_mode, S_IRUGO,
1438 		bq2415x_sysfs_show_reported_mode, NULL);
1439 static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO,
1440 		bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode);
1441 static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO,
1442 		bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer);
1443 
1444 static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO,
1445 		bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers);
1446 
1447 static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1448 static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1449 static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1450 static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1451 
1452 static struct attribute *bq2415x_sysfs_attrs[] = {
1453 	/*
1454 	 * TODO: some (appropriate) of these attrs should be switched to
1455 	 * use power supply class props.
1456 	 */
1457 	&dev_attr_current_limit.attr,
1458 	&dev_attr_weak_battery_voltage.attr,
1459 	&dev_attr_battery_regulation_voltage.attr,
1460 	&dev_attr_charge_current.attr,
1461 	&dev_attr_termination_current.attr,
1462 
1463 	&dev_attr_charge_termination_enable.attr,
1464 	&dev_attr_high_impedance_enable.attr,
1465 	&dev_attr_otg_pin_enable.attr,
1466 	&dev_attr_stat_pin_enable.attr,
1467 
1468 	&dev_attr_reported_mode.attr,
1469 	&dev_attr_mode.attr,
1470 	&dev_attr_timer.attr,
1471 
1472 	&dev_attr_registers.attr,
1473 
1474 	&dev_attr_otg_status.attr,
1475 	&dev_attr_charge_status.attr,
1476 	&dev_attr_boost_status.attr,
1477 	&dev_attr_fault_status.attr,
1478 	NULL,
1479 };
1480 
1481 ATTRIBUTE_GROUPS(bq2415x_sysfs);
1482 
bq2415x_power_supply_init(struct bq2415x_device * bq)1483 static int bq2415x_power_supply_init(struct bq2415x_device *bq)
1484 {
1485 	int ret;
1486 	int chip;
1487 	char revstr[8];
1488 	struct power_supply_config psy_cfg = {
1489 		.drv_data = bq,
1490 		.of_node = bq->dev->of_node,
1491 		.attr_grp = bq2415x_sysfs_groups,
1492 	};
1493 
1494 	bq->charger_desc.name = bq->name;
1495 	bq->charger_desc.type = POWER_SUPPLY_TYPE_USB;
1496 	bq->charger_desc.properties = bq2415x_power_supply_props;
1497 	bq->charger_desc.num_properties =
1498 			ARRAY_SIZE(bq2415x_power_supply_props);
1499 	bq->charger_desc.get_property = bq2415x_power_supply_get_property;
1500 
1501 	ret = bq2415x_detect_chip(bq);
1502 	if (ret < 0)
1503 		chip = BQUNKNOWN;
1504 	else
1505 		chip = ret;
1506 
1507 	ret = bq2415x_detect_revision(bq);
1508 	if (ret < 0)
1509 		strcpy(revstr, "unknown");
1510 	else
1511 		sprintf(revstr, "1.%d", ret);
1512 
1513 	bq->model = kasprintf(GFP_KERNEL,
1514 				"chip %s, revision %s, vender code %.3d",
1515 				bq2415x_chip_name[chip], revstr,
1516 				bq2415x_get_vender_code(bq));
1517 	if (!bq->model) {
1518 		dev_err(bq->dev, "failed to allocate model name\n");
1519 		return -ENOMEM;
1520 	}
1521 
1522 	bq->charger = power_supply_register(bq->dev, &bq->charger_desc,
1523 					    &psy_cfg);
1524 	if (IS_ERR(bq->charger)) {
1525 		kfree(bq->model);
1526 		return PTR_ERR(bq->charger);
1527 	}
1528 
1529 	return 0;
1530 }
1531 
1532 /* main bq2415x probe function */
bq2415x_probe(struct i2c_client * client)1533 static int bq2415x_probe(struct i2c_client *client)
1534 {
1535 	const struct i2c_device_id *id = i2c_client_get_device_id(client);
1536 	int ret;
1537 	int num;
1538 	char *name = NULL;
1539 	struct bq2415x_device *bq;
1540 	struct device_node *np = client->dev.of_node;
1541 	struct bq2415x_platform_data *pdata = client->dev.platform_data;
1542 	const struct acpi_device_id *acpi_id = NULL;
1543 	struct power_supply *notify_psy = NULL;
1544 	union power_supply_propval prop;
1545 
1546 	if (!np && !pdata && !ACPI_HANDLE(&client->dev)) {
1547 		dev_err(&client->dev, "Neither devicetree, nor platform data, nor ACPI support\n");
1548 		return -ENODEV;
1549 	}
1550 
1551 	/* Get new ID for the new device */
1552 	mutex_lock(&bq2415x_id_mutex);
1553 	num = idr_alloc(&bq2415x_id, client, 0, 0, GFP_KERNEL);
1554 	mutex_unlock(&bq2415x_id_mutex);
1555 	if (num < 0)
1556 		return num;
1557 
1558 	if (id) {
1559 		name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
1560 	} else if (ACPI_HANDLE(&client->dev)) {
1561 		acpi_id =
1562 			acpi_match_device(client->dev.driver->acpi_match_table,
1563 					  &client->dev);
1564 		if (!acpi_id) {
1565 			dev_err(&client->dev, "failed to match device name\n");
1566 			ret = -ENODEV;
1567 			goto error_1;
1568 		}
1569 		name = kasprintf(GFP_KERNEL, "%s-%d", acpi_id->id, num);
1570 	}
1571 	if (!name) {
1572 		dev_err(&client->dev, "failed to allocate device name\n");
1573 		ret = -ENOMEM;
1574 		goto error_1;
1575 	}
1576 
1577 	bq = devm_kzalloc(&client->dev, sizeof(*bq), GFP_KERNEL);
1578 	if (!bq) {
1579 		ret = -ENOMEM;
1580 		goto error_2;
1581 	}
1582 
1583 	i2c_set_clientdata(client, bq);
1584 
1585 	bq->id = num;
1586 	bq->dev = &client->dev;
1587 	if (id)
1588 		bq->chip = id->driver_data;
1589 	else if (ACPI_HANDLE(bq->dev))
1590 		bq->chip = acpi_id->driver_data;
1591 	bq->name = name;
1592 	bq->mode = BQ2415X_MODE_OFF;
1593 	bq->reported_mode = BQ2415X_MODE_OFF;
1594 	bq->autotimer = 0;
1595 	bq->automode = 0;
1596 
1597 	if (np || ACPI_HANDLE(bq->dev)) {
1598 		ret = device_property_read_u32(bq->dev,
1599 					       "ti,current-limit",
1600 					       &bq->init_data.current_limit);
1601 		if (ret)
1602 			goto error_2;
1603 		ret = device_property_read_u32(bq->dev,
1604 					"ti,weak-battery-voltage",
1605 					&bq->init_data.weak_battery_voltage);
1606 		if (ret)
1607 			goto error_2;
1608 		ret = device_property_read_u32(bq->dev,
1609 				"ti,battery-regulation-voltage",
1610 				&bq->init_data.battery_regulation_voltage);
1611 		if (ret)
1612 			goto error_2;
1613 		ret = device_property_read_u32(bq->dev,
1614 					       "ti,charge-current",
1615 					       &bq->init_data.charge_current);
1616 		if (ret)
1617 			goto error_2;
1618 		ret = device_property_read_u32(bq->dev,
1619 				"ti,termination-current",
1620 				&bq->init_data.termination_current);
1621 		if (ret)
1622 			goto error_2;
1623 		ret = device_property_read_u32(bq->dev,
1624 					       "ti,resistor-sense",
1625 					       &bq->init_data.resistor_sense);
1626 		if (ret)
1627 			goto error_2;
1628 		if (np)
1629 			bq->notify_node = of_parse_phandle(np,
1630 						"ti,usb-charger-detection", 0);
1631 	} else {
1632 		memcpy(&bq->init_data, pdata, sizeof(bq->init_data));
1633 	}
1634 
1635 	bq2415x_reset_chip(bq);
1636 
1637 	ret = bq2415x_power_supply_init(bq);
1638 	if (ret) {
1639 		dev_err(bq->dev, "failed to register power supply: %d\n", ret);
1640 		goto error_2;
1641 	}
1642 
1643 	ret = bq2415x_set_defaults(bq);
1644 	if (ret) {
1645 		dev_err(bq->dev, "failed to set default values: %d\n", ret);
1646 		goto error_3;
1647 	}
1648 
1649 	if (bq->notify_node || bq->init_data.notify_device) {
1650 		bq->nb.notifier_call = bq2415x_notifier_call;
1651 		ret = power_supply_reg_notifier(&bq->nb);
1652 		if (ret) {
1653 			dev_err(bq->dev, "failed to reg notifier: %d\n", ret);
1654 			goto error_3;
1655 		}
1656 
1657 		bq->automode = 1;
1658 		dev_info(bq->dev, "automode supported, waiting for events\n");
1659 	} else {
1660 		bq->automode = -1;
1661 		dev_info(bq->dev, "automode not supported\n");
1662 	}
1663 
1664 	/* Query for initial reported_mode and set it */
1665 	if (bq->nb.notifier_call) {
1666 		if (np) {
1667 			notify_psy = power_supply_get_by_phandle(np,
1668 						"ti,usb-charger-detection");
1669 			if (IS_ERR(notify_psy))
1670 				notify_psy = NULL;
1671 		} else if (bq->init_data.notify_device) {
1672 			notify_psy = power_supply_get_by_name(
1673 						bq->init_data.notify_device);
1674 		}
1675 	}
1676 	if (notify_psy) {
1677 		ret = power_supply_get_property(notify_psy,
1678 					POWER_SUPPLY_PROP_CURRENT_MAX, &prop);
1679 		power_supply_put(notify_psy);
1680 
1681 		if (ret == 0) {
1682 			bq2415x_update_reported_mode(bq, prop.intval);
1683 			bq2415x_set_mode(bq, bq->reported_mode);
1684 		}
1685 	}
1686 
1687 	INIT_DELAYED_WORK(&bq->work, bq2415x_timer_work);
1688 	bq2415x_set_autotimer(bq, 1);
1689 
1690 	dev_info(bq->dev, "driver registered\n");
1691 	return 0;
1692 
1693 error_3:
1694 	bq2415x_power_supply_exit(bq);
1695 error_2:
1696 	if (bq)
1697 		of_node_put(bq->notify_node);
1698 	kfree(name);
1699 error_1:
1700 	mutex_lock(&bq2415x_id_mutex);
1701 	idr_remove(&bq2415x_id, num);
1702 	mutex_unlock(&bq2415x_id_mutex);
1703 
1704 	return ret;
1705 }
1706 
1707 /* main bq2415x remove function */
1708 
bq2415x_remove(struct i2c_client * client)1709 static void bq2415x_remove(struct i2c_client *client)
1710 {
1711 	struct bq2415x_device *bq = i2c_get_clientdata(client);
1712 
1713 	if (bq->nb.notifier_call)
1714 		power_supply_unreg_notifier(&bq->nb);
1715 
1716 	of_node_put(bq->notify_node);
1717 	bq2415x_power_supply_exit(bq);
1718 
1719 	bq2415x_reset_chip(bq);
1720 
1721 	mutex_lock(&bq2415x_id_mutex);
1722 	idr_remove(&bq2415x_id, bq->id);
1723 	mutex_unlock(&bq2415x_id_mutex);
1724 
1725 	dev_info(bq->dev, "driver unregistered\n");
1726 
1727 	kfree(bq->name);
1728 }
1729 
1730 static const struct i2c_device_id bq2415x_i2c_id_table[] = {
1731 	{ "bq2415x", BQUNKNOWN },
1732 	{ "bq24150", BQ24150 },
1733 	{ "bq24150a", BQ24150A },
1734 	{ "bq24151", BQ24151 },
1735 	{ "bq24151a", BQ24151A },
1736 	{ "bq24152", BQ24152 },
1737 	{ "bq24153", BQ24153 },
1738 	{ "bq24153a", BQ24153A },
1739 	{ "bq24155", BQ24155 },
1740 	{ "bq24156", BQ24156 },
1741 	{ "bq24156a", BQ24156A },
1742 	{ "bq24157s", BQ24157S },
1743 	{ "bq24158", BQ24158 },
1744 	{},
1745 };
1746 MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table);
1747 
1748 #ifdef CONFIG_ACPI
1749 static const struct acpi_device_id bq2415x_i2c_acpi_match[] = {
1750 	{ "BQ2415X", BQUNKNOWN },
1751 	{ "BQ241500", BQ24150 },
1752 	{ "BQA24150", BQ24150A },
1753 	{ "BQ241510", BQ24151 },
1754 	{ "BQA24151", BQ24151A },
1755 	{ "BQ241520", BQ24152 },
1756 	{ "BQ241530", BQ24153 },
1757 	{ "BQA24153", BQ24153A },
1758 	{ "BQ241550", BQ24155 },
1759 	{ "BQ241560", BQ24156 },
1760 	{ "BQA24156", BQ24156A },
1761 	{ "BQS24157", BQ24157S },
1762 	{ "BQ241580", BQ24158 },
1763 	{},
1764 };
1765 MODULE_DEVICE_TABLE(acpi, bq2415x_i2c_acpi_match);
1766 #endif
1767 
1768 #ifdef CONFIG_OF
1769 static const struct of_device_id bq2415x_of_match_table[] = {
1770 	{ .compatible = "ti,bq24150" },
1771 	{ .compatible = "ti,bq24150a" },
1772 	{ .compatible = "ti,bq24151" },
1773 	{ .compatible = "ti,bq24151a" },
1774 	{ .compatible = "ti,bq24152" },
1775 	{ .compatible = "ti,bq24153" },
1776 	{ .compatible = "ti,bq24153a" },
1777 	{ .compatible = "ti,bq24155" },
1778 	{ .compatible = "ti,bq24156" },
1779 	{ .compatible = "ti,bq24156a" },
1780 	{ .compatible = "ti,bq24157s" },
1781 	{ .compatible = "ti,bq24158" },
1782 	{},
1783 };
1784 MODULE_DEVICE_TABLE(of, bq2415x_of_match_table);
1785 #endif
1786 
1787 static struct i2c_driver bq2415x_driver = {
1788 	.driver = {
1789 		.name = "bq2415x-charger",
1790 		.of_match_table = of_match_ptr(bq2415x_of_match_table),
1791 		.acpi_match_table = ACPI_PTR(bq2415x_i2c_acpi_match),
1792 	},
1793 	.probe = bq2415x_probe,
1794 	.remove = bq2415x_remove,
1795 	.id_table = bq2415x_i2c_id_table,
1796 };
1797 module_i2c_driver(bq2415x_driver);
1798 
1799 MODULE_AUTHOR("Pali Rohár <pali@kernel.org>");
1800 MODULE_DESCRIPTION("bq2415x charger driver");
1801 MODULE_LICENSE("GPL");
1802