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
91enum 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
126enum 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
142static 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
158struct 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 */
178static DEFINE_IDR(bq2415x_id);
179
180static DEFINE_MUTEX(bq2415x_id_mutex);
181static DEFINE_MUTEX(bq2415x_timer_mutex);
182static DEFINE_MUTEX(bq2415x_i2c_mutex);
183
184/**** i2c read functions ****/
185
186/* read value from register */
187static 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 */
217static 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 */
232static 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 */
242static 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 */
271static 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 */
290static 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 */
301static 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 */
405static 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 */
455static 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 */
495static 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 */
510static 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 */
522static 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 */
540static 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 */
560static 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 */
579static 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 */
591static 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 */
610static 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) */
621static 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) */
640static 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) */
655static 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) */
674static 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 */
699static 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 */
722static 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
786static 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
806static 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 */
850static 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 */
873static 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 */
885static 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
990static 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
997static 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
1036static 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 */
1049static 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 */
1081static 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) */
1103static 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 */
1126static 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) */
1179static 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) */
1216static 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' */
1243static 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' */
1267static 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' */
1279static 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) */
1296static 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) */
1328static 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 */
1355static 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 */
1391static 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
1417static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO,
1418		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1419static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO,
1420		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1421static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO,
1422		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1423static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO,
1424		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1425static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO,
1426		bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1427
1428static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO,
1429		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1430static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO,
1431		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1432static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO,
1433		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1434static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO,
1435		bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1436
1437static DEVICE_ATTR(reported_mode, S_IRUGO,
1438		bq2415x_sysfs_show_reported_mode, NULL);
1439static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO,
1440		bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode);
1441static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO,
1442		bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer);
1443
1444static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO,
1445		bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers);
1446
1447static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1448static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1449static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1450static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1451
1452static 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
1481ATTRIBUTE_GROUPS(bq2415x_sysfs);
1482
1483static 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 */
1533static 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
1693error_3:
1694	bq2415x_power_supply_exit(bq);
1695error_2:
1696	if (bq)
1697		of_node_put(bq->notify_node);
1698	kfree(name);
1699error_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
1709static 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
1730static 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};
1746MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table);
1747
1748#ifdef CONFIG_ACPI
1749static 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};
1765MODULE_DEVICE_TABLE(acpi, bq2415x_i2c_acpi_match);
1766#endif
1767
1768#ifdef CONFIG_OF
1769static 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};
1784MODULE_DEVICE_TABLE(of, bq2415x_of_match_table);
1785#endif
1786
1787static 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};
1797module_i2c_driver(bq2415x_driver);
1798
1799MODULE_AUTHOR("Pali Roh��r <pali@kernel.org>");
1800MODULE_DESCRIPTION("bq2415x charger driver");
1801MODULE_LICENSE("GPL");
1802