1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Battery driver for Marvell 88PM860x PMIC
4  *
5  * Copyright (c) 2012 Marvell International Ltd.
6  * Author:	Jett Zhou <jtzhou@marvell.com>
7  *		Haojian Zhuang <haojian.zhuang@marvell.com>
8  */
9 
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/platform_device.h>
13 #include <linux/slab.h>
14 #include <linux/power_supply.h>
15 #include <linux/mfd/88pm860x.h>
16 #include <linux/delay.h>
17 #include <linux/uaccess.h>
18 #include <asm/div64.h>
19 
20 /* bit definitions of Status Query Interface 2 */
21 #define STATUS2_CHG		(1 << 2)
22 
23 /* bit definitions of Reset Out Register */
24 #define RESET_SW_PD		(1 << 7)
25 
26 /* bit definitions of PreReg 1 */
27 #define PREREG1_90MA		(0x0)
28 #define PREREG1_180MA		(0x1)
29 #define PREREG1_450MA		(0x4)
30 #define PREREG1_540MA		(0x5)
31 #define PREREG1_1350MA		(0xE)
32 #define PREREG1_VSYS_4_5V	(3 << 4)
33 
34 /* bit definitions of Charger Control 1 Register */
35 #define CC1_MODE_OFF		(0)
36 #define CC1_MODE_PRECHARGE	(1)
37 #define CC1_MODE_FASTCHARGE	(2)
38 #define CC1_MODE_PULSECHARGE	(3)
39 #define CC1_ITERM_20MA		(0 << 2)
40 #define CC1_ITERM_60MA		(2 << 2)
41 #define CC1_VFCHG_4_2V		(9 << 4)
42 
43 /* bit definitions of Charger Control 2 Register */
44 #define CC2_ICHG_100MA		(0x1)
45 #define CC2_ICHG_500MA		(0x9)
46 #define CC2_ICHG_1000MA		(0x13)
47 
48 /* bit definitions of Charger Control 3 Register */
49 #define CC3_180MIN_TIMEOUT	(0x6 << 4)
50 #define CC3_270MIN_TIMEOUT	(0x7 << 4)
51 #define CC3_360MIN_TIMEOUT	(0xA << 4)
52 #define CC3_DISABLE_TIMEOUT	(0xF << 4)
53 
54 /* bit definitions of Charger Control 4 Register */
55 #define CC4_IPRE_40MA		(7)
56 #define CC4_VPCHG_3_2V		(3 << 4)
57 #define CC4_IFCHG_MON_EN	(1 << 6)
58 #define CC4_BTEMP_MON_EN	(1 << 7)
59 
60 /* bit definitions of Charger Control 6 Register */
61 #define CC6_BAT_OV_EN		(1 << 2)
62 #define CC6_BAT_UV_EN		(1 << 3)
63 #define CC6_UV_VBAT_SET		(0x3 << 6)	/* 2.8v */
64 
65 /* bit definitions of Charger Control 7 Register */
66 #define CC7_BAT_REM_EN		(1 << 3)
67 #define CC7_IFSM_EN		(1 << 7)
68 
69 /* bit definitions of Measurement Enable 1 Register */
70 #define MEAS1_VBAT		(1 << 0)
71 
72 /* bit definitions of Measurement Enable 3 Register */
73 #define MEAS3_IBAT_EN		(1 << 0)
74 #define MEAS3_CC_EN		(1 << 2)
75 
76 #define FSM_INIT		0
77 #define FSM_DISCHARGE		1
78 #define FSM_PRECHARGE		2
79 #define FSM_FASTCHARGE		3
80 
81 #define PRECHARGE_THRESHOLD	3100
82 #define POWEROFF_THRESHOLD	3400
83 #define CHARGE_THRESHOLD	4000
84 #define DISCHARGE_THRESHOLD	4180
85 
86 /* over-temperature on PM8606 setting */
87 #define OVER_TEMP_FLAG		(1 << 6)
88 #define OVTEMP_AUTORECOVER	(1 << 3)
89 
90 /* over-voltage protect on vchg setting mv */
91 #define VCHG_NORMAL_LOW		4200
92 #define VCHG_NORMAL_CHECK	5800
93 #define VCHG_NORMAL_HIGH	6000
94 #define VCHG_OVP_LOW		5500
95 
96 struct pm860x_charger_info {
97 	struct pm860x_chip *chip;
98 	struct i2c_client *i2c;
99 	struct i2c_client *i2c_8606;
100 	struct device *dev;
101 
102 	struct power_supply *usb;
103 	struct mutex lock;
104 	int irq_nums;
105 	int irq[7];
106 	unsigned state:3;	/* fsm state */
107 	unsigned online:1;	/* usb charger */
108 	unsigned present:1;	/* battery present */
109 	unsigned allowed:1;
110 };
111 
112 static char *pm860x_supplied_to[] = {
113 	"battery-monitor",
114 };
115 
116 static int measure_vchg(struct pm860x_charger_info *info, int *data)
117 {
118 	unsigned char buf[2];
119 	int ret = 0;
120 
121 	ret = pm860x_bulk_read(info->i2c, PM8607_VCHG_MEAS1, 2, buf);
122 	if (ret < 0)
123 		return ret;
124 
125 	*data = ((buf[0] & 0xff) << 4) | (buf[1] & 0x0f);
126 	/* V_BATT_MEAS(mV) = value * 5 * 1.8 * 1000 / (2^12) */
127 	*data = ((*data & 0xfff) * 9 * 125) >> 9;
128 
129 	dev_dbg(info->dev, "%s, vchg: %d mv\n", __func__, *data);
130 
131 	return ret;
132 }
133 
134 static void set_vchg_threshold(struct pm860x_charger_info *info,
135 			       int min, int max)
136 {
137 	int data;
138 
139 	/* (tmp << 8) * / 5 / 1800 */
140 	if (min <= 0)
141 		data = 0;
142 	else
143 		data = (min << 5) / 1125;
144 	pm860x_reg_write(info->i2c, PM8607_VCHG_LOWTH, data);
145 	dev_dbg(info->dev, "VCHG_LOWTH:%dmv, 0x%x\n", min, data);
146 
147 	if (max <= 0)
148 		data = 0xff;
149 	else
150 		data = (max << 5) / 1125;
151 	pm860x_reg_write(info->i2c, PM8607_VCHG_HIGHTH, data);
152 	dev_dbg(info->dev, "VCHG_HIGHTH:%dmv, 0x%x\n", max, data);
153 
154 }
155 
156 static void set_vbatt_threshold(struct pm860x_charger_info *info,
157 				int min, int max)
158 {
159 	int data;
160 
161 	/* (tmp << 8) * 3 / 1800 */
162 	if (min <= 0)
163 		data = 0;
164 	else
165 		data = (min << 5) / 675;
166 	pm860x_reg_write(info->i2c, PM8607_VBAT_LOWTH, data);
167 	dev_dbg(info->dev, "VBAT Min:%dmv, LOWTH:0x%x\n", min, data);
168 
169 	if (max <= 0)
170 		data = 0xff;
171 	else
172 		data = (max << 5) / 675;
173 	pm860x_reg_write(info->i2c, PM8607_VBAT_HIGHTH, data);
174 	dev_dbg(info->dev, "VBAT Max:%dmv, HIGHTH:0x%x\n", max, data);
175 
176 	return;
177 }
178 
179 static int start_precharge(struct pm860x_charger_info *info)
180 {
181 	int ret;
182 
183 	dev_dbg(info->dev, "Start Pre-charging!\n");
184 	set_vbatt_threshold(info, 0, 0);
185 
186 	ret = pm860x_reg_write(info->i2c_8606, PM8606_PREREGULATORA,
187 			       PREREG1_1350MA | PREREG1_VSYS_4_5V);
188 	if (ret < 0)
189 		goto out;
190 	/* stop charging */
191 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
192 			      CC1_MODE_OFF);
193 	if (ret < 0)
194 		goto out;
195 	/* set 270 minutes timeout */
196 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL3, (0xf << 4),
197 			      CC3_270MIN_TIMEOUT);
198 	if (ret < 0)
199 		goto out;
200 	/* set precharge current, termination voltage, IBAT & TBAT monitor */
201 	ret = pm860x_reg_write(info->i2c, PM8607_CHG_CTRL4,
202 			       CC4_IPRE_40MA | CC4_VPCHG_3_2V |
203 			       CC4_IFCHG_MON_EN | CC4_BTEMP_MON_EN);
204 	if (ret < 0)
205 		goto out;
206 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL7,
207 			      CC7_BAT_REM_EN | CC7_IFSM_EN,
208 			      CC7_BAT_REM_EN | CC7_IFSM_EN);
209 	if (ret < 0)
210 		goto out;
211 	/* trigger precharge */
212 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
213 			      CC1_MODE_PRECHARGE);
214 out:
215 	return ret;
216 }
217 
218 static int start_fastcharge(struct pm860x_charger_info *info)
219 {
220 	int ret;
221 
222 	dev_dbg(info->dev, "Start Fast-charging!\n");
223 
224 	/* set fastcharge termination current & voltage, disable charging */
225 	ret = pm860x_reg_write(info->i2c, PM8607_CHG_CTRL1,
226 			       CC1_MODE_OFF | CC1_ITERM_60MA |
227 			       CC1_VFCHG_4_2V);
228 	if (ret < 0)
229 		goto out;
230 	ret = pm860x_reg_write(info->i2c_8606, PM8606_PREREGULATORA,
231 			       PREREG1_540MA | PREREG1_VSYS_4_5V);
232 	if (ret < 0)
233 		goto out;
234 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL2, 0x1f,
235 			      CC2_ICHG_500MA);
236 	if (ret < 0)
237 		goto out;
238 	/* set 270 minutes timeout */
239 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL3, (0xf << 4),
240 			      CC3_270MIN_TIMEOUT);
241 	if (ret < 0)
242 		goto out;
243 	/* set IBAT & TBAT monitor */
244 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL4,
245 			      CC4_IFCHG_MON_EN | CC4_BTEMP_MON_EN,
246 			      CC4_IFCHG_MON_EN | CC4_BTEMP_MON_EN);
247 	if (ret < 0)
248 		goto out;
249 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL6,
250 			      CC6_BAT_OV_EN | CC6_BAT_UV_EN |
251 			      CC6_UV_VBAT_SET,
252 			      CC6_BAT_OV_EN | CC6_BAT_UV_EN |
253 			      CC6_UV_VBAT_SET);
254 	if (ret < 0)
255 		goto out;
256 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL7,
257 			      CC7_BAT_REM_EN | CC7_IFSM_EN,
258 			      CC7_BAT_REM_EN | CC7_IFSM_EN);
259 	if (ret < 0)
260 		goto out;
261 	/* launch fast-charge */
262 	ret = pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3,
263 			      CC1_MODE_FASTCHARGE);
264 	/* vchg threshold setting */
265 	set_vchg_threshold(info, VCHG_NORMAL_LOW, VCHG_NORMAL_HIGH);
266 out:
267 	return ret;
268 }
269 
270 static void stop_charge(struct pm860x_charger_info *info, int vbatt)
271 {
272 	dev_dbg(info->dev, "Stop charging!\n");
273 	pm860x_set_bits(info->i2c, PM8607_CHG_CTRL1, 3, CC1_MODE_OFF);
274 	if (vbatt > CHARGE_THRESHOLD && info->online)
275 		set_vbatt_threshold(info, CHARGE_THRESHOLD, 0);
276 }
277 
278 static void power_off_notification(struct pm860x_charger_info *info)
279 {
280 	dev_dbg(info->dev, "Power-off notification!\n");
281 }
282 
283 static int set_charging_fsm(struct pm860x_charger_info *info)
284 {
285 	struct power_supply *psy;
286 	union power_supply_propval data;
287 	unsigned char fsm_state[][16] = { "init", "discharge", "precharge",
288 		"fastcharge",
289 	};
290 	int ret;
291 	int vbatt;
292 
293 	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
294 	if (!psy)
295 		return -EINVAL;
296 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW,
297 			&data);
298 	if (ret) {
299 		power_supply_put(psy);
300 		return ret;
301 	}
302 	vbatt = data.intval / 1000;
303 
304 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_PRESENT, &data);
305 	if (ret) {
306 		power_supply_put(psy);
307 		return ret;
308 	}
309 	power_supply_put(psy);
310 
311 	mutex_lock(&info->lock);
312 	info->present = data.intval;
313 
314 	dev_dbg(info->dev, "Entering FSM:%s, Charger:%s, Battery:%s, "
315 		"Allowed:%d\n",
316 		&fsm_state[info->state][0],
317 		(info->online) ? "online" : "N/A",
318 		(info->present) ? "present" : "N/A", info->allowed);
319 	dev_dbg(info->dev, "set_charging_fsm:vbatt:%d(mV)\n", vbatt);
320 
321 	switch (info->state) {
322 	case FSM_INIT:
323 		if (info->online && info->present && info->allowed) {
324 			if (vbatt < PRECHARGE_THRESHOLD) {
325 				info->state = FSM_PRECHARGE;
326 				start_precharge(info);
327 			} else if (vbatt > DISCHARGE_THRESHOLD) {
328 				info->state = FSM_DISCHARGE;
329 				stop_charge(info, vbatt);
330 			} else if (vbatt < DISCHARGE_THRESHOLD) {
331 				info->state = FSM_FASTCHARGE;
332 				start_fastcharge(info);
333 			}
334 		} else {
335 			if (vbatt < POWEROFF_THRESHOLD) {
336 				power_off_notification(info);
337 			} else {
338 				info->state = FSM_DISCHARGE;
339 				stop_charge(info, vbatt);
340 			}
341 		}
342 		break;
343 	case FSM_PRECHARGE:
344 		if (info->online && info->present && info->allowed) {
345 			if (vbatt > PRECHARGE_THRESHOLD) {
346 				info->state = FSM_FASTCHARGE;
347 				start_fastcharge(info);
348 			}
349 		} else {
350 			info->state = FSM_DISCHARGE;
351 			stop_charge(info, vbatt);
352 		}
353 		break;
354 	case FSM_FASTCHARGE:
355 		if (info->online && info->present && info->allowed) {
356 			if (vbatt < PRECHARGE_THRESHOLD) {
357 				info->state = FSM_PRECHARGE;
358 				start_precharge(info);
359 			}
360 		} else {
361 			info->state = FSM_DISCHARGE;
362 			stop_charge(info, vbatt);
363 		}
364 		break;
365 	case FSM_DISCHARGE:
366 		if (info->online && info->present && info->allowed) {
367 			if (vbatt < PRECHARGE_THRESHOLD) {
368 				info->state = FSM_PRECHARGE;
369 				start_precharge(info);
370 			} else if (vbatt < DISCHARGE_THRESHOLD) {
371 				info->state = FSM_FASTCHARGE;
372 				start_fastcharge(info);
373 			}
374 		} else {
375 			if (vbatt < POWEROFF_THRESHOLD)
376 				power_off_notification(info);
377 			else if (vbatt > CHARGE_THRESHOLD && info->online)
378 				set_vbatt_threshold(info, CHARGE_THRESHOLD, 0);
379 		}
380 		break;
381 	default:
382 		dev_warn(info->dev, "FSM meets wrong state:%d\n",
383 			 info->state);
384 		break;
385 	}
386 	dev_dbg(info->dev,
387 		"Out FSM:%s, Charger:%s, Battery:%s, Allowed:%d\n",
388 		&fsm_state[info->state][0],
389 		(info->online) ? "online" : "N/A",
390 		(info->present) ? "present" : "N/A", info->allowed);
391 	mutex_unlock(&info->lock);
392 
393 	return 0;
394 }
395 
396 static irqreturn_t pm860x_charger_handler(int irq, void *data)
397 {
398 	struct pm860x_charger_info *info = data;
399 	int ret;
400 
401 	mutex_lock(&info->lock);
402 	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
403 	if (ret < 0) {
404 		mutex_unlock(&info->lock);
405 		goto out;
406 	}
407 	if (ret & STATUS2_CHG) {
408 		info->online = 1;
409 		info->allowed = 1;
410 	} else {
411 		info->online = 0;
412 		info->allowed = 0;
413 	}
414 	mutex_unlock(&info->lock);
415 	dev_dbg(info->dev, "%s, Charger:%s, Allowed:%d\n", __func__,
416 		(info->online) ? "online" : "N/A", info->allowed);
417 
418 	set_charging_fsm(info);
419 
420 	power_supply_changed(info->usb);
421 out:
422 	return IRQ_HANDLED;
423 }
424 
425 static irqreturn_t pm860x_temp_handler(int irq, void *data)
426 {
427 	struct power_supply *psy;
428 	struct pm860x_charger_info *info = data;
429 	union power_supply_propval temp;
430 	int value;
431 	int ret;
432 
433 	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
434 	if (!psy)
435 		return IRQ_HANDLED;
436 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_TEMP, &temp);
437 	if (ret)
438 		goto out;
439 	value = temp.intval / 10;
440 
441 	mutex_lock(&info->lock);
442 	/* Temperature < -10 C or >40 C, Will not allow charge */
443 	if (value < -10 || value > 40)
444 		info->allowed = 0;
445 	else
446 		info->allowed = 1;
447 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
448 	mutex_unlock(&info->lock);
449 
450 	set_charging_fsm(info);
451 out:
452 	power_supply_put(psy);
453 	return IRQ_HANDLED;
454 }
455 
456 static irqreturn_t pm860x_exception_handler(int irq, void *data)
457 {
458 	struct pm860x_charger_info *info = data;
459 
460 	mutex_lock(&info->lock);
461 	info->allowed = 0;
462 	mutex_unlock(&info->lock);
463 	dev_dbg(info->dev, "%s, irq: %d\n", __func__, irq);
464 
465 	set_charging_fsm(info);
466 	return IRQ_HANDLED;
467 }
468 
469 static irqreturn_t pm860x_done_handler(int irq, void *data)
470 {
471 	struct pm860x_charger_info *info = data;
472 	struct power_supply *psy;
473 	union power_supply_propval val;
474 	int ret;
475 	int vbatt;
476 
477 	mutex_lock(&info->lock);
478 	/* pre-charge done, will transimit to fast-charge stage */
479 	if (info->state == FSM_PRECHARGE) {
480 		info->allowed = 1;
481 		goto out;
482 	}
483 	/*
484 	 * Fast charge done, delay to read
485 	 * the correct status of CHG_DET.
486 	 */
487 	mdelay(5);
488 	info->allowed = 0;
489 	psy = power_supply_get_by_name(pm860x_supplied_to[0]);
490 	if (!psy)
491 		goto out;
492 	ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW,
493 			&val);
494 	if (ret)
495 		goto out_psy_put;
496 	vbatt = val.intval / 1000;
497 	/*
498 	 * CHG_DONE interrupt is faster than CHG_DET interrupt when
499 	 * plug in/out usb, So we can not rely on info->online, we
500 	 * need check pm8607 status register to check usb is online
501 	 * or not, then we can decide it is real charge done
502 	 * automatically or it is triggered by usb plug out;
503 	 */
504 	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
505 	if (ret < 0)
506 		goto out_psy_put;
507 	if (vbatt > CHARGE_THRESHOLD && ret & STATUS2_CHG)
508 		power_supply_set_property(psy, POWER_SUPPLY_PROP_CHARGE_FULL,
509 				&val);
510 
511 out_psy_put:
512 	power_supply_put(psy);
513 out:
514 	mutex_unlock(&info->lock);
515 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
516 	set_charging_fsm(info);
517 
518 	return IRQ_HANDLED;
519 }
520 
521 static irqreturn_t pm860x_vbattery_handler(int irq, void *data)
522 {
523 	struct pm860x_charger_info *info = data;
524 
525 	mutex_lock(&info->lock);
526 
527 	set_vbatt_threshold(info, 0, 0);
528 
529 	if (info->present && info->online)
530 		info->allowed = 1;
531 	else
532 		info->allowed = 0;
533 	mutex_unlock(&info->lock);
534 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
535 
536 	set_charging_fsm(info);
537 
538 	return IRQ_HANDLED;
539 }
540 
541 static irqreturn_t pm860x_vchg_handler(int irq, void *data)
542 {
543 	struct pm860x_charger_info *info = data;
544 	int vchg = 0;
545 
546 	if (info->present)
547 		goto out;
548 
549 	measure_vchg(info, &vchg);
550 
551 	mutex_lock(&info->lock);
552 	if (!info->online) {
553 		int status;
554 		/* check if over-temp on pm8606 or not */
555 		status = pm860x_reg_read(info->i2c_8606, PM8606_FLAGS);
556 		if (status & OVER_TEMP_FLAG) {
557 			/* clear over temp flag and set auto recover */
558 			pm860x_set_bits(info->i2c_8606, PM8606_FLAGS,
559 					OVER_TEMP_FLAG, OVER_TEMP_FLAG);
560 			pm860x_set_bits(info->i2c_8606,
561 					PM8606_VSYS,
562 					OVTEMP_AUTORECOVER,
563 					OVTEMP_AUTORECOVER);
564 			dev_dbg(info->dev,
565 				"%s, pm8606 over-temp occurred\n", __func__);
566 		}
567 	}
568 
569 	if (vchg > VCHG_NORMAL_CHECK) {
570 		set_vchg_threshold(info, VCHG_OVP_LOW, 0);
571 		info->allowed = 0;
572 		dev_dbg(info->dev,
573 			"%s,pm8607 over-vchg occurred,vchg = %dmv\n",
574 			__func__, vchg);
575 	} else if (vchg < VCHG_OVP_LOW) {
576 		set_vchg_threshold(info, VCHG_NORMAL_LOW,
577 				   VCHG_NORMAL_HIGH);
578 		info->allowed = 1;
579 		dev_dbg(info->dev,
580 			"%s,pm8607 over-vchg recover,vchg = %dmv\n",
581 			__func__, vchg);
582 	}
583 	mutex_unlock(&info->lock);
584 
585 	dev_dbg(info->dev, "%s, Allowed: %d\n", __func__, info->allowed);
586 	set_charging_fsm(info);
587 out:
588 	return IRQ_HANDLED;
589 }
590 
591 static int pm860x_usb_get_prop(struct power_supply *psy,
592 			       enum power_supply_property psp,
593 			       union power_supply_propval *val)
594 {
595 	struct pm860x_charger_info *info = power_supply_get_drvdata(psy);
596 
597 	switch (psp) {
598 	case POWER_SUPPLY_PROP_STATUS:
599 		if (info->state == FSM_FASTCHARGE ||
600 				info->state == FSM_PRECHARGE)
601 			val->intval = POWER_SUPPLY_STATUS_CHARGING;
602 		else
603 			val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
604 		break;
605 	case POWER_SUPPLY_PROP_ONLINE:
606 		val->intval = info->online;
607 		break;
608 	default:
609 		return -ENODEV;
610 	}
611 	return 0;
612 }
613 
614 static enum power_supply_property pm860x_usb_props[] = {
615 	POWER_SUPPLY_PROP_STATUS,
616 	POWER_SUPPLY_PROP_ONLINE,
617 };
618 
619 static int pm860x_init_charger(struct pm860x_charger_info *info)
620 {
621 	int ret;
622 
623 	ret = pm860x_reg_read(info->i2c, PM8607_STATUS_2);
624 	if (ret < 0)
625 		return ret;
626 
627 	mutex_lock(&info->lock);
628 	info->state = FSM_INIT;
629 	if (ret & STATUS2_CHG) {
630 		info->online = 1;
631 		info->allowed = 1;
632 	} else {
633 		info->online = 0;
634 		info->allowed = 0;
635 	}
636 	mutex_unlock(&info->lock);
637 
638 	set_charging_fsm(info);
639 	return 0;
640 }
641 
642 static struct pm860x_irq_desc {
643 	const char *name;
644 	irqreturn_t (*handler)(int irq, void *data);
645 } pm860x_irq_descs[] = {
646 	{ "usb supply detect", pm860x_charger_handler },
647 	{ "charge done", pm860x_done_handler },
648 	{ "charge timeout", pm860x_exception_handler },
649 	{ "charge fault", pm860x_exception_handler },
650 	{ "temperature", pm860x_temp_handler },
651 	{ "vbatt", pm860x_vbattery_handler },
652 	{ "vchg", pm860x_vchg_handler },
653 };
654 
655 static const struct power_supply_desc pm860x_charger_desc = {
656 	.name		= "usb",
657 	.type		= POWER_SUPPLY_TYPE_USB,
658 	.properties	= pm860x_usb_props,
659 	.num_properties	= ARRAY_SIZE(pm860x_usb_props),
660 	.get_property	= pm860x_usb_get_prop,
661 };
662 
663 static int pm860x_charger_probe(struct platform_device *pdev)
664 {
665 	struct pm860x_chip *chip = dev_get_drvdata(pdev->dev.parent);
666 	struct power_supply_config psy_cfg = {};
667 	struct pm860x_charger_info *info;
668 	int ret;
669 	int count;
670 	int i;
671 	int j;
672 
673 	info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
674 	if (!info)
675 		return -ENOMEM;
676 
677 	count = pdev->num_resources;
678 	for (i = 0, j = 0; i < count; i++) {
679 		info->irq[j] = platform_get_irq(pdev, i);
680 		if (info->irq[j] < 0)
681 			continue;
682 		j++;
683 	}
684 	info->irq_nums = j;
685 
686 	info->chip = chip;
687 	info->i2c =
688 	    (chip->id == CHIP_PM8607) ? chip->client : chip->companion;
689 	info->i2c_8606 =
690 	    (chip->id == CHIP_PM8607) ? chip->companion : chip->client;
691 	if (!info->i2c_8606) {
692 		dev_err(&pdev->dev, "Missed I2C address of 88PM8606!\n");
693 		ret = -EINVAL;
694 		goto out;
695 	}
696 	info->dev = &pdev->dev;
697 
698 	/* set init value for the case we are not using battery */
699 	set_vchg_threshold(info, VCHG_NORMAL_LOW, VCHG_OVP_LOW);
700 
701 	mutex_init(&info->lock);
702 	platform_set_drvdata(pdev, info);
703 
704 	psy_cfg.drv_data = info;
705 	psy_cfg.supplied_to = pm860x_supplied_to;
706 	psy_cfg.num_supplicants = ARRAY_SIZE(pm860x_supplied_to);
707 	info->usb = power_supply_register(&pdev->dev, &pm860x_charger_desc,
708 					  &psy_cfg);
709 	if (IS_ERR(info->usb)) {
710 		ret = PTR_ERR(info->usb);
711 		goto out;
712 	}
713 
714 	pm860x_init_charger(info);
715 
716 	for (i = 0; i < ARRAY_SIZE(info->irq); i++) {
717 		ret = request_threaded_irq(info->irq[i], NULL,
718 			pm860x_irq_descs[i].handler,
719 			IRQF_ONESHOT, pm860x_irq_descs[i].name, info);
720 		if (ret < 0) {
721 			dev_err(chip->dev, "Failed to request IRQ: #%d: %d\n",
722 				info->irq[i], ret);
723 			goto out_irq;
724 		}
725 	}
726 	return 0;
727 
728 out_irq:
729 	power_supply_unregister(info->usb);
730 	while (--i >= 0)
731 		free_irq(info->irq[i], info);
732 out:
733 	return ret;
734 }
735 
736 static int pm860x_charger_remove(struct platform_device *pdev)
737 {
738 	struct pm860x_charger_info *info = platform_get_drvdata(pdev);
739 	int i;
740 
741 	power_supply_unregister(info->usb);
742 	for (i = 0; i < info->irq_nums; i++)
743 		free_irq(info->irq[i], info);
744 	return 0;
745 }
746 
747 static struct platform_driver pm860x_charger_driver = {
748 	.driver = {
749 		   .name = "88pm860x-charger",
750 	},
751 	.probe = pm860x_charger_probe,
752 	.remove = pm860x_charger_remove,
753 };
754 module_platform_driver(pm860x_charger_driver);
755 
756 MODULE_DESCRIPTION("Marvell 88PM860x Charger driver");
757 MODULE_LICENSE("GPL");
758