xref: /linux/drivers/power/supply/ab8500_charger.c (revision 172cdcaefea5c297fdb3d20b7d5aff60ae4fbce6)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (C) ST-Ericsson SA 2012
4  *
5  * Charger driver for AB8500
6  *
7  * Author:
8  *	Johan Palsson <johan.palsson@stericsson.com>
9  *	Karl Komierowski <karl.komierowski@stericsson.com>
10  *	Arun R Murthy <arun.murthy@stericsson.com>
11  */
12 
13 #include <linux/init.h>
14 #include <linux/module.h>
15 #include <linux/device.h>
16 #include <linux/interrupt.h>
17 #include <linux/delay.h>
18 #include <linux/notifier.h>
19 #include <linux/slab.h>
20 #include <linux/platform_device.h>
21 #include <linux/power_supply.h>
22 #include <linux/completion.h>
23 #include <linux/regulator/consumer.h>
24 #include <linux/err.h>
25 #include <linux/workqueue.h>
26 #include <linux/kobject.h>
27 #include <linux/of.h>
28 #include <linux/mfd/core.h>
29 #include <linux/mfd/abx500/ab8500.h>
30 #include <linux/mfd/abx500.h>
31 #include <linux/usb/otg.h>
32 #include <linux/mutex.h>
33 #include <linux/iio/consumer.h>
34 
35 #include "ab8500-bm.h"
36 #include "ab8500-chargalg.h"
37 
38 /* Charger constants */
39 #define NO_PW_CONN			0
40 #define AC_PW_CONN			1
41 #define USB_PW_CONN			2
42 
43 #define MAIN_WDOG_ENA			0x01
44 #define MAIN_WDOG_KICK			0x02
45 #define MAIN_WDOG_DIS			0x00
46 #define CHARG_WD_KICK			0x01
47 #define MAIN_CH_ENA			0x01
48 #define MAIN_CH_NO_OVERSHOOT_ENA_N	0x02
49 #define USB_CH_ENA			0x01
50 #define USB_CHG_NO_OVERSHOOT_ENA_N	0x02
51 #define MAIN_CH_DET			0x01
52 #define MAIN_CH_CV_ON			0x04
53 #define USB_CH_CV_ON			0x08
54 #define VBUS_DET_DBNC100		0x02
55 #define VBUS_DET_DBNC1			0x01
56 #define OTP_ENABLE_WD			0x01
57 #define DROP_COUNT_RESET		0x01
58 #define USB_CH_DET			0x01
59 
60 #define MAIN_CH_INPUT_CURR_SHIFT	4
61 #define VBUS_IN_CURR_LIM_SHIFT		4
62 #define AUTO_VBUS_IN_CURR_LIM_SHIFT	4
63 #define VBUS_IN_CURR_LIM_RETRY_SET_TIME	30 /* seconds */
64 
65 #define LED_INDICATOR_PWM_ENA		0x01
66 #define LED_INDICATOR_PWM_DIS		0x00
67 #define LED_IND_CUR_5MA			0x04
68 #define LED_INDICATOR_PWM_DUTY_252_256	0xBF
69 
70 /* HW failure constants */
71 #define MAIN_CH_TH_PROT			0x02
72 #define VBUS_CH_NOK			0x08
73 #define USB_CH_TH_PROT			0x02
74 #define VBUS_OVV_TH			0x01
75 #define MAIN_CH_NOK			0x01
76 #define VBUS_DET			0x80
77 
78 #define MAIN_CH_STATUS2_MAINCHGDROP		0x80
79 #define MAIN_CH_STATUS2_MAINCHARGERDETDBNC	0x40
80 #define USB_CH_VBUSDROP				0x40
81 #define USB_CH_VBUSDETDBNC			0x01
82 
83 /* UsbLineStatus register bit masks */
84 #define AB8500_USB_LINK_STATUS		0x78
85 #define AB8505_USB_LINK_STATUS		0xF8
86 #define AB8500_STD_HOST_SUSP		0x18
87 #define USB_LINK_STATUS_SHIFT		3
88 
89 /* Watchdog timeout constant */
90 #define WD_TIMER			0x30 /* 4min */
91 #define WD_KICK_INTERVAL		(60 * HZ)
92 
93 /* Lowest charger voltage is 3.39V -> 0x4E */
94 #define LOW_VOLT_REG			0x4E
95 
96 /* Step up/down delay in us */
97 #define STEP_UDELAY			1000
98 
99 #define CHARGER_STATUS_POLL 10 /* in ms */
100 
101 #define CHG_WD_INTERVAL			(60 * HZ)
102 
103 #define AB8500_SW_CONTROL_FALLBACK	0x03
104 /* Wait for enumeration before charing in us */
105 #define WAIT_ACA_RID_ENUMERATION	(5 * 1000)
106 /*External charger control*/
107 #define AB8500_SYS_CHARGER_CONTROL_REG		0x52
108 #define EXTERNAL_CHARGER_DISABLE_REG_VAL	0x03
109 #define EXTERNAL_CHARGER_ENABLE_REG_VAL		0x07
110 
111 /* UsbLineStatus register - usb types */
112 enum ab8500_charger_link_status {
113 	USB_STAT_NOT_CONFIGURED,
114 	USB_STAT_STD_HOST_NC,
115 	USB_STAT_STD_HOST_C_NS,
116 	USB_STAT_STD_HOST_C_S,
117 	USB_STAT_HOST_CHG_NM,
118 	USB_STAT_HOST_CHG_HS,
119 	USB_STAT_HOST_CHG_HS_CHIRP,
120 	USB_STAT_DEDICATED_CHG,
121 	USB_STAT_ACA_RID_A,
122 	USB_STAT_ACA_RID_B,
123 	USB_STAT_ACA_RID_C_NM,
124 	USB_STAT_ACA_RID_C_HS,
125 	USB_STAT_ACA_RID_C_HS_CHIRP,
126 	USB_STAT_HM_IDGND,
127 	USB_STAT_RESERVED,
128 	USB_STAT_NOT_VALID_LINK,
129 	USB_STAT_PHY_EN,
130 	USB_STAT_SUP_NO_IDGND_VBUS,
131 	USB_STAT_SUP_IDGND_VBUS,
132 	USB_STAT_CHARGER_LINE_1,
133 	USB_STAT_CARKIT_1,
134 	USB_STAT_CARKIT_2,
135 	USB_STAT_ACA_DOCK_CHARGER,
136 };
137 
138 enum ab8500_usb_state {
139 	AB8500_BM_USB_STATE_RESET_HS,	/* HighSpeed Reset */
140 	AB8500_BM_USB_STATE_RESET_FS,	/* FullSpeed/LowSpeed Reset */
141 	AB8500_BM_USB_STATE_CONFIGURED,
142 	AB8500_BM_USB_STATE_SUSPEND,
143 	AB8500_BM_USB_STATE_RESUME,
144 	AB8500_BM_USB_STATE_MAX,
145 };
146 
147 /* VBUS input current limits supported in AB8500 in mA */
148 #define USB_CH_IP_CUR_LVL_0P05		50
149 #define USB_CH_IP_CUR_LVL_0P09		98
150 #define USB_CH_IP_CUR_LVL_0P19		193
151 #define USB_CH_IP_CUR_LVL_0P29		290
152 #define USB_CH_IP_CUR_LVL_0P38		380
153 #define USB_CH_IP_CUR_LVL_0P45		450
154 #define USB_CH_IP_CUR_LVL_0P5		500
155 #define USB_CH_IP_CUR_LVL_0P6		600
156 #define USB_CH_IP_CUR_LVL_0P7		700
157 #define USB_CH_IP_CUR_LVL_0P8		800
158 #define USB_CH_IP_CUR_LVL_0P9		900
159 #define USB_CH_IP_CUR_LVL_1P0		1000
160 #define USB_CH_IP_CUR_LVL_1P1		1100
161 #define USB_CH_IP_CUR_LVL_1P3		1300
162 #define USB_CH_IP_CUR_LVL_1P4		1400
163 #define USB_CH_IP_CUR_LVL_1P5		1500
164 
165 #define VBAT_TRESH_IP_CUR_RED		3800
166 
167 #define to_ab8500_charger_usb_device_info(x) container_of((x), \
168 	struct ab8500_charger, usb_chg)
169 #define to_ab8500_charger_ac_device_info(x) container_of((x), \
170 	struct ab8500_charger, ac_chg)
171 
172 /**
173  * struct ab8500_charger_interrupts - ab8500 interupts
174  * @name:	name of the interrupt
175  * @isr		function pointer to the isr
176  */
177 struct ab8500_charger_interrupts {
178 	char *name;
179 	irqreturn_t (*isr)(int irq, void *data);
180 };
181 
182 struct ab8500_charger_info {
183 	int charger_connected;
184 	int charger_online;
185 	int charger_voltage;
186 	int cv_active;
187 	bool wd_expired;
188 	int charger_current;
189 };
190 
191 struct ab8500_charger_event_flags {
192 	bool mainextchnotok;
193 	bool main_thermal_prot;
194 	bool usb_thermal_prot;
195 	bool vbus_ovv;
196 	bool usbchargernotok;
197 	bool chgwdexp;
198 	bool vbus_collapse;
199 	bool vbus_drop_end;
200 };
201 
202 struct ab8500_charger_usb_state {
203 	int usb_current;
204 	int usb_current_tmp;
205 	enum ab8500_usb_state state;
206 	enum ab8500_usb_state state_tmp;
207 	spinlock_t usb_lock;
208 };
209 
210 struct ab8500_charger_max_usb_in_curr {
211 	int usb_type_max;
212 	int set_max;
213 	int calculated_max;
214 };
215 
216 /**
217  * struct ab8500_charger - ab8500 Charger device information
218  * @dev:		Pointer to the structure device
219  * @vbus_detected:	VBUS detected
220  * @vbus_detected_start:
221  *			VBUS detected during startup
222  * @ac_conn:		This will be true when the AC charger has been plugged
223  * @vddadc_en_ac:	Indicate if VDD ADC supply is enabled because AC
224  *			charger is enabled
225  * @vddadc_en_usb:	Indicate if VDD ADC supply is enabled because USB
226  *			charger is enabled
227  * @vbat		Battery voltage
228  * @old_vbat		Previously measured battery voltage
229  * @usb_device_is_unrecognised	USB device is unrecognised by the hardware
230  * @autopower		Indicate if we should have automatic pwron after pwrloss
231  * @autopower_cfg	platform specific power config support for "pwron after pwrloss"
232  * @invalid_charger_detect_state State when forcing AB to use invalid charger
233  * @is_aca_rid:		Incicate if accessory is ACA type
234  * @current_stepping_sessions:
235  *			Counter for current stepping sessions
236  * @parent:		Pointer to the struct ab8500
237  * @adc_main_charger_v	ADC channel for main charger voltage
238  * @adc_main_charger_c	ADC channel for main charger current
239  * @adc_vbus_v		ADC channel for USB charger voltage
240  * @adc_usb_charger_c	ADC channel for USB charger current
241  * @bm:           	Platform specific battery management information
242  * @flags:		Structure for information about events triggered
243  * @usb_state:		Structure for usb stack information
244  * @max_usb_in_curr:	Max USB charger input current
245  * @ac_chg:		AC charger power supply
246  * @usb_chg:		USB charger power supply
247  * @ac:			Structure that holds the AC charger properties
248  * @usb:		Structure that holds the USB charger properties
249  * @regu:		Pointer to the struct regulator
250  * @charger_wq:		Work queue for the IRQs and checking HW state
251  * @usb_ipt_crnt_lock:	Lock to protect VBUS input current setting from mutuals
252  * @pm_lock:		Lock to prevent system to suspend
253  * @check_vbat_work	Work for checking vbat threshold to adjust vbus current
254  * @check_hw_failure_work:	Work for checking HW state
255  * @check_usbchgnotok_work:	Work for checking USB charger not ok status
256  * @kick_wd_work:		Work for kicking the charger watchdog in case
257  *				of ABB rev 1.* due to the watchog logic bug
258  * @ac_charger_attached_work:	Work for checking if AC charger is still
259  *				connected
260  * @usb_charger_attached_work:	Work for checking if USB charger is still
261  *				connected
262  * @ac_work:			Work for checking AC charger connection
263  * @detect_usb_type_work:	Work for detecting the USB type connected
264  * @usb_link_status_work:	Work for checking the new USB link status
265  * @usb_state_changed_work:	Work for checking USB state
266  * @attach_work:		Work for detecting USB type
267  * @vbus_drop_end_work:		Work for detecting VBUS drop end
268  * @check_main_thermal_prot_work:
269  *				Work for checking Main thermal status
270  * @check_usb_thermal_prot_work:
271  *				Work for checking USB thermal status
272  * @charger_attached_mutex:	For controlling the wakelock
273  */
274 struct ab8500_charger {
275 	struct device *dev;
276 	bool vbus_detected;
277 	bool vbus_detected_start;
278 	bool ac_conn;
279 	bool vddadc_en_ac;
280 	bool vddadc_en_usb;
281 	int vbat;
282 	int old_vbat;
283 	bool usb_device_is_unrecognised;
284 	bool autopower;
285 	bool autopower_cfg;
286 	int invalid_charger_detect_state;
287 	int is_aca_rid;
288 	atomic_t current_stepping_sessions;
289 	struct ab8500 *parent;
290 	struct iio_channel *adc_main_charger_v;
291 	struct iio_channel *adc_main_charger_c;
292 	struct iio_channel *adc_vbus_v;
293 	struct iio_channel *adc_usb_charger_c;
294 	struct abx500_bm_data *bm;
295 	struct ab8500_charger_event_flags flags;
296 	struct ab8500_charger_usb_state usb_state;
297 	struct ab8500_charger_max_usb_in_curr max_usb_in_curr;
298 	struct ux500_charger ac_chg;
299 	struct ux500_charger usb_chg;
300 	struct ab8500_charger_info ac;
301 	struct ab8500_charger_info usb;
302 	struct regulator *regu;
303 	struct workqueue_struct *charger_wq;
304 	struct mutex usb_ipt_crnt_lock;
305 	struct delayed_work check_vbat_work;
306 	struct delayed_work check_hw_failure_work;
307 	struct delayed_work check_usbchgnotok_work;
308 	struct delayed_work kick_wd_work;
309 	struct delayed_work usb_state_changed_work;
310 	struct delayed_work attach_work;
311 	struct delayed_work ac_charger_attached_work;
312 	struct delayed_work usb_charger_attached_work;
313 	struct delayed_work vbus_drop_end_work;
314 	struct work_struct ac_work;
315 	struct work_struct detect_usb_type_work;
316 	struct work_struct usb_link_status_work;
317 	struct work_struct check_main_thermal_prot_work;
318 	struct work_struct check_usb_thermal_prot_work;
319 	struct usb_phy *usb_phy;
320 	struct notifier_block nb;
321 	struct mutex charger_attached_mutex;
322 };
323 
324 /* AC properties */
325 static enum power_supply_property ab8500_charger_ac_props[] = {
326 	POWER_SUPPLY_PROP_HEALTH,
327 	POWER_SUPPLY_PROP_PRESENT,
328 	POWER_SUPPLY_PROP_ONLINE,
329 	POWER_SUPPLY_PROP_VOLTAGE_NOW,
330 	POWER_SUPPLY_PROP_VOLTAGE_AVG,
331 	POWER_SUPPLY_PROP_CURRENT_NOW,
332 };
333 
334 /* USB properties */
335 static enum power_supply_property ab8500_charger_usb_props[] = {
336 	POWER_SUPPLY_PROP_HEALTH,
337 	POWER_SUPPLY_PROP_CURRENT_AVG,
338 	POWER_SUPPLY_PROP_PRESENT,
339 	POWER_SUPPLY_PROP_ONLINE,
340 	POWER_SUPPLY_PROP_VOLTAGE_NOW,
341 	POWER_SUPPLY_PROP_VOLTAGE_AVG,
342 	POWER_SUPPLY_PROP_CURRENT_NOW,
343 };
344 
345 /*
346  * Function for enabling and disabling sw fallback mode
347  * should always be disabled when no charger is connected.
348  */
349 static void ab8500_enable_disable_sw_fallback(struct ab8500_charger *di,
350 		bool fallback)
351 {
352 	u8 val;
353 	u8 reg;
354 	u8 bank;
355 	u8 bit;
356 	int ret;
357 
358 	dev_dbg(di->dev, "SW Fallback: %d\n", fallback);
359 
360 	if (is_ab8500(di->parent)) {
361 		bank = 0x15;
362 		reg = 0x0;
363 		bit = 3;
364 	} else {
365 		bank = AB8500_SYS_CTRL1_BLOCK;
366 		reg = AB8500_SW_CONTROL_FALLBACK;
367 		bit = 0;
368 	}
369 
370 	/* read the register containing fallback bit */
371 	ret = abx500_get_register_interruptible(di->dev, bank, reg, &val);
372 	if (ret < 0) {
373 		dev_err(di->dev, "%d read failed\n", __LINE__);
374 		return;
375 	}
376 
377 	if (is_ab8500(di->parent)) {
378 		/* enable the OPT emulation registers */
379 		ret = abx500_set_register_interruptible(di->dev, 0x11, 0x00, 0x2);
380 		if (ret) {
381 			dev_err(di->dev, "%d write failed\n", __LINE__);
382 			goto disable_otp;
383 		}
384 	}
385 
386 	if (fallback)
387 		val |= (1 << bit);
388 	else
389 		val &= ~(1 << bit);
390 
391 	/* write back the changed fallback bit value to register */
392 	ret = abx500_set_register_interruptible(di->dev, bank, reg, val);
393 	if (ret) {
394 		dev_err(di->dev, "%d write failed\n", __LINE__);
395 	}
396 
397 disable_otp:
398 	if (is_ab8500(di->parent)) {
399 		/* disable the set OTP registers again */
400 		ret = abx500_set_register_interruptible(di->dev, 0x11, 0x00, 0x0);
401 		if (ret) {
402 			dev_err(di->dev, "%d write failed\n", __LINE__);
403 		}
404 	}
405 }
406 
407 /**
408  * ab8500_power_supply_changed - a wrapper with local extensions for
409  * power_supply_changed
410  * @di:	  pointer to the ab8500_charger structure
411  * @psy:  pointer to power_supply_that have changed.
412  *
413  */
414 static void ab8500_power_supply_changed(struct ab8500_charger *di,
415 					struct power_supply *psy)
416 {
417 	if (di->autopower_cfg) {
418 		if (!di->usb.charger_connected &&
419 		    !di->ac.charger_connected &&
420 		    di->autopower) {
421 			di->autopower = false;
422 			ab8500_enable_disable_sw_fallback(di, false);
423 		} else if (!di->autopower &&
424 			   (di->ac.charger_connected ||
425 			    di->usb.charger_connected)) {
426 			di->autopower = true;
427 			ab8500_enable_disable_sw_fallback(di, true);
428 		}
429 	}
430 	power_supply_changed(psy);
431 }
432 
433 static void ab8500_charger_set_usb_connected(struct ab8500_charger *di,
434 	bool connected)
435 {
436 	if (connected != di->usb.charger_connected) {
437 		dev_dbg(di->dev, "USB connected:%i\n", connected);
438 		di->usb.charger_connected = connected;
439 
440 		if (!connected)
441 			di->flags.vbus_drop_end = false;
442 
443 		sysfs_notify(&di->usb_chg.psy->dev.kobj, NULL, "present");
444 
445 		if (connected) {
446 			mutex_lock(&di->charger_attached_mutex);
447 			mutex_unlock(&di->charger_attached_mutex);
448 
449 			if (is_ab8500(di->parent))
450 				queue_delayed_work(di->charger_wq,
451 					   &di->usb_charger_attached_work,
452 					   HZ);
453 		} else {
454 			cancel_delayed_work_sync(&di->usb_charger_attached_work);
455 			mutex_lock(&di->charger_attached_mutex);
456 			mutex_unlock(&di->charger_attached_mutex);
457 		}
458 	}
459 }
460 
461 /**
462  * ab8500_charger_get_ac_voltage() - get ac charger voltage
463  * @di:		pointer to the ab8500_charger structure
464  *
465  * Returns ac charger voltage (on success)
466  */
467 static int ab8500_charger_get_ac_voltage(struct ab8500_charger *di)
468 {
469 	int vch, ret;
470 
471 	/* Only measure voltage if the charger is connected */
472 	if (di->ac.charger_connected) {
473 		ret = iio_read_channel_processed(di->adc_main_charger_v, &vch);
474 		if (ret < 0)
475 			dev_err(di->dev, "%s ADC conv failed,\n", __func__);
476 	} else {
477 		vch = 0;
478 	}
479 	return vch;
480 }
481 
482 /**
483  * ab8500_charger_ac_cv() - check if the main charger is in CV mode
484  * @di:		pointer to the ab8500_charger structure
485  *
486  * Returns ac charger CV mode (on success) else error code
487  */
488 static int ab8500_charger_ac_cv(struct ab8500_charger *di)
489 {
490 	u8 val;
491 	int ret = 0;
492 
493 	/* Only check CV mode if the charger is online */
494 	if (di->ac.charger_online) {
495 		ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
496 			AB8500_CH_STATUS1_REG, &val);
497 		if (ret < 0) {
498 			dev_err(di->dev, "%s ab8500 read failed\n", __func__);
499 			return 0;
500 		}
501 
502 		if (val & MAIN_CH_CV_ON)
503 			ret = 1;
504 		else
505 			ret = 0;
506 	}
507 
508 	return ret;
509 }
510 
511 /**
512  * ab8500_charger_get_vbus_voltage() - get vbus voltage
513  * @di:		pointer to the ab8500_charger structure
514  *
515  * This function returns the vbus voltage.
516  * Returns vbus voltage (on success)
517  */
518 static int ab8500_charger_get_vbus_voltage(struct ab8500_charger *di)
519 {
520 	int vch, ret;
521 
522 	/* Only measure voltage if the charger is connected */
523 	if (di->usb.charger_connected) {
524 		ret = iio_read_channel_processed(di->adc_vbus_v, &vch);
525 		if (ret < 0)
526 			dev_err(di->dev, "%s ADC conv failed,\n", __func__);
527 	} else {
528 		vch = 0;
529 	}
530 	return vch;
531 }
532 
533 /**
534  * ab8500_charger_get_usb_current() - get usb charger current
535  * @di:		pointer to the ab8500_charger structure
536  *
537  * This function returns the usb charger current.
538  * Returns usb current (on success) and error code on failure
539  */
540 static int ab8500_charger_get_usb_current(struct ab8500_charger *di)
541 {
542 	int ich, ret;
543 
544 	/* Only measure current if the charger is online */
545 	if (di->usb.charger_online) {
546 		ret = iio_read_channel_processed(di->adc_usb_charger_c, &ich);
547 		if (ret < 0)
548 			dev_err(di->dev, "%s ADC conv failed,\n", __func__);
549 	} else {
550 		ich = 0;
551 	}
552 	return ich;
553 }
554 
555 /**
556  * ab8500_charger_get_ac_current() - get ac charger current
557  * @di:		pointer to the ab8500_charger structure
558  *
559  * This function returns the ac charger current.
560  * Returns ac current (on success) and error code on failure.
561  */
562 static int ab8500_charger_get_ac_current(struct ab8500_charger *di)
563 {
564 	int ich, ret;
565 
566 	/* Only measure current if the charger is online */
567 	if (di->ac.charger_online) {
568 		ret = iio_read_channel_processed(di->adc_main_charger_c, &ich);
569 		if (ret < 0)
570 			dev_err(di->dev, "%s ADC conv failed,\n", __func__);
571 	} else {
572 		ich = 0;
573 	}
574 	return ich;
575 }
576 
577 /**
578  * ab8500_charger_usb_cv() - check if the usb charger is in CV mode
579  * @di:		pointer to the ab8500_charger structure
580  *
581  * Returns ac charger CV mode (on success) else error code
582  */
583 static int ab8500_charger_usb_cv(struct ab8500_charger *di)
584 {
585 	int ret;
586 	u8 val;
587 
588 	/* Only check CV mode if the charger is online */
589 	if (di->usb.charger_online) {
590 		ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
591 			AB8500_CH_USBCH_STAT1_REG, &val);
592 		if (ret < 0) {
593 			dev_err(di->dev, "%s ab8500 read failed\n", __func__);
594 			return 0;
595 		}
596 
597 		if (val & USB_CH_CV_ON)
598 			ret = 1;
599 		else
600 			ret = 0;
601 	} else {
602 		ret = 0;
603 	}
604 
605 	return ret;
606 }
607 
608 /**
609  * ab8500_charger_detect_chargers() - Detect the connected chargers
610  * @di:		pointer to the ab8500_charger structure
611  * @probe:	if probe, don't delay and wait for HW
612  *
613  * Returns the type of charger connected.
614  * For USB it will not mean we can actually charge from it
615  * but that there is a USB cable connected that we have to
616  * identify. This is used during startup when we don't get
617  * interrupts of the charger detection
618  *
619  * Returns an integer value, that means,
620  * NO_PW_CONN  no power supply is connected
621  * AC_PW_CONN  if the AC power supply is connected
622  * USB_PW_CONN  if the USB power supply is connected
623  * AC_PW_CONN + USB_PW_CONN if USB and AC power supplies are both connected
624  */
625 static int ab8500_charger_detect_chargers(struct ab8500_charger *di, bool probe)
626 {
627 	int result = NO_PW_CONN;
628 	int ret;
629 	u8 val;
630 
631 	/* Check for AC charger */
632 	ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
633 		AB8500_CH_STATUS1_REG, &val);
634 	if (ret < 0) {
635 		dev_err(di->dev, "%s ab8500 read failed\n", __func__);
636 		return ret;
637 	}
638 
639 	if (val & MAIN_CH_DET)
640 		result = AC_PW_CONN;
641 
642 	/* Check for USB charger */
643 
644 	if (!probe) {
645 		/*
646 		 * AB8500 says VBUS_DET_DBNC1 & VBUS_DET_DBNC100
647 		 * when disconnecting ACA even though no
648 		 * charger was connected. Try waiting a little
649 		 * longer than the 100 ms of VBUS_DET_DBNC100...
650 		 */
651 		msleep(110);
652 	}
653 	ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
654 		AB8500_CH_USBCH_STAT1_REG, &val);
655 	if (ret < 0) {
656 		dev_err(di->dev, "%s ab8500 read failed\n", __func__);
657 		return ret;
658 	}
659 	dev_dbg(di->dev,
660 		"%s AB8500_CH_USBCH_STAT1_REG %x\n", __func__,
661 		val);
662 	if ((val & VBUS_DET_DBNC1) && (val & VBUS_DET_DBNC100))
663 		result |= USB_PW_CONN;
664 
665 	return result;
666 }
667 
668 /**
669  * ab8500_charger_max_usb_curr() - get the max curr for the USB type
670  * @di:			pointer to the ab8500_charger structure
671  * @link_status:	the identified USB type
672  *
673  * Get the maximum current that is allowed to be drawn from the host
674  * based on the USB type.
675  * Returns error code in case of failure else 0 on success
676  */
677 static int ab8500_charger_max_usb_curr(struct ab8500_charger *di,
678 		enum ab8500_charger_link_status link_status)
679 {
680 	int ret = 0;
681 
682 	di->usb_device_is_unrecognised = false;
683 
684 	/*
685 	 * Platform only supports USB 2.0.
686 	 * This means that charging current from USB source
687 	 * is maximum 500 mA. Every occurrence of USB_STAT_*_HOST_*
688 	 * should set USB_CH_IP_CUR_LVL_0P5.
689 	 */
690 
691 	switch (link_status) {
692 	case USB_STAT_STD_HOST_NC:
693 	case USB_STAT_STD_HOST_C_NS:
694 	case USB_STAT_STD_HOST_C_S:
695 		dev_dbg(di->dev, "USB Type - Standard host is "
696 			"detected through USB driver\n");
697 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
698 		di->is_aca_rid = 0;
699 		break;
700 	case USB_STAT_HOST_CHG_HS_CHIRP:
701 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
702 		di->is_aca_rid = 0;
703 		break;
704 	case USB_STAT_HOST_CHG_HS:
705 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
706 		di->is_aca_rid = 0;
707 		break;
708 	case USB_STAT_ACA_RID_C_HS:
709 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P9;
710 		di->is_aca_rid = 0;
711 		break;
712 	case USB_STAT_ACA_RID_A:
713 		/*
714 		 * Dedicated charger level minus maximum current accessory
715 		 * can consume (900mA). Closest level is 500mA
716 		 */
717 		dev_dbg(di->dev, "USB_STAT_ACA_RID_A detected\n");
718 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
719 		di->is_aca_rid = 1;
720 		break;
721 	case USB_STAT_ACA_RID_B:
722 		/*
723 		 * Dedicated charger level minus 120mA (20mA for ACA and
724 		 * 100mA for potential accessory). Closest level is 1300mA
725 		 */
726 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_1P3;
727 		dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d", link_status,
728 				di->max_usb_in_curr.usb_type_max);
729 		di->is_aca_rid = 1;
730 		break;
731 	case USB_STAT_HOST_CHG_NM:
732 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
733 		di->is_aca_rid = 0;
734 		break;
735 	case USB_STAT_DEDICATED_CHG:
736 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_1P5;
737 		di->is_aca_rid = 0;
738 		break;
739 	case USB_STAT_ACA_RID_C_HS_CHIRP:
740 	case USB_STAT_ACA_RID_C_NM:
741 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_1P5;
742 		di->is_aca_rid = 1;
743 		break;
744 	case USB_STAT_NOT_CONFIGURED:
745 		if (di->vbus_detected) {
746 			di->usb_device_is_unrecognised = true;
747 			dev_dbg(di->dev, "USB Type - Legacy charger.\n");
748 			di->max_usb_in_curr.usb_type_max =
749 						USB_CH_IP_CUR_LVL_1P5;
750 			break;
751 		}
752 		fallthrough;
753 	case USB_STAT_HM_IDGND:
754 		dev_err(di->dev, "USB Type - Charging not allowed\n");
755 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P05;
756 		ret = -ENXIO;
757 		break;
758 	case USB_STAT_RESERVED:
759 		if (is_ab8500(di->parent)) {
760 			di->flags.vbus_collapse = true;
761 			dev_err(di->dev, "USB Type - USB_STAT_RESERVED "
762 						"VBUS has collapsed\n");
763 			ret = -ENXIO;
764 			break;
765 		} else {
766 			dev_dbg(di->dev, "USB Type - Charging not allowed\n");
767 			di->max_usb_in_curr.usb_type_max =
768 						USB_CH_IP_CUR_LVL_0P05;
769 			dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d",
770 				link_status,
771 				di->max_usb_in_curr.usb_type_max);
772 			ret = -ENXIO;
773 			break;
774 		}
775 	case USB_STAT_CARKIT_1:
776 	case USB_STAT_CARKIT_2:
777 	case USB_STAT_ACA_DOCK_CHARGER:
778 	case USB_STAT_CHARGER_LINE_1:
779 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
780 		dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d", link_status,
781 				di->max_usb_in_curr.usb_type_max);
782 		break;
783 	case USB_STAT_NOT_VALID_LINK:
784 		dev_err(di->dev, "USB Type invalid - try charging anyway\n");
785 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
786 		break;
787 
788 	default:
789 		dev_err(di->dev, "USB Type - Unknown\n");
790 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P05;
791 		ret = -ENXIO;
792 		break;
793 	}
794 
795 	di->max_usb_in_curr.set_max = di->max_usb_in_curr.usb_type_max;
796 	dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d",
797 		link_status, di->max_usb_in_curr.set_max);
798 
799 	return ret;
800 }
801 
802 /**
803  * ab8500_charger_read_usb_type() - read the type of usb connected
804  * @di:		pointer to the ab8500_charger structure
805  *
806  * Detect the type of the plugged USB
807  * Returns error code in case of failure else 0 on success
808  */
809 static int ab8500_charger_read_usb_type(struct ab8500_charger *di)
810 {
811 	int ret;
812 	u8 val;
813 
814 	ret = abx500_get_register_interruptible(di->dev,
815 		AB8500_INTERRUPT, AB8500_IT_SOURCE21_REG, &val);
816 	if (ret < 0) {
817 		dev_err(di->dev, "%s ab8500 read failed\n", __func__);
818 		return ret;
819 	}
820 	if (is_ab8500(di->parent))
821 		ret = abx500_get_register_interruptible(di->dev, AB8500_USB,
822 			AB8500_USB_LINE_STAT_REG, &val);
823 	else
824 		ret = abx500_get_register_interruptible(di->dev,
825 			AB8500_USB, AB8500_USB_LINK1_STAT_REG, &val);
826 	if (ret < 0) {
827 		dev_err(di->dev, "%s ab8500 read failed\n", __func__);
828 		return ret;
829 	}
830 
831 	/* get the USB type */
832 	if (is_ab8500(di->parent))
833 		val = (val & AB8500_USB_LINK_STATUS) >> USB_LINK_STATUS_SHIFT;
834 	else
835 		val = (val & AB8505_USB_LINK_STATUS) >> USB_LINK_STATUS_SHIFT;
836 	ret = ab8500_charger_max_usb_curr(di,
837 		(enum ab8500_charger_link_status) val);
838 
839 	return ret;
840 }
841 
842 /**
843  * ab8500_charger_detect_usb_type() - get the type of usb connected
844  * @di:		pointer to the ab8500_charger structure
845  *
846  * Detect the type of the plugged USB
847  * Returns error code in case of failure else 0 on success
848  */
849 static int ab8500_charger_detect_usb_type(struct ab8500_charger *di)
850 {
851 	int i, ret;
852 	u8 val;
853 
854 	/*
855 	 * On getting the VBUS rising edge detect interrupt there
856 	 * is a 250ms delay after which the register UsbLineStatus
857 	 * is filled with valid data.
858 	 */
859 	for (i = 0; i < 10; i++) {
860 		msleep(250);
861 		ret = abx500_get_register_interruptible(di->dev,
862 			AB8500_INTERRUPT, AB8500_IT_SOURCE21_REG,
863 			&val);
864 		dev_dbg(di->dev, "%s AB8500_IT_SOURCE21_REG %x\n",
865 			__func__, val);
866 		if (ret < 0) {
867 			dev_err(di->dev, "%s ab8500 read failed\n", __func__);
868 			return ret;
869 		}
870 
871 		if (is_ab8500(di->parent))
872 			ret = abx500_get_register_interruptible(di->dev,
873 				AB8500_USB, AB8500_USB_LINE_STAT_REG, &val);
874 		else
875 			ret = abx500_get_register_interruptible(di->dev,
876 				AB8500_USB, AB8500_USB_LINK1_STAT_REG, &val);
877 		if (ret < 0) {
878 			dev_err(di->dev, "%s ab8500 read failed\n", __func__);
879 			return ret;
880 		}
881 		dev_dbg(di->dev, "%s AB8500_USB_LINE_STAT_REG %x\n", __func__,
882 			val);
883 		/*
884 		 * Until the IT source register is read the UsbLineStatus
885 		 * register is not updated, hence doing the same
886 		 * Revisit this:
887 		 */
888 
889 		/* get the USB type */
890 		if (is_ab8500(di->parent))
891 			val = (val & AB8500_USB_LINK_STATUS) >>
892 							USB_LINK_STATUS_SHIFT;
893 		else
894 			val = (val & AB8505_USB_LINK_STATUS) >>
895 							USB_LINK_STATUS_SHIFT;
896 		if (val)
897 			break;
898 	}
899 	ret = ab8500_charger_max_usb_curr(di,
900 		(enum ab8500_charger_link_status) val);
901 
902 	return ret;
903 }
904 
905 /*
906  * This array maps the raw hex value to charger voltage used by the AB8500
907  * Values taken from the UM0836
908  */
909 static int ab8500_charger_voltage_map[] = {
910 	3500 ,
911 	3525 ,
912 	3550 ,
913 	3575 ,
914 	3600 ,
915 	3625 ,
916 	3650 ,
917 	3675 ,
918 	3700 ,
919 	3725 ,
920 	3750 ,
921 	3775 ,
922 	3800 ,
923 	3825 ,
924 	3850 ,
925 	3875 ,
926 	3900 ,
927 	3925 ,
928 	3950 ,
929 	3975 ,
930 	4000 ,
931 	4025 ,
932 	4050 ,
933 	4060 ,
934 	4070 ,
935 	4080 ,
936 	4090 ,
937 	4100 ,
938 	4110 ,
939 	4120 ,
940 	4130 ,
941 	4140 ,
942 	4150 ,
943 	4160 ,
944 	4170 ,
945 	4180 ,
946 	4190 ,
947 	4200 ,
948 	4210 ,
949 	4220 ,
950 	4230 ,
951 	4240 ,
952 	4250 ,
953 	4260 ,
954 	4270 ,
955 	4280 ,
956 	4290 ,
957 	4300 ,
958 	4310 ,
959 	4320 ,
960 	4330 ,
961 	4340 ,
962 	4350 ,
963 	4360 ,
964 	4370 ,
965 	4380 ,
966 	4390 ,
967 	4400 ,
968 	4410 ,
969 	4420 ,
970 	4430 ,
971 	4440 ,
972 	4450 ,
973 	4460 ,
974 	4470 ,
975 	4480 ,
976 	4490 ,
977 	4500 ,
978 	4510 ,
979 	4520 ,
980 	4530 ,
981 	4540 ,
982 	4550 ,
983 	4560 ,
984 	4570 ,
985 	4580 ,
986 	4590 ,
987 	4600 ,
988 };
989 
990 static int ab8500_voltage_to_regval(int voltage)
991 {
992 	int i;
993 
994 	/* Special case for voltage below 3.5V */
995 	if (voltage < ab8500_charger_voltage_map[0])
996 		return LOW_VOLT_REG;
997 
998 	for (i = 1; i < ARRAY_SIZE(ab8500_charger_voltage_map); i++) {
999 		if (voltage < ab8500_charger_voltage_map[i])
1000 			return i - 1;
1001 	}
1002 
1003 	/* If not last element, return error */
1004 	i = ARRAY_SIZE(ab8500_charger_voltage_map) - 1;
1005 	if (voltage == ab8500_charger_voltage_map[i])
1006 		return i;
1007 	else
1008 		return -1;
1009 }
1010 
1011 static int ab8500_current_to_regval(struct ab8500_charger *di, int curr)
1012 {
1013 	int i;
1014 
1015 	if (curr < di->bm->chg_output_curr[0])
1016 		return 0;
1017 
1018 	for (i = 0; i < di->bm->n_chg_out_curr; i++) {
1019 		if (curr < di->bm->chg_output_curr[i])
1020 			return i - 1;
1021 	}
1022 
1023 	/* If not last element, return error */
1024 	i = di->bm->n_chg_out_curr - 1;
1025 	if (curr == di->bm->chg_output_curr[i])
1026 		return i;
1027 	else
1028 		return -1;
1029 }
1030 
1031 static int ab8500_vbus_in_curr_to_regval(struct ab8500_charger *di, int curr)
1032 {
1033 	int i;
1034 
1035 	if (curr < di->bm->chg_input_curr[0])
1036 		return 0;
1037 
1038 	for (i = 0; i < di->bm->n_chg_in_curr; i++) {
1039 		if (curr < di->bm->chg_input_curr[i])
1040 			return i - 1;
1041 	}
1042 
1043 	/* If not last element, return error */
1044 	i = di->bm->n_chg_in_curr - 1;
1045 	if (curr == di->bm->chg_input_curr[i])
1046 		return i;
1047 	else
1048 		return -1;
1049 }
1050 
1051 /**
1052  * ab8500_charger_get_usb_cur() - get usb current
1053  * @di:		pointer to the ab8500_charger structre
1054  *
1055  * The usb stack provides the maximum current that can be drawn from
1056  * the standard usb host. This will be in mA.
1057  * This function converts current in mA to a value that can be written
1058  * to the register. Returns -1 if charging is not allowed
1059  */
1060 static int ab8500_charger_get_usb_cur(struct ab8500_charger *di)
1061 {
1062 	int ret = 0;
1063 	switch (di->usb_state.usb_current) {
1064 	case 100:
1065 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P09;
1066 		break;
1067 	case 200:
1068 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P19;
1069 		break;
1070 	case 300:
1071 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P29;
1072 		break;
1073 	case 400:
1074 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P38;
1075 		break;
1076 	case 500:
1077 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
1078 		break;
1079 	default:
1080 		di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P05;
1081 		ret = -EPERM;
1082 		break;
1083 	}
1084 	di->max_usb_in_curr.set_max = di->max_usb_in_curr.usb_type_max;
1085 	return ret;
1086 }
1087 
1088 /**
1089  * ab8500_charger_check_continue_stepping() - Check to allow stepping
1090  * @di:		pointer to the ab8500_charger structure
1091  * @reg:	select what charger register to check
1092  *
1093  * Check if current stepping should be allowed to continue.
1094  * Checks if charger source has not collapsed. If it has, further stepping
1095  * is not allowed.
1096  */
1097 static bool ab8500_charger_check_continue_stepping(struct ab8500_charger *di,
1098 						   int reg)
1099 {
1100 	if (reg == AB8500_USBCH_IPT_CRNTLVL_REG)
1101 		return !di->flags.vbus_drop_end;
1102 	else
1103 		return true;
1104 }
1105 
1106 /**
1107  * ab8500_charger_set_current() - set charger current
1108  * @di:		pointer to the ab8500_charger structure
1109  * @ich:	charger current, in mA
1110  * @reg:	select what charger register to set
1111  *
1112  * Set charger current.
1113  * There is no state machine in the AB to step up/down the charger
1114  * current to avoid dips and spikes on MAIN, VBUS and VBAT when
1115  * charging is started. Instead we need to implement
1116  * this charger current step-up/down here.
1117  * Returns error code in case of failure else 0(on success)
1118  */
1119 static int ab8500_charger_set_current(struct ab8500_charger *di,
1120 	int ich, int reg)
1121 {
1122 	int ret = 0;
1123 	int curr_index, prev_curr_index, shift_value, i;
1124 	u8 reg_value;
1125 	u32 step_udelay;
1126 	bool no_stepping = false;
1127 
1128 	atomic_inc(&di->current_stepping_sessions);
1129 
1130 	ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
1131 		reg, &reg_value);
1132 	if (ret < 0) {
1133 		dev_err(di->dev, "%s read failed\n", __func__);
1134 		goto exit_set_current;
1135 	}
1136 
1137 	switch (reg) {
1138 	case AB8500_MCH_IPT_CURLVL_REG:
1139 		shift_value = MAIN_CH_INPUT_CURR_SHIFT;
1140 		prev_curr_index = (reg_value >> shift_value);
1141 		curr_index = ab8500_current_to_regval(di, ich);
1142 		step_udelay = STEP_UDELAY;
1143 		if (!di->ac.charger_connected)
1144 			no_stepping = true;
1145 		break;
1146 	case AB8500_USBCH_IPT_CRNTLVL_REG:
1147 		shift_value = VBUS_IN_CURR_LIM_SHIFT;
1148 		prev_curr_index = (reg_value >> shift_value);
1149 		curr_index = ab8500_vbus_in_curr_to_regval(di, ich);
1150 		step_udelay = STEP_UDELAY * 100;
1151 
1152 		if (!di->usb.charger_connected)
1153 			no_stepping = true;
1154 		break;
1155 	case AB8500_CH_OPT_CRNTLVL_REG:
1156 		shift_value = 0;
1157 		prev_curr_index = (reg_value >> shift_value);
1158 		curr_index = ab8500_current_to_regval(di, ich);
1159 		step_udelay = STEP_UDELAY;
1160 		if (curr_index && (curr_index - prev_curr_index) > 1)
1161 			step_udelay *= 100;
1162 
1163 		if (!di->usb.charger_connected && !di->ac.charger_connected)
1164 			no_stepping = true;
1165 
1166 		break;
1167 	default:
1168 		dev_err(di->dev, "%s current register not valid\n", __func__);
1169 		ret = -ENXIO;
1170 		goto exit_set_current;
1171 	}
1172 
1173 	if (curr_index < 0) {
1174 		dev_err(di->dev, "requested current limit out-of-range\n");
1175 		ret = -ENXIO;
1176 		goto exit_set_current;
1177 	}
1178 
1179 	/* only update current if it's been changed */
1180 	if (prev_curr_index == curr_index) {
1181 		dev_dbg(di->dev, "%s current not changed for reg: 0x%02x\n",
1182 			__func__, reg);
1183 		ret = 0;
1184 		goto exit_set_current;
1185 	}
1186 
1187 	dev_dbg(di->dev, "%s set charger current: %d mA for reg: 0x%02x\n",
1188 		__func__, ich, reg);
1189 
1190 	if (no_stepping) {
1191 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1192 					reg, (u8)curr_index << shift_value);
1193 		if (ret)
1194 			dev_err(di->dev, "%s write failed\n", __func__);
1195 	} else if (prev_curr_index > curr_index) {
1196 		for (i = prev_curr_index - 1; i >= curr_index; i--) {
1197 			dev_dbg(di->dev, "curr change_1 to: %x for 0x%02x\n",
1198 				(u8) i << shift_value, reg);
1199 			ret = abx500_set_register_interruptible(di->dev,
1200 				AB8500_CHARGER, reg, (u8)i << shift_value);
1201 			if (ret) {
1202 				dev_err(di->dev, "%s write failed\n", __func__);
1203 				goto exit_set_current;
1204 			}
1205 			if (i != curr_index)
1206 				usleep_range(step_udelay, step_udelay * 2);
1207 		}
1208 	} else {
1209 		bool allow = true;
1210 		for (i = prev_curr_index + 1; i <= curr_index && allow; i++) {
1211 			dev_dbg(di->dev, "curr change_2 to: %x for 0x%02x\n",
1212 				(u8)i << shift_value, reg);
1213 			ret = abx500_set_register_interruptible(di->dev,
1214 				AB8500_CHARGER, reg, (u8)i << shift_value);
1215 			if (ret) {
1216 				dev_err(di->dev, "%s write failed\n", __func__);
1217 				goto exit_set_current;
1218 			}
1219 			if (i != curr_index)
1220 				usleep_range(step_udelay, step_udelay * 2);
1221 
1222 			allow = ab8500_charger_check_continue_stepping(di, reg);
1223 		}
1224 	}
1225 
1226 exit_set_current:
1227 	atomic_dec(&di->current_stepping_sessions);
1228 
1229 	return ret;
1230 }
1231 
1232 /**
1233  * ab8500_charger_set_vbus_in_curr() - set VBUS input current limit
1234  * @di:		pointer to the ab8500_charger structure
1235  * @ich_in:	charger input current limit
1236  *
1237  * Sets the current that can be drawn from the USB host
1238  * Returns error code in case of failure else 0(on success)
1239  */
1240 static int ab8500_charger_set_vbus_in_curr(struct ab8500_charger *di,
1241 		int ich_in)
1242 {
1243 	int min_value;
1244 	int ret;
1245 
1246 	/* We should always use to lowest current limit */
1247 	min_value = min(di->bm->chg_params->usb_curr_max, ich_in);
1248 	if (di->max_usb_in_curr.set_max > 0)
1249 		min_value = min(di->max_usb_in_curr.set_max, min_value);
1250 
1251 	if (di->usb_state.usb_current >= 0)
1252 		min_value = min(di->usb_state.usb_current, min_value);
1253 
1254 	switch (min_value) {
1255 	case 100:
1256 		if (di->vbat < VBAT_TRESH_IP_CUR_RED)
1257 			min_value = USB_CH_IP_CUR_LVL_0P05;
1258 		break;
1259 	case 500:
1260 		if (di->vbat < VBAT_TRESH_IP_CUR_RED)
1261 			min_value = USB_CH_IP_CUR_LVL_0P45;
1262 		break;
1263 	default:
1264 		break;
1265 	}
1266 
1267 	dev_info(di->dev, "VBUS input current limit set to %d mA\n", min_value);
1268 
1269 	mutex_lock(&di->usb_ipt_crnt_lock);
1270 	ret = ab8500_charger_set_current(di, min_value,
1271 		AB8500_USBCH_IPT_CRNTLVL_REG);
1272 	mutex_unlock(&di->usb_ipt_crnt_lock);
1273 
1274 	return ret;
1275 }
1276 
1277 /**
1278  * ab8500_charger_set_main_in_curr() - set main charger input current
1279  * @di:		pointer to the ab8500_charger structure
1280  * @ich_in:	input charger current, in mA
1281  *
1282  * Set main charger input current.
1283  * Returns error code in case of failure else 0(on success)
1284  */
1285 static int ab8500_charger_set_main_in_curr(struct ab8500_charger *di,
1286 	int ich_in)
1287 {
1288 	return ab8500_charger_set_current(di, ich_in,
1289 		AB8500_MCH_IPT_CURLVL_REG);
1290 }
1291 
1292 /**
1293  * ab8500_charger_set_output_curr() - set charger output current
1294  * @di:		pointer to the ab8500_charger structure
1295  * @ich_out:	output charger current, in mA
1296  *
1297  * Set charger output current.
1298  * Returns error code in case of failure else 0(on success)
1299  */
1300 static int ab8500_charger_set_output_curr(struct ab8500_charger *di,
1301 	int ich_out)
1302 {
1303 	return ab8500_charger_set_current(di, ich_out,
1304 		AB8500_CH_OPT_CRNTLVL_REG);
1305 }
1306 
1307 /**
1308  * ab8500_charger_led_en() - turn on/off chargign led
1309  * @di:		pointer to the ab8500_charger structure
1310  * @on:		flag to turn on/off the chargign led
1311  *
1312  * Power ON/OFF charging LED indication
1313  * Returns error code in case of failure else 0(on success)
1314  */
1315 static int ab8500_charger_led_en(struct ab8500_charger *di, int on)
1316 {
1317 	int ret;
1318 
1319 	if (on) {
1320 		/* Power ON charging LED indicator, set LED current to 5mA */
1321 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1322 			AB8500_LED_INDICATOR_PWM_CTRL,
1323 			(LED_IND_CUR_5MA | LED_INDICATOR_PWM_ENA));
1324 		if (ret) {
1325 			dev_err(di->dev, "Power ON LED failed\n");
1326 			return ret;
1327 		}
1328 		/* LED indicator PWM duty cycle 252/256 */
1329 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1330 			AB8500_LED_INDICATOR_PWM_DUTY,
1331 			LED_INDICATOR_PWM_DUTY_252_256);
1332 		if (ret) {
1333 			dev_err(di->dev, "Set LED PWM duty cycle failed\n");
1334 			return ret;
1335 		}
1336 	} else {
1337 		/* Power off charging LED indicator */
1338 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1339 			AB8500_LED_INDICATOR_PWM_CTRL,
1340 			LED_INDICATOR_PWM_DIS);
1341 		if (ret) {
1342 			dev_err(di->dev, "Power-off LED failed\n");
1343 			return ret;
1344 		}
1345 	}
1346 
1347 	return ret;
1348 }
1349 
1350 /**
1351  * ab8500_charger_ac_en() - enable or disable ac charging
1352  * @di:		pointer to the ab8500_charger structure
1353  * @enable:	enable/disable flag
1354  * @vset:	charging voltage
1355  * @iset:	charging current
1356  *
1357  * Enable/Disable AC/Mains charging and turns on/off the charging led
1358  * respectively.
1359  **/
1360 static int ab8500_charger_ac_en(struct ux500_charger *charger,
1361 	int enable, int vset, int iset)
1362 {
1363 	int ret;
1364 	int volt_index;
1365 	int curr_index;
1366 	int input_curr_index;
1367 	u8 overshoot = 0;
1368 
1369 	struct ab8500_charger *di = to_ab8500_charger_ac_device_info(charger);
1370 
1371 	if (enable) {
1372 		/* Check if AC is connected */
1373 		if (!di->ac.charger_connected) {
1374 			dev_err(di->dev, "AC charger not connected\n");
1375 			return -ENXIO;
1376 		}
1377 
1378 		/* Enable AC charging */
1379 		dev_dbg(di->dev, "Enable AC: %dmV %dmA\n", vset, iset);
1380 
1381 		/*
1382 		 * Due to a bug in AB8500, BTEMP_HIGH/LOW interrupts
1383 		 * will be triggered every time we enable the VDD ADC supply.
1384 		 * This will turn off charging for a short while.
1385 		 * It can be avoided by having the supply on when
1386 		 * there is a charger enabled. Normally the VDD ADC supply
1387 		 * is enabled every time a GPADC conversion is triggered.
1388 		 * We will force it to be enabled from this driver to have
1389 		 * the GPADC module independent of the AB8500 chargers
1390 		 */
1391 		if (!di->vddadc_en_ac) {
1392 			ret = regulator_enable(di->regu);
1393 			if (ret)
1394 				dev_warn(di->dev,
1395 					"Failed to enable regulator\n");
1396 			else
1397 				di->vddadc_en_ac = true;
1398 		}
1399 
1400 		/* Check if the requested voltage or current is valid */
1401 		volt_index = ab8500_voltage_to_regval(vset);
1402 		curr_index = ab8500_current_to_regval(di, iset);
1403 		input_curr_index = ab8500_current_to_regval(di,
1404 			di->bm->chg_params->ac_curr_max);
1405 		if (volt_index < 0 || curr_index < 0 || input_curr_index < 0) {
1406 			dev_err(di->dev,
1407 				"Charger voltage or current too high, "
1408 				"charging not started\n");
1409 			return -ENXIO;
1410 		}
1411 
1412 		/* ChVoltLevel: maximum battery charging voltage */
1413 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1414 			AB8500_CH_VOLT_LVL_REG, (u8) volt_index);
1415 		if (ret) {
1416 			dev_err(di->dev, "%s write failed\n", __func__);
1417 			return ret;
1418 		}
1419 		/* MainChInputCurr: current that can be drawn from the charger*/
1420 		ret = ab8500_charger_set_main_in_curr(di,
1421 			di->bm->chg_params->ac_curr_max);
1422 		if (ret) {
1423 			dev_err(di->dev, "%s Failed to set MainChInputCurr\n",
1424 				__func__);
1425 			return ret;
1426 		}
1427 		/* ChOutputCurentLevel: protected output current */
1428 		ret = ab8500_charger_set_output_curr(di, iset);
1429 		if (ret) {
1430 			dev_err(di->dev, "%s "
1431 				"Failed to set ChOutputCurentLevel\n",
1432 				__func__);
1433 			return ret;
1434 		}
1435 
1436 		/* Check if VBAT overshoot control should be enabled */
1437 		if (!di->bm->enable_overshoot)
1438 			overshoot = MAIN_CH_NO_OVERSHOOT_ENA_N;
1439 
1440 		/* Enable Main Charger */
1441 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1442 			AB8500_MCH_CTRL1, MAIN_CH_ENA | overshoot);
1443 		if (ret) {
1444 			dev_err(di->dev, "%s write failed\n", __func__);
1445 			return ret;
1446 		}
1447 
1448 		/* Power on charging LED indication */
1449 		ret = ab8500_charger_led_en(di, true);
1450 		if (ret < 0)
1451 			dev_err(di->dev, "failed to enable LED\n");
1452 
1453 		di->ac.charger_online = 1;
1454 	} else {
1455 		/* Disable AC charging */
1456 		if (is_ab8500_1p1_or_earlier(di->parent)) {
1457 			/*
1458 			 * For ABB revision 1.0 and 1.1 there is a bug in the
1459 			 * watchdog logic. That means we have to continuously
1460 			 * kick the charger watchdog even when no charger is
1461 			 * connected. This is only valid once the AC charger
1462 			 * has been enabled. This is a bug that is not handled
1463 			 * by the algorithm and the watchdog have to be kicked
1464 			 * by the charger driver when the AC charger
1465 			 * is disabled
1466 			 */
1467 			if (di->ac_conn) {
1468 				queue_delayed_work(di->charger_wq,
1469 					&di->kick_wd_work,
1470 					round_jiffies(WD_KICK_INTERVAL));
1471 			}
1472 
1473 			/*
1474 			 * We can't turn off charging completely
1475 			 * due to a bug in AB8500 cut1.
1476 			 * If we do, charging will not start again.
1477 			 * That is why we set the lowest voltage
1478 			 * and current possible
1479 			 */
1480 			ret = abx500_set_register_interruptible(di->dev,
1481 				AB8500_CHARGER,
1482 				AB8500_CH_VOLT_LVL_REG, CH_VOL_LVL_3P5);
1483 			if (ret) {
1484 				dev_err(di->dev,
1485 					"%s write failed\n", __func__);
1486 				return ret;
1487 			}
1488 
1489 			ret = ab8500_charger_set_output_curr(di, 0);
1490 			if (ret) {
1491 				dev_err(di->dev, "%s "
1492 					"Failed to set ChOutputCurentLevel\n",
1493 					__func__);
1494 				return ret;
1495 			}
1496 		} else {
1497 			ret = abx500_set_register_interruptible(di->dev,
1498 				AB8500_CHARGER,
1499 				AB8500_MCH_CTRL1, 0);
1500 			if (ret) {
1501 				dev_err(di->dev,
1502 					"%s write failed\n", __func__);
1503 				return ret;
1504 			}
1505 		}
1506 
1507 		ret = ab8500_charger_led_en(di, false);
1508 		if (ret < 0)
1509 			dev_err(di->dev, "failed to disable LED\n");
1510 
1511 		di->ac.charger_online = 0;
1512 		di->ac.wd_expired = false;
1513 
1514 		/* Disable regulator if enabled */
1515 		if (di->vddadc_en_ac) {
1516 			regulator_disable(di->regu);
1517 			di->vddadc_en_ac = false;
1518 		}
1519 
1520 		dev_dbg(di->dev, "%s Disabled AC charging\n", __func__);
1521 	}
1522 	ab8500_power_supply_changed(di, di->ac_chg.psy);
1523 
1524 	return ret;
1525 }
1526 
1527 /**
1528  * ab8500_charger_usb_en() - enable usb charging
1529  * @di:		pointer to the ab8500_charger structure
1530  * @enable:	enable/disable flag
1531  * @vset:	charging voltage
1532  * @ich_out:	charger output current
1533  *
1534  * Enable/Disable USB charging and turns on/off the charging led respectively.
1535  * Returns error code in case of failure else 0(on success)
1536  */
1537 static int ab8500_charger_usb_en(struct ux500_charger *charger,
1538 	int enable, int vset, int ich_out)
1539 {
1540 	int ret;
1541 	int volt_index;
1542 	int curr_index;
1543 	u8 overshoot = 0;
1544 
1545 	struct ab8500_charger *di = to_ab8500_charger_usb_device_info(charger);
1546 
1547 	if (enable) {
1548 		/* Check if USB is connected */
1549 		if (!di->usb.charger_connected) {
1550 			dev_err(di->dev, "USB charger not connected\n");
1551 			return -ENXIO;
1552 		}
1553 
1554 		/*
1555 		 * Due to a bug in AB8500, BTEMP_HIGH/LOW interrupts
1556 		 * will be triggered every time we enable the VDD ADC supply.
1557 		 * This will turn off charging for a short while.
1558 		 * It can be avoided by having the supply on when
1559 		 * there is a charger enabled. Normally the VDD ADC supply
1560 		 * is enabled every time a GPADC conversion is triggered.
1561 		 * We will force it to be enabled from this driver to have
1562 		 * the GPADC module independent of the AB8500 chargers
1563 		 */
1564 		if (!di->vddadc_en_usb) {
1565 			ret = regulator_enable(di->regu);
1566 			if (ret)
1567 				dev_warn(di->dev,
1568 					"Failed to enable regulator\n");
1569 			else
1570 				di->vddadc_en_usb = true;
1571 		}
1572 
1573 		/* Enable USB charging */
1574 		dev_dbg(di->dev, "Enable USB: %dmV %dmA\n", vset, ich_out);
1575 
1576 		/* Check if the requested voltage or current is valid */
1577 		volt_index = ab8500_voltage_to_regval(vset);
1578 		curr_index = ab8500_current_to_regval(di, ich_out);
1579 		if (volt_index < 0 || curr_index < 0) {
1580 			dev_err(di->dev,
1581 				"Charger voltage or current too high, "
1582 				"charging not started\n");
1583 			return -ENXIO;
1584 		}
1585 
1586 		/*
1587 		 * ChVoltLevel: max voltage up to which battery can be
1588 		 * charged
1589 		 */
1590 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1591 			AB8500_CH_VOLT_LVL_REG, (u8) volt_index);
1592 		if (ret) {
1593 			dev_err(di->dev, "%s write failed\n", __func__);
1594 			return ret;
1595 		}
1596 		/* Check if VBAT overshoot control should be enabled */
1597 		if (!di->bm->enable_overshoot)
1598 			overshoot = USB_CHG_NO_OVERSHOOT_ENA_N;
1599 
1600 		/* Enable USB Charger */
1601 		dev_dbg(di->dev,
1602 			"Enabling USB with write to AB8500_USBCH_CTRL1_REG\n");
1603 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1604 			AB8500_USBCH_CTRL1_REG, USB_CH_ENA | overshoot);
1605 		if (ret) {
1606 			dev_err(di->dev, "%s write failed\n", __func__);
1607 			return ret;
1608 		}
1609 
1610 		/* If success power on charging LED indication */
1611 		ret = ab8500_charger_led_en(di, true);
1612 		if (ret < 0)
1613 			dev_err(di->dev, "failed to enable LED\n");
1614 
1615 		di->usb.charger_online = 1;
1616 
1617 		/* USBChInputCurr: current that can be drawn from the usb */
1618 		ret = ab8500_charger_set_vbus_in_curr(di,
1619 					di->max_usb_in_curr.usb_type_max);
1620 		if (ret) {
1621 			dev_err(di->dev, "setting USBChInputCurr failed\n");
1622 			return ret;
1623 		}
1624 
1625 		/* ChOutputCurentLevel: protected output current */
1626 		ret = ab8500_charger_set_output_curr(di, ich_out);
1627 		if (ret) {
1628 			dev_err(di->dev, "%s "
1629 				"Failed to set ChOutputCurentLevel\n",
1630 				__func__);
1631 			return ret;
1632 		}
1633 
1634 		queue_delayed_work(di->charger_wq, &di->check_vbat_work, HZ);
1635 
1636 	} else {
1637 		/* Disable USB charging */
1638 		dev_dbg(di->dev, "%s Disabled USB charging\n", __func__);
1639 		ret = abx500_set_register_interruptible(di->dev,
1640 			AB8500_CHARGER,
1641 			AB8500_USBCH_CTRL1_REG, 0);
1642 		if (ret) {
1643 			dev_err(di->dev,
1644 				"%s write failed\n", __func__);
1645 			return ret;
1646 		}
1647 
1648 		ret = ab8500_charger_led_en(di, false);
1649 		if (ret < 0)
1650 			dev_err(di->dev, "failed to disable LED\n");
1651 		/* USBChInputCurr: current that can be drawn from the usb */
1652 		ret = ab8500_charger_set_vbus_in_curr(di, 0);
1653 		if (ret) {
1654 			dev_err(di->dev, "setting USBChInputCurr failed\n");
1655 			return ret;
1656 		}
1657 
1658 		/* ChOutputCurentLevel: protected output current */
1659 		ret = ab8500_charger_set_output_curr(di, 0);
1660 		if (ret) {
1661 			dev_err(di->dev, "%s "
1662 				"Failed to reset ChOutputCurentLevel\n",
1663 				__func__);
1664 			return ret;
1665 		}
1666 		di->usb.charger_online = 0;
1667 		di->usb.wd_expired = false;
1668 
1669 		/* Disable regulator if enabled */
1670 		if (di->vddadc_en_usb) {
1671 			regulator_disable(di->regu);
1672 			di->vddadc_en_usb = false;
1673 		}
1674 
1675 		dev_dbg(di->dev, "%s Disabled USB charging\n", __func__);
1676 
1677 		/* Cancel any pending Vbat check work */
1678 		cancel_delayed_work(&di->check_vbat_work);
1679 
1680 	}
1681 	ab8500_power_supply_changed(di, di->usb_chg.psy);
1682 
1683 	return ret;
1684 }
1685 
1686 static int ab8500_external_charger_prepare(struct notifier_block *charger_nb,
1687 				unsigned long event, void *data)
1688 {
1689 	int ret;
1690 	struct device *dev = data;
1691 	/*Toggle External charger control pin*/
1692 	ret = abx500_set_register_interruptible(dev, AB8500_SYS_CTRL1_BLOCK,
1693 				  AB8500_SYS_CHARGER_CONTROL_REG,
1694 				  EXTERNAL_CHARGER_DISABLE_REG_VAL);
1695 	if (ret < 0) {
1696 		dev_err(dev, "write reg failed %d\n", ret);
1697 		goto out;
1698 	}
1699 	ret = abx500_set_register_interruptible(dev, AB8500_SYS_CTRL1_BLOCK,
1700 				  AB8500_SYS_CHARGER_CONTROL_REG,
1701 				  EXTERNAL_CHARGER_ENABLE_REG_VAL);
1702 	if (ret < 0)
1703 		dev_err(dev, "Write reg failed %d\n", ret);
1704 
1705 out:
1706 	return ret;
1707 }
1708 
1709 /**
1710  * ab8500_charger_usb_check_enable() - enable usb charging
1711  * @charger:	pointer to the ux500_charger structure
1712  * @vset:	charging voltage
1713  * @iset:	charger output current
1714  *
1715  * Check if the VBUS charger has been disconnected and reconnected without
1716  * AB8500 rising an interrupt. Returns 0 on success.
1717  */
1718 static int ab8500_charger_usb_check_enable(struct ux500_charger *charger,
1719 	int vset, int iset)
1720 {
1721 	u8 usbch_ctrl1 = 0;
1722 	int ret = 0;
1723 
1724 	struct ab8500_charger *di = to_ab8500_charger_usb_device_info(charger);
1725 
1726 	if (!di->usb.charger_connected)
1727 		return ret;
1728 
1729 	ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
1730 				AB8500_USBCH_CTRL1_REG, &usbch_ctrl1);
1731 	if (ret < 0) {
1732 		dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
1733 		return ret;
1734 	}
1735 	dev_dbg(di->dev, "USB charger ctrl: 0x%02x\n", usbch_ctrl1);
1736 
1737 	if (!(usbch_ctrl1 & USB_CH_ENA)) {
1738 		dev_info(di->dev, "Charging has been disabled abnormally and will be re-enabled\n");
1739 
1740 		ret = abx500_mask_and_set_register_interruptible(di->dev,
1741 					AB8500_CHARGER, AB8500_CHARGER_CTRL,
1742 					DROP_COUNT_RESET, DROP_COUNT_RESET);
1743 		if (ret < 0) {
1744 			dev_err(di->dev, "ab8500 write failed %d\n", __LINE__);
1745 			return ret;
1746 		}
1747 
1748 		ret = ab8500_charger_usb_en(&di->usb_chg, true, vset, iset);
1749 		if (ret < 0) {
1750 			dev_err(di->dev, "Failed to enable VBUS charger %d\n",
1751 					__LINE__);
1752 			return ret;
1753 		}
1754 	}
1755 	return ret;
1756 }
1757 
1758 /**
1759  * ab8500_charger_ac_check_enable() - enable usb charging
1760  * @charger:	pointer to the ux500_charger structure
1761  * @vset:	charging voltage
1762  * @iset:	charger output current
1763  *
1764  * Check if the AC charger has been disconnected and reconnected without
1765  * AB8500 rising an interrupt. Returns 0 on success.
1766  */
1767 static int ab8500_charger_ac_check_enable(struct ux500_charger *charger,
1768 	int vset, int iset)
1769 {
1770 	u8 mainch_ctrl1 = 0;
1771 	int ret = 0;
1772 
1773 	struct ab8500_charger *di = to_ab8500_charger_ac_device_info(charger);
1774 
1775 	if (!di->ac.charger_connected)
1776 		return ret;
1777 
1778 	ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
1779 				AB8500_MCH_CTRL1, &mainch_ctrl1);
1780 	if (ret < 0) {
1781 		dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
1782 		return ret;
1783 	}
1784 	dev_dbg(di->dev, "AC charger ctrl: 0x%02x\n", mainch_ctrl1);
1785 
1786 	if (!(mainch_ctrl1 & MAIN_CH_ENA)) {
1787 		dev_info(di->dev, "Charging has been disabled abnormally and will be re-enabled\n");
1788 
1789 		ret = abx500_mask_and_set_register_interruptible(di->dev,
1790 					AB8500_CHARGER, AB8500_CHARGER_CTRL,
1791 					DROP_COUNT_RESET, DROP_COUNT_RESET);
1792 
1793 		if (ret < 0) {
1794 			dev_err(di->dev, "ab8500 write failed %d\n", __LINE__);
1795 			return ret;
1796 		}
1797 
1798 		ret = ab8500_charger_ac_en(&di->usb_chg, true, vset, iset);
1799 		if (ret < 0) {
1800 			dev_err(di->dev, "failed to enable AC charger %d\n",
1801 				__LINE__);
1802 			return ret;
1803 		}
1804 	}
1805 	return ret;
1806 }
1807 
1808 /**
1809  * ab8500_charger_watchdog_kick() - kick charger watchdog
1810  * @di:		pointer to the ab8500_charger structure
1811  *
1812  * Kick charger watchdog
1813  * Returns error code in case of failure else 0(on success)
1814  */
1815 static int ab8500_charger_watchdog_kick(struct ux500_charger *charger)
1816 {
1817 	int ret;
1818 	struct ab8500_charger *di;
1819 
1820 	if (charger->psy->desc->type == POWER_SUPPLY_TYPE_MAINS)
1821 		di = to_ab8500_charger_ac_device_info(charger);
1822 	else if (charger->psy->desc->type == POWER_SUPPLY_TYPE_USB)
1823 		di = to_ab8500_charger_usb_device_info(charger);
1824 	else
1825 		return -ENXIO;
1826 
1827 	ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1828 		AB8500_CHARG_WD_CTRL, CHARG_WD_KICK);
1829 	if (ret)
1830 		dev_err(di->dev, "Failed to kick WD!\n");
1831 
1832 	return ret;
1833 }
1834 
1835 /**
1836  * ab8500_charger_update_charger_current() - update charger current
1837  * @di:		pointer to the ab8500_charger structure
1838  *
1839  * Update the charger output current for the specified charger
1840  * Returns error code in case of failure else 0(on success)
1841  */
1842 static int ab8500_charger_update_charger_current(struct ux500_charger *charger,
1843 		int ich_out)
1844 {
1845 	int ret;
1846 	struct ab8500_charger *di;
1847 
1848 	if (charger->psy->desc->type == POWER_SUPPLY_TYPE_MAINS)
1849 		di = to_ab8500_charger_ac_device_info(charger);
1850 	else if (charger->psy->desc->type == POWER_SUPPLY_TYPE_USB)
1851 		di = to_ab8500_charger_usb_device_info(charger);
1852 	else
1853 		return -ENXIO;
1854 
1855 	ret = ab8500_charger_set_output_curr(di, ich_out);
1856 	if (ret) {
1857 		dev_err(di->dev, "%s "
1858 			"Failed to set ChOutputCurentLevel\n",
1859 			__func__);
1860 		return ret;
1861 	}
1862 
1863 	/* Reset the main and usb drop input current measurement counter */
1864 	ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1865 				AB8500_CHARGER_CTRL, DROP_COUNT_RESET);
1866 	if (ret) {
1867 		dev_err(di->dev, "%s write failed\n", __func__);
1868 		return ret;
1869 	}
1870 
1871 	return ret;
1872 }
1873 
1874 static int ab8500_charger_get_ext_psy_data(struct device *dev, void *data)
1875 {
1876 	struct power_supply *psy;
1877 	struct power_supply *ext = dev_get_drvdata(dev);
1878 	const char **supplicants = (const char **)ext->supplied_to;
1879 	struct ab8500_charger *di;
1880 	union power_supply_propval ret;
1881 	int j;
1882 	struct ux500_charger *usb_chg;
1883 
1884 	usb_chg = (struct ux500_charger *)data;
1885 	psy = usb_chg->psy;
1886 
1887 	di = to_ab8500_charger_usb_device_info(usb_chg);
1888 
1889 	/* For all psy where the driver name appears in any supplied_to */
1890 	j = match_string(supplicants, ext->num_supplicants, psy->desc->name);
1891 	if (j < 0)
1892 		return 0;
1893 
1894 	/* Go through all properties for the psy */
1895 	for (j = 0; j < ext->desc->num_properties; j++) {
1896 		enum power_supply_property prop;
1897 		prop = ext->desc->properties[j];
1898 
1899 		if (power_supply_get_property(ext, prop, &ret))
1900 			continue;
1901 
1902 		switch (prop) {
1903 		case POWER_SUPPLY_PROP_VOLTAGE_NOW:
1904 			switch (ext->desc->type) {
1905 			case POWER_SUPPLY_TYPE_BATTERY:
1906 				di->vbat = ret.intval / 1000;
1907 				break;
1908 			default:
1909 				break;
1910 			}
1911 			break;
1912 		default:
1913 			break;
1914 		}
1915 	}
1916 	return 0;
1917 }
1918 
1919 /**
1920  * ab8500_charger_check_vbat_work() - keep vbus current within spec
1921  * @work	pointer to the work_struct structure
1922  *
1923  * Due to a asic bug it is necessary to lower the input current to the vbus
1924  * charger when charging with at some specific levels. This issue is only valid
1925  * for below a certain battery voltage. This function makes sure that the
1926  * the allowed current limit isn't exceeded.
1927  */
1928 static void ab8500_charger_check_vbat_work(struct work_struct *work)
1929 {
1930 	int t = 10;
1931 	struct ab8500_charger *di = container_of(work,
1932 		struct ab8500_charger, check_vbat_work.work);
1933 
1934 	class_for_each_device(power_supply_class, NULL,
1935 		di->usb_chg.psy, ab8500_charger_get_ext_psy_data);
1936 
1937 	/* First run old_vbat is 0. */
1938 	if (di->old_vbat == 0)
1939 		di->old_vbat = di->vbat;
1940 
1941 	if (!((di->old_vbat <= VBAT_TRESH_IP_CUR_RED &&
1942 		di->vbat <= VBAT_TRESH_IP_CUR_RED) ||
1943 		(di->old_vbat > VBAT_TRESH_IP_CUR_RED &&
1944 		di->vbat > VBAT_TRESH_IP_CUR_RED))) {
1945 
1946 		dev_dbg(di->dev, "Vbat did cross threshold, curr: %d, new: %d,"
1947 			" old: %d\n", di->max_usb_in_curr.usb_type_max,
1948 			di->vbat, di->old_vbat);
1949 		ab8500_charger_set_vbus_in_curr(di,
1950 					di->max_usb_in_curr.usb_type_max);
1951 		power_supply_changed(di->usb_chg.psy);
1952 	}
1953 
1954 	di->old_vbat = di->vbat;
1955 
1956 	/*
1957 	 * No need to check the battery voltage every second when not close to
1958 	 * the threshold.
1959 	 */
1960 	if (di->vbat < (VBAT_TRESH_IP_CUR_RED + 100) &&
1961 		(di->vbat > (VBAT_TRESH_IP_CUR_RED - 100)))
1962 			t = 1;
1963 
1964 	queue_delayed_work(di->charger_wq, &di->check_vbat_work, t * HZ);
1965 }
1966 
1967 /**
1968  * ab8500_charger_check_hw_failure_work() - check main charger failure
1969  * @work:	pointer to the work_struct structure
1970  *
1971  * Work queue function for checking the main charger status
1972  */
1973 static void ab8500_charger_check_hw_failure_work(struct work_struct *work)
1974 {
1975 	int ret;
1976 	u8 reg_value;
1977 
1978 	struct ab8500_charger *di = container_of(work,
1979 		struct ab8500_charger, check_hw_failure_work.work);
1980 
1981 	/* Check if the status bits for HW failure is still active */
1982 	if (di->flags.mainextchnotok) {
1983 		ret = abx500_get_register_interruptible(di->dev,
1984 			AB8500_CHARGER, AB8500_CH_STATUS2_REG, &reg_value);
1985 		if (ret < 0) {
1986 			dev_err(di->dev, "%s ab8500 read failed\n", __func__);
1987 			return;
1988 		}
1989 		if (!(reg_value & MAIN_CH_NOK)) {
1990 			di->flags.mainextchnotok = false;
1991 			ab8500_power_supply_changed(di, di->ac_chg.psy);
1992 		}
1993 	}
1994 	if (di->flags.vbus_ovv) {
1995 		ret = abx500_get_register_interruptible(di->dev,
1996 			AB8500_CHARGER, AB8500_CH_USBCH_STAT2_REG,
1997 			&reg_value);
1998 		if (ret < 0) {
1999 			dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2000 			return;
2001 		}
2002 		if (!(reg_value & VBUS_OVV_TH)) {
2003 			di->flags.vbus_ovv = false;
2004 			ab8500_power_supply_changed(di, di->usb_chg.psy);
2005 		}
2006 	}
2007 	/* If we still have a failure, schedule a new check */
2008 	if (di->flags.mainextchnotok || di->flags.vbus_ovv) {
2009 		queue_delayed_work(di->charger_wq,
2010 			&di->check_hw_failure_work, round_jiffies(HZ));
2011 	}
2012 }
2013 
2014 /**
2015  * ab8500_charger_kick_watchdog_work() - kick the watchdog
2016  * @work:	pointer to the work_struct structure
2017  *
2018  * Work queue function for kicking the charger watchdog.
2019  *
2020  * For ABB revision 1.0 and 1.1 there is a bug in the watchdog
2021  * logic. That means we have to continuously kick the charger
2022  * watchdog even when no charger is connected. This is only
2023  * valid once the AC charger has been enabled. This is
2024  * a bug that is not handled by the algorithm and the
2025  * watchdog have to be kicked by the charger driver
2026  * when the AC charger is disabled
2027  */
2028 static void ab8500_charger_kick_watchdog_work(struct work_struct *work)
2029 {
2030 	int ret;
2031 
2032 	struct ab8500_charger *di = container_of(work,
2033 		struct ab8500_charger, kick_wd_work.work);
2034 
2035 	ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
2036 		AB8500_CHARG_WD_CTRL, CHARG_WD_KICK);
2037 	if (ret)
2038 		dev_err(di->dev, "Failed to kick WD!\n");
2039 
2040 	/* Schedule a new watchdog kick */
2041 	queue_delayed_work(di->charger_wq,
2042 		&di->kick_wd_work, round_jiffies(WD_KICK_INTERVAL));
2043 }
2044 
2045 /**
2046  * ab8500_charger_ac_work() - work to get and set main charger status
2047  * @work:	pointer to the work_struct structure
2048  *
2049  * Work queue function for checking the main charger status
2050  */
2051 static void ab8500_charger_ac_work(struct work_struct *work)
2052 {
2053 	int ret;
2054 
2055 	struct ab8500_charger *di = container_of(work,
2056 		struct ab8500_charger, ac_work);
2057 
2058 	/*
2059 	 * Since we can't be sure that the events are received
2060 	 * synchronously, we have the check if the main charger is
2061 	 * connected by reading the status register
2062 	 */
2063 	ret = ab8500_charger_detect_chargers(di, false);
2064 	if (ret < 0)
2065 		return;
2066 
2067 	if (ret & AC_PW_CONN) {
2068 		di->ac.charger_connected = 1;
2069 		di->ac_conn = true;
2070 	} else {
2071 		di->ac.charger_connected = 0;
2072 	}
2073 
2074 	ab8500_power_supply_changed(di, di->ac_chg.psy);
2075 	sysfs_notify(&di->ac_chg.psy->dev.kobj, NULL, "present");
2076 }
2077 
2078 static void ab8500_charger_usb_attached_work(struct work_struct *work)
2079 {
2080 	struct ab8500_charger *di = container_of(work,
2081 						 struct ab8500_charger,
2082 						 usb_charger_attached_work.work);
2083 	int usbch = (USB_CH_VBUSDROP | USB_CH_VBUSDETDBNC);
2084 	int ret, i;
2085 	u8 statval;
2086 
2087 	for (i = 0; i < 10; i++) {
2088 		ret = abx500_get_register_interruptible(di->dev,
2089 							AB8500_CHARGER,
2090 							AB8500_CH_USBCH_STAT1_REG,
2091 							&statval);
2092 		if (ret < 0) {
2093 			dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
2094 			goto reschedule;
2095 		}
2096 		if ((statval & usbch) != usbch)
2097 			goto reschedule;
2098 
2099 		msleep(CHARGER_STATUS_POLL);
2100 	}
2101 
2102 	ab8500_charger_usb_en(&di->usb_chg, 0, 0, 0);
2103 
2104 	mutex_lock(&di->charger_attached_mutex);
2105 	mutex_unlock(&di->charger_attached_mutex);
2106 
2107 	return;
2108 
2109 reschedule:
2110 	queue_delayed_work(di->charger_wq,
2111 			   &di->usb_charger_attached_work,
2112 			   HZ);
2113 }
2114 
2115 static void ab8500_charger_ac_attached_work(struct work_struct *work)
2116 {
2117 
2118 	struct ab8500_charger *di = container_of(work,
2119 						 struct ab8500_charger,
2120 						 ac_charger_attached_work.work);
2121 	int mainch = (MAIN_CH_STATUS2_MAINCHGDROP |
2122 		      MAIN_CH_STATUS2_MAINCHARGERDETDBNC);
2123 	int ret, i;
2124 	u8 statval;
2125 
2126 	for (i = 0; i < 10; i++) {
2127 		ret = abx500_get_register_interruptible(di->dev,
2128 							AB8500_CHARGER,
2129 							AB8500_CH_STATUS2_REG,
2130 							&statval);
2131 		if (ret < 0) {
2132 			dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
2133 			goto reschedule;
2134 		}
2135 
2136 		if ((statval & mainch) != mainch)
2137 			goto reschedule;
2138 
2139 		msleep(CHARGER_STATUS_POLL);
2140 	}
2141 
2142 	ab8500_charger_ac_en(&di->ac_chg, 0, 0, 0);
2143 	queue_work(di->charger_wq, &di->ac_work);
2144 
2145 	mutex_lock(&di->charger_attached_mutex);
2146 	mutex_unlock(&di->charger_attached_mutex);
2147 
2148 	return;
2149 
2150 reschedule:
2151 	queue_delayed_work(di->charger_wq,
2152 			   &di->ac_charger_attached_work,
2153 			   HZ);
2154 }
2155 
2156 /**
2157  * ab8500_charger_detect_usb_type_work() - work to detect USB type
2158  * @work:	Pointer to the work_struct structure
2159  *
2160  * Detect the type of USB plugged
2161  */
2162 static void ab8500_charger_detect_usb_type_work(struct work_struct *work)
2163 {
2164 	int ret;
2165 
2166 	struct ab8500_charger *di = container_of(work,
2167 		struct ab8500_charger, detect_usb_type_work);
2168 
2169 	/*
2170 	 * Since we can't be sure that the events are received
2171 	 * synchronously, we have the check if is
2172 	 * connected by reading the status register
2173 	 */
2174 	ret = ab8500_charger_detect_chargers(di, false);
2175 	if (ret < 0)
2176 		return;
2177 
2178 	if (!(ret & USB_PW_CONN)) {
2179 		dev_dbg(di->dev, "%s di->vbus_detected = false\n", __func__);
2180 		di->vbus_detected = false;
2181 		ab8500_charger_set_usb_connected(di, false);
2182 		ab8500_power_supply_changed(di, di->usb_chg.psy);
2183 	} else {
2184 		dev_dbg(di->dev, "%s di->vbus_detected = true\n", __func__);
2185 		di->vbus_detected = true;
2186 
2187 		if (is_ab8500_1p1_or_earlier(di->parent)) {
2188 			ret = ab8500_charger_detect_usb_type(di);
2189 			if (!ret) {
2190 				ab8500_charger_set_usb_connected(di, true);
2191 				ab8500_power_supply_changed(di,
2192 							    di->usb_chg.psy);
2193 			}
2194 		} else {
2195 			/*
2196 			 * For ABB cut2.0 and onwards we have an IRQ,
2197 			 * USB_LINK_STATUS that will be triggered when the USB
2198 			 * link status changes. The exception is USB connected
2199 			 * during startup. Then we don't get a
2200 			 * USB_LINK_STATUS IRQ
2201 			 */
2202 			if (di->vbus_detected_start) {
2203 				di->vbus_detected_start = false;
2204 				ret = ab8500_charger_detect_usb_type(di);
2205 				if (!ret) {
2206 					ab8500_charger_set_usb_connected(di,
2207 						true);
2208 					ab8500_power_supply_changed(di,
2209 						di->usb_chg.psy);
2210 				}
2211 			}
2212 		}
2213 	}
2214 }
2215 
2216 /**
2217  * ab8500_charger_usb_link_attach_work() - work to detect USB type
2218  * @work:	pointer to the work_struct structure
2219  *
2220  * Detect the type of USB plugged
2221  */
2222 static void ab8500_charger_usb_link_attach_work(struct work_struct *work)
2223 {
2224 	struct ab8500_charger *di =
2225 		container_of(work, struct ab8500_charger, attach_work.work);
2226 	int ret;
2227 
2228 	/* Update maximum input current if USB enumeration is not detected */
2229 	if (!di->usb.charger_online) {
2230 		ret = ab8500_charger_set_vbus_in_curr(di,
2231 					di->max_usb_in_curr.usb_type_max);
2232 		if (ret)
2233 			return;
2234 	}
2235 
2236 	ab8500_charger_set_usb_connected(di, true);
2237 	ab8500_power_supply_changed(di, di->usb_chg.psy);
2238 }
2239 
2240 /**
2241  * ab8500_charger_usb_link_status_work() - work to detect USB type
2242  * @work:	pointer to the work_struct structure
2243  *
2244  * Detect the type of USB plugged
2245  */
2246 static void ab8500_charger_usb_link_status_work(struct work_struct *work)
2247 {
2248 	int detected_chargers;
2249 	int ret;
2250 	u8 val;
2251 	u8 link_status;
2252 
2253 	struct ab8500_charger *di = container_of(work,
2254 		struct ab8500_charger, usb_link_status_work);
2255 
2256 	/*
2257 	 * Since we can't be sure that the events are received
2258 	 * synchronously, we have the check if  is
2259 	 * connected by reading the status register
2260 	 */
2261 	detected_chargers = ab8500_charger_detect_chargers(di, false);
2262 	if (detected_chargers < 0)
2263 		return;
2264 
2265 	/*
2266 	 * Some chargers that breaks the USB spec is
2267 	 * identified as invalid by AB8500 and it refuse
2268 	 * to start the charging process. but by jumping
2269 	 * through a few hoops it can be forced to start.
2270 	 */
2271 	if (is_ab8500(di->parent))
2272 		ret = abx500_get_register_interruptible(di->dev, AB8500_USB,
2273 					AB8500_USB_LINE_STAT_REG, &val);
2274 	else
2275 		ret = abx500_get_register_interruptible(di->dev, AB8500_USB,
2276 					AB8500_USB_LINK1_STAT_REG, &val);
2277 
2278 	if (ret >= 0)
2279 		dev_dbg(di->dev, "UsbLineStatus register = 0x%02x\n", val);
2280 	else
2281 		dev_dbg(di->dev, "Error reading USB link status\n");
2282 
2283 	if (is_ab8500(di->parent))
2284 		link_status = AB8500_USB_LINK_STATUS;
2285 	else
2286 		link_status = AB8505_USB_LINK_STATUS;
2287 
2288 	if (detected_chargers & USB_PW_CONN) {
2289 		if (((val & link_status) >> USB_LINK_STATUS_SHIFT) ==
2290 				USB_STAT_NOT_VALID_LINK &&
2291 				di->invalid_charger_detect_state == 0) {
2292 			dev_dbg(di->dev,
2293 					"Invalid charger detected, state= 0\n");
2294 			/*Enable charger*/
2295 			abx500_mask_and_set_register_interruptible(di->dev,
2296 					AB8500_CHARGER, AB8500_USBCH_CTRL1_REG,
2297 					USB_CH_ENA, USB_CH_ENA);
2298 			/*Enable charger detection*/
2299 			abx500_mask_and_set_register_interruptible(di->dev,
2300 					AB8500_USB, AB8500_USB_LINE_CTRL2_REG,
2301 					USB_CH_DET, USB_CH_DET);
2302 			di->invalid_charger_detect_state = 1;
2303 			/*exit and wait for new link status interrupt.*/
2304 			return;
2305 
2306 		}
2307 		if (di->invalid_charger_detect_state == 1) {
2308 			dev_dbg(di->dev,
2309 					"Invalid charger detected, state= 1\n");
2310 			/*Stop charger detection*/
2311 			abx500_mask_and_set_register_interruptible(di->dev,
2312 					AB8500_USB, AB8500_USB_LINE_CTRL2_REG,
2313 					USB_CH_DET, 0x00);
2314 			/*Check link status*/
2315 			if (is_ab8500(di->parent))
2316 				ret = abx500_get_register_interruptible(di->dev,
2317 					AB8500_USB, AB8500_USB_LINE_STAT_REG,
2318 					&val);
2319 			else
2320 				ret = abx500_get_register_interruptible(di->dev,
2321 					AB8500_USB, AB8500_USB_LINK1_STAT_REG,
2322 					&val);
2323 
2324 			dev_dbg(di->dev, "USB link status= 0x%02x\n",
2325 				(val & link_status) >> USB_LINK_STATUS_SHIFT);
2326 			di->invalid_charger_detect_state = 2;
2327 		}
2328 	} else {
2329 		di->invalid_charger_detect_state = 0;
2330 	}
2331 
2332 	if (!(detected_chargers & USB_PW_CONN)) {
2333 		di->vbus_detected = false;
2334 		ab8500_charger_set_usb_connected(di, false);
2335 		ab8500_power_supply_changed(di, di->usb_chg.psy);
2336 		return;
2337 	}
2338 
2339 	dev_dbg(di->dev,"%s di->vbus_detected = true\n",__func__);
2340 	di->vbus_detected = true;
2341 	ret = ab8500_charger_read_usb_type(di);
2342 	if (ret) {
2343 		if (ret == -ENXIO) {
2344 			/* No valid charger type detected */
2345 			ab8500_charger_set_usb_connected(di, false);
2346 			ab8500_power_supply_changed(di, di->usb_chg.psy);
2347 		}
2348 		return;
2349 	}
2350 
2351 	if (di->usb_device_is_unrecognised) {
2352 		dev_dbg(di->dev,
2353 			"Potential Legacy Charger device. "
2354 			"Delay work for %d msec for USB enum "
2355 			"to finish",
2356 			WAIT_ACA_RID_ENUMERATION);
2357 		queue_delayed_work(di->charger_wq,
2358 				   &di->attach_work,
2359 				   msecs_to_jiffies(WAIT_ACA_RID_ENUMERATION));
2360 	} else if (di->is_aca_rid == 1) {
2361 		/* Only wait once */
2362 		di->is_aca_rid++;
2363 		dev_dbg(di->dev,
2364 			"%s Wait %d msec for USB enum to finish",
2365 			__func__, WAIT_ACA_RID_ENUMERATION);
2366 		queue_delayed_work(di->charger_wq,
2367 				   &di->attach_work,
2368 				   msecs_to_jiffies(WAIT_ACA_RID_ENUMERATION));
2369 	} else {
2370 		queue_delayed_work(di->charger_wq,
2371 				   &di->attach_work,
2372 				   0);
2373 	}
2374 }
2375 
2376 static void ab8500_charger_usb_state_changed_work(struct work_struct *work)
2377 {
2378 	int ret;
2379 	unsigned long flags;
2380 
2381 	struct ab8500_charger *di = container_of(work,
2382 		struct ab8500_charger, usb_state_changed_work.work);
2383 
2384 	if (!di->vbus_detected)	{
2385 		dev_dbg(di->dev,
2386 			"%s !di->vbus_detected\n",
2387 			__func__);
2388 		return;
2389 	}
2390 
2391 	spin_lock_irqsave(&di->usb_state.usb_lock, flags);
2392 	di->usb_state.state = di->usb_state.state_tmp;
2393 	di->usb_state.usb_current = di->usb_state.usb_current_tmp;
2394 	spin_unlock_irqrestore(&di->usb_state.usb_lock, flags);
2395 
2396 	dev_dbg(di->dev, "%s USB state: 0x%02x mA: %d\n",
2397 		__func__, di->usb_state.state, di->usb_state.usb_current);
2398 
2399 	switch (di->usb_state.state) {
2400 	case AB8500_BM_USB_STATE_RESET_HS:
2401 	case AB8500_BM_USB_STATE_RESET_FS:
2402 	case AB8500_BM_USB_STATE_SUSPEND:
2403 	case AB8500_BM_USB_STATE_MAX:
2404 		ab8500_charger_set_usb_connected(di, false);
2405 		ab8500_power_supply_changed(di, di->usb_chg.psy);
2406 		break;
2407 
2408 	case AB8500_BM_USB_STATE_RESUME:
2409 		/*
2410 		 * when suspend->resume there should be delay
2411 		 * of 1sec for enabling charging
2412 		 */
2413 		msleep(1000);
2414 		fallthrough;
2415 	case AB8500_BM_USB_STATE_CONFIGURED:
2416 		/*
2417 		 * USB is configured, enable charging with the charging
2418 		 * input current obtained from USB driver
2419 		 */
2420 		if (!ab8500_charger_get_usb_cur(di)) {
2421 			/* Update maximum input current */
2422 			ret = ab8500_charger_set_vbus_in_curr(di,
2423 					di->max_usb_in_curr.usb_type_max);
2424 			if (ret)
2425 				return;
2426 
2427 			ab8500_charger_set_usb_connected(di, true);
2428 			ab8500_power_supply_changed(di, di->usb_chg.psy);
2429 		}
2430 		break;
2431 
2432 	default:
2433 		break;
2434 	}
2435 }
2436 
2437 /**
2438  * ab8500_charger_check_usbchargernotok_work() - check USB chg not ok status
2439  * @work:	pointer to the work_struct structure
2440  *
2441  * Work queue function for checking the USB charger Not OK status
2442  */
2443 static void ab8500_charger_check_usbchargernotok_work(struct work_struct *work)
2444 {
2445 	int ret;
2446 	u8 reg_value;
2447 	bool prev_status;
2448 
2449 	struct ab8500_charger *di = container_of(work,
2450 		struct ab8500_charger, check_usbchgnotok_work.work);
2451 
2452 	/* Check if the status bit for usbchargernotok is still active */
2453 	ret = abx500_get_register_interruptible(di->dev,
2454 		AB8500_CHARGER, AB8500_CH_USBCH_STAT2_REG, &reg_value);
2455 	if (ret < 0) {
2456 		dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2457 		return;
2458 	}
2459 	prev_status = di->flags.usbchargernotok;
2460 
2461 	if (reg_value & VBUS_CH_NOK) {
2462 		di->flags.usbchargernotok = true;
2463 		/* Check again in 1sec */
2464 		queue_delayed_work(di->charger_wq,
2465 			&di->check_usbchgnotok_work, HZ);
2466 	} else {
2467 		di->flags.usbchargernotok = false;
2468 		di->flags.vbus_collapse = false;
2469 	}
2470 
2471 	if (prev_status != di->flags.usbchargernotok)
2472 		ab8500_power_supply_changed(di, di->usb_chg.psy);
2473 }
2474 
2475 /**
2476  * ab8500_charger_check_main_thermal_prot_work() - check main thermal status
2477  * @work:	pointer to the work_struct structure
2478  *
2479  * Work queue function for checking the Main thermal prot status
2480  */
2481 static void ab8500_charger_check_main_thermal_prot_work(
2482 	struct work_struct *work)
2483 {
2484 	int ret;
2485 	u8 reg_value;
2486 
2487 	struct ab8500_charger *di = container_of(work,
2488 		struct ab8500_charger, check_main_thermal_prot_work);
2489 
2490 	/* Check if the status bit for main_thermal_prot is still active */
2491 	ret = abx500_get_register_interruptible(di->dev,
2492 		AB8500_CHARGER, AB8500_CH_STATUS2_REG, &reg_value);
2493 	if (ret < 0) {
2494 		dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2495 		return;
2496 	}
2497 	if (reg_value & MAIN_CH_TH_PROT)
2498 		di->flags.main_thermal_prot = true;
2499 	else
2500 		di->flags.main_thermal_prot = false;
2501 
2502 	ab8500_power_supply_changed(di, di->ac_chg.psy);
2503 }
2504 
2505 /**
2506  * ab8500_charger_check_usb_thermal_prot_work() - check usb thermal status
2507  * @work:	pointer to the work_struct structure
2508  *
2509  * Work queue function for checking the USB thermal prot status
2510  */
2511 static void ab8500_charger_check_usb_thermal_prot_work(
2512 	struct work_struct *work)
2513 {
2514 	int ret;
2515 	u8 reg_value;
2516 
2517 	struct ab8500_charger *di = container_of(work,
2518 		struct ab8500_charger, check_usb_thermal_prot_work);
2519 
2520 	/* Check if the status bit for usb_thermal_prot is still active */
2521 	ret = abx500_get_register_interruptible(di->dev,
2522 		AB8500_CHARGER, AB8500_CH_USBCH_STAT2_REG, &reg_value);
2523 	if (ret < 0) {
2524 		dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2525 		return;
2526 	}
2527 	if (reg_value & USB_CH_TH_PROT)
2528 		di->flags.usb_thermal_prot = true;
2529 	else
2530 		di->flags.usb_thermal_prot = false;
2531 
2532 	ab8500_power_supply_changed(di, di->usb_chg.psy);
2533 }
2534 
2535 /**
2536  * ab8500_charger_mainchunplugdet_handler() - main charger unplugged
2537  * @irq:       interrupt number
2538  * @_di:       pointer to the ab8500_charger structure
2539  *
2540  * Returns IRQ status(IRQ_HANDLED)
2541  */
2542 static irqreturn_t ab8500_charger_mainchunplugdet_handler(int irq, void *_di)
2543 {
2544 	struct ab8500_charger *di = _di;
2545 
2546 	dev_dbg(di->dev, "Main charger unplugged\n");
2547 	queue_work(di->charger_wq, &di->ac_work);
2548 
2549 	cancel_delayed_work_sync(&di->ac_charger_attached_work);
2550 	mutex_lock(&di->charger_attached_mutex);
2551 	mutex_unlock(&di->charger_attached_mutex);
2552 
2553 	return IRQ_HANDLED;
2554 }
2555 
2556 /**
2557  * ab8500_charger_mainchplugdet_handler() - main charger plugged
2558  * @irq:       interrupt number
2559  * @_di:       pointer to the ab8500_charger structure
2560  *
2561  * Returns IRQ status(IRQ_HANDLED)
2562  */
2563 static irqreturn_t ab8500_charger_mainchplugdet_handler(int irq, void *_di)
2564 {
2565 	struct ab8500_charger *di = _di;
2566 
2567 	dev_dbg(di->dev, "Main charger plugged\n");
2568 	queue_work(di->charger_wq, &di->ac_work);
2569 
2570 	mutex_lock(&di->charger_attached_mutex);
2571 	mutex_unlock(&di->charger_attached_mutex);
2572 
2573 	if (is_ab8500(di->parent))
2574 		queue_delayed_work(di->charger_wq,
2575 			   &di->ac_charger_attached_work,
2576 			   HZ);
2577 	return IRQ_HANDLED;
2578 }
2579 
2580 /**
2581  * ab8500_charger_mainextchnotok_handler() - main charger not ok
2582  * @irq:       interrupt number
2583  * @_di:       pointer to the ab8500_charger structure
2584  *
2585  * Returns IRQ status(IRQ_HANDLED)
2586  */
2587 static irqreturn_t ab8500_charger_mainextchnotok_handler(int irq, void *_di)
2588 {
2589 	struct ab8500_charger *di = _di;
2590 
2591 	dev_dbg(di->dev, "Main charger not ok\n");
2592 	di->flags.mainextchnotok = true;
2593 	ab8500_power_supply_changed(di, di->ac_chg.psy);
2594 
2595 	/* Schedule a new HW failure check */
2596 	queue_delayed_work(di->charger_wq, &di->check_hw_failure_work, 0);
2597 
2598 	return IRQ_HANDLED;
2599 }
2600 
2601 /**
2602  * ab8500_charger_mainchthprotr_handler() - Die temp is above main charger
2603  * thermal protection threshold
2604  * @irq:       interrupt number
2605  * @_di:       pointer to the ab8500_charger structure
2606  *
2607  * Returns IRQ status(IRQ_HANDLED)
2608  */
2609 static irqreturn_t ab8500_charger_mainchthprotr_handler(int irq, void *_di)
2610 {
2611 	struct ab8500_charger *di = _di;
2612 
2613 	dev_dbg(di->dev,
2614 		"Die temp above Main charger thermal protection threshold\n");
2615 	queue_work(di->charger_wq, &di->check_main_thermal_prot_work);
2616 
2617 	return IRQ_HANDLED;
2618 }
2619 
2620 /**
2621  * ab8500_charger_mainchthprotf_handler() - Die temp is below main charger
2622  * thermal protection threshold
2623  * @irq:       interrupt number
2624  * @_di:       pointer to the ab8500_charger structure
2625  *
2626  * Returns IRQ status(IRQ_HANDLED)
2627  */
2628 static irqreturn_t ab8500_charger_mainchthprotf_handler(int irq, void *_di)
2629 {
2630 	struct ab8500_charger *di = _di;
2631 
2632 	dev_dbg(di->dev,
2633 		"Die temp ok for Main charger thermal protection threshold\n");
2634 	queue_work(di->charger_wq, &di->check_main_thermal_prot_work);
2635 
2636 	return IRQ_HANDLED;
2637 }
2638 
2639 static void ab8500_charger_vbus_drop_end_work(struct work_struct *work)
2640 {
2641 	struct ab8500_charger *di = container_of(work,
2642 		struct ab8500_charger, vbus_drop_end_work.work);
2643 	int ret, curr;
2644 	u8 reg_value;
2645 
2646 	di->flags.vbus_drop_end = false;
2647 
2648 	/* Reset the drop counter */
2649 	abx500_set_register_interruptible(di->dev,
2650 				  AB8500_CHARGER, AB8500_CHARGER_CTRL, 0x01);
2651 
2652 	ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
2653 			AB8500_CH_USBCH_STAT2_REG, &reg_value);
2654 	if (ret < 0) {
2655 		dev_err(di->dev, "%s read failed\n", __func__);
2656 		return;
2657 	}
2658 
2659 	curr = di->bm->chg_input_curr[
2660 		reg_value >> AUTO_VBUS_IN_CURR_LIM_SHIFT];
2661 
2662 	if (di->max_usb_in_curr.calculated_max != curr) {
2663 		/* USB source is collapsing */
2664 		di->max_usb_in_curr.calculated_max = curr;
2665 		dev_dbg(di->dev,
2666 			 "VBUS input current limiting to %d mA\n",
2667 			 di->max_usb_in_curr.calculated_max);
2668 	} else {
2669 		/*
2670 		 * USB source can not give more than this amount.
2671 		 * Taking more will collapse the source.
2672 		 */
2673 		di->max_usb_in_curr.set_max =
2674 			di->max_usb_in_curr.calculated_max;
2675 		dev_dbg(di->dev,
2676 			 "VBUS input current limited to %d mA\n",
2677 			 di->max_usb_in_curr.set_max);
2678 	}
2679 
2680 	if (di->usb.charger_connected)
2681 		ab8500_charger_set_vbus_in_curr(di,
2682 					di->max_usb_in_curr.usb_type_max);
2683 }
2684 
2685 /**
2686  * ab8500_charger_vbusdetf_handler() - VBUS falling detected
2687  * @irq:       interrupt number
2688  * @_di:       pointer to the ab8500_charger structure
2689  *
2690  * Returns IRQ status(IRQ_HANDLED)
2691  */
2692 static irqreturn_t ab8500_charger_vbusdetf_handler(int irq, void *_di)
2693 {
2694 	struct ab8500_charger *di = _di;
2695 
2696 	di->vbus_detected = false;
2697 	dev_dbg(di->dev, "VBUS falling detected\n");
2698 	queue_work(di->charger_wq, &di->detect_usb_type_work);
2699 
2700 	return IRQ_HANDLED;
2701 }
2702 
2703 /**
2704  * ab8500_charger_vbusdetr_handler() - VBUS rising detected
2705  * @irq:       interrupt number
2706  * @_di:       pointer to the ab8500_charger structure
2707  *
2708  * Returns IRQ status(IRQ_HANDLED)
2709  */
2710 static irqreturn_t ab8500_charger_vbusdetr_handler(int irq, void *_di)
2711 {
2712 	struct ab8500_charger *di = _di;
2713 
2714 	di->vbus_detected = true;
2715 	dev_dbg(di->dev, "VBUS rising detected\n");
2716 
2717 	queue_work(di->charger_wq, &di->detect_usb_type_work);
2718 
2719 	return IRQ_HANDLED;
2720 }
2721 
2722 /**
2723  * ab8500_charger_usblinkstatus_handler() - USB link status has changed
2724  * @irq:       interrupt number
2725  * @_di:       pointer to the ab8500_charger structure
2726  *
2727  * Returns IRQ status(IRQ_HANDLED)
2728  */
2729 static irqreturn_t ab8500_charger_usblinkstatus_handler(int irq, void *_di)
2730 {
2731 	struct ab8500_charger *di = _di;
2732 
2733 	dev_dbg(di->dev, "USB link status changed\n");
2734 
2735 	queue_work(di->charger_wq, &di->usb_link_status_work);
2736 
2737 	return IRQ_HANDLED;
2738 }
2739 
2740 /**
2741  * ab8500_charger_usbchthprotr_handler() - Die temp is above usb charger
2742  * thermal protection threshold
2743  * @irq:       interrupt number
2744  * @_di:       pointer to the ab8500_charger structure
2745  *
2746  * Returns IRQ status(IRQ_HANDLED)
2747  */
2748 static irqreturn_t ab8500_charger_usbchthprotr_handler(int irq, void *_di)
2749 {
2750 	struct ab8500_charger *di = _di;
2751 
2752 	dev_dbg(di->dev,
2753 		"Die temp above USB charger thermal protection threshold\n");
2754 	queue_work(di->charger_wq, &di->check_usb_thermal_prot_work);
2755 
2756 	return IRQ_HANDLED;
2757 }
2758 
2759 /**
2760  * ab8500_charger_usbchthprotf_handler() - Die temp is below usb charger
2761  * thermal protection threshold
2762  * @irq:       interrupt number
2763  * @_di:       pointer to the ab8500_charger structure
2764  *
2765  * Returns IRQ status(IRQ_HANDLED)
2766  */
2767 static irqreturn_t ab8500_charger_usbchthprotf_handler(int irq, void *_di)
2768 {
2769 	struct ab8500_charger *di = _di;
2770 
2771 	dev_dbg(di->dev,
2772 		"Die temp ok for USB charger thermal protection threshold\n");
2773 	queue_work(di->charger_wq, &di->check_usb_thermal_prot_work);
2774 
2775 	return IRQ_HANDLED;
2776 }
2777 
2778 /**
2779  * ab8500_charger_usbchargernotokr_handler() - USB charger not ok detected
2780  * @irq:       interrupt number
2781  * @_di:       pointer to the ab8500_charger structure
2782  *
2783  * Returns IRQ status(IRQ_HANDLED)
2784  */
2785 static irqreturn_t ab8500_charger_usbchargernotokr_handler(int irq, void *_di)
2786 {
2787 	struct ab8500_charger *di = _di;
2788 
2789 	dev_dbg(di->dev, "Not allowed USB charger detected\n");
2790 	queue_delayed_work(di->charger_wq, &di->check_usbchgnotok_work, 0);
2791 
2792 	return IRQ_HANDLED;
2793 }
2794 
2795 /**
2796  * ab8500_charger_chwdexp_handler() - Charger watchdog expired
2797  * @irq:       interrupt number
2798  * @_di:       pointer to the ab8500_charger structure
2799  *
2800  * Returns IRQ status(IRQ_HANDLED)
2801  */
2802 static irqreturn_t ab8500_charger_chwdexp_handler(int irq, void *_di)
2803 {
2804 	struct ab8500_charger *di = _di;
2805 
2806 	dev_dbg(di->dev, "Charger watchdog expired\n");
2807 
2808 	/*
2809 	 * The charger that was online when the watchdog expired
2810 	 * needs to be restarted for charging to start again
2811 	 */
2812 	if (di->ac.charger_online) {
2813 		di->ac.wd_expired = true;
2814 		ab8500_power_supply_changed(di, di->ac_chg.psy);
2815 	}
2816 	if (di->usb.charger_online) {
2817 		di->usb.wd_expired = true;
2818 		ab8500_power_supply_changed(di, di->usb_chg.psy);
2819 	}
2820 
2821 	return IRQ_HANDLED;
2822 }
2823 
2824 /**
2825  * ab8500_charger_vbuschdropend_handler() - VBUS drop removed
2826  * @irq:       interrupt number
2827  * @_di:       pointer to the ab8500_charger structure
2828  *
2829  * Returns IRQ status(IRQ_HANDLED)
2830  */
2831 static irqreturn_t ab8500_charger_vbuschdropend_handler(int irq, void *_di)
2832 {
2833 	struct ab8500_charger *di = _di;
2834 
2835 	dev_dbg(di->dev, "VBUS charger drop ended\n");
2836 	di->flags.vbus_drop_end = true;
2837 
2838 	/*
2839 	 * VBUS might have dropped due to bad connection.
2840 	 * Schedule a new input limit set to the value SW requests.
2841 	 */
2842 	queue_delayed_work(di->charger_wq, &di->vbus_drop_end_work,
2843 			   round_jiffies(VBUS_IN_CURR_LIM_RETRY_SET_TIME * HZ));
2844 
2845 	return IRQ_HANDLED;
2846 }
2847 
2848 /**
2849  * ab8500_charger_vbusovv_handler() - VBUS overvoltage detected
2850  * @irq:       interrupt number
2851  * @_di:       pointer to the ab8500_charger structure
2852  *
2853  * Returns IRQ status(IRQ_HANDLED)
2854  */
2855 static irqreturn_t ab8500_charger_vbusovv_handler(int irq, void *_di)
2856 {
2857 	struct ab8500_charger *di = _di;
2858 
2859 	dev_dbg(di->dev, "VBUS overvoltage detected\n");
2860 	di->flags.vbus_ovv = true;
2861 	ab8500_power_supply_changed(di, di->usb_chg.psy);
2862 
2863 	/* Schedule a new HW failure check */
2864 	queue_delayed_work(di->charger_wq, &di->check_hw_failure_work, 0);
2865 
2866 	return IRQ_HANDLED;
2867 }
2868 
2869 /**
2870  * ab8500_charger_ac_get_property() - get the ac/mains properties
2871  * @psy:       pointer to the power_supply structure
2872  * @psp:       pointer to the power_supply_property structure
2873  * @val:       pointer to the power_supply_propval union
2874  *
2875  * This function gets called when an application tries to get the ac/mains
2876  * properties by reading the sysfs files.
2877  * AC/Mains properties are online, present and voltage.
2878  * online:     ac/mains charging is in progress or not
2879  * present:    presence of the ac/mains
2880  * voltage:    AC/Mains voltage
2881  * Returns error code in case of failure else 0(on success)
2882  */
2883 static int ab8500_charger_ac_get_property(struct power_supply *psy,
2884 	enum power_supply_property psp,
2885 	union power_supply_propval *val)
2886 {
2887 	struct ab8500_charger *di;
2888 	int ret;
2889 
2890 	di = to_ab8500_charger_ac_device_info(psy_to_ux500_charger(psy));
2891 
2892 	switch (psp) {
2893 	case POWER_SUPPLY_PROP_HEALTH:
2894 		if (di->flags.mainextchnotok)
2895 			val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
2896 		else if (di->ac.wd_expired || di->usb.wd_expired)
2897 			val->intval = POWER_SUPPLY_HEALTH_DEAD;
2898 		else if (di->flags.main_thermal_prot)
2899 			val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
2900 		else
2901 			val->intval = POWER_SUPPLY_HEALTH_GOOD;
2902 		break;
2903 	case POWER_SUPPLY_PROP_ONLINE:
2904 		val->intval = di->ac.charger_online;
2905 		break;
2906 	case POWER_SUPPLY_PROP_PRESENT:
2907 		val->intval = di->ac.charger_connected;
2908 		break;
2909 	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
2910 		ret = ab8500_charger_get_ac_voltage(di);
2911 		if (ret >= 0)
2912 			di->ac.charger_voltage = ret;
2913 		/* On error, use previous value */
2914 		val->intval = di->ac.charger_voltage * 1000;
2915 		break;
2916 	case POWER_SUPPLY_PROP_VOLTAGE_AVG:
2917 		/*
2918 		 * This property is used to indicate when CV mode is entered
2919 		 * for the AC charger
2920 		 */
2921 		di->ac.cv_active = ab8500_charger_ac_cv(di);
2922 		val->intval = di->ac.cv_active;
2923 		break;
2924 	case POWER_SUPPLY_PROP_CURRENT_NOW:
2925 		ret = ab8500_charger_get_ac_current(di);
2926 		if (ret >= 0)
2927 			di->ac.charger_current = ret;
2928 		val->intval = di->ac.charger_current * 1000;
2929 		break;
2930 	default:
2931 		return -EINVAL;
2932 	}
2933 	return 0;
2934 }
2935 
2936 /**
2937  * ab8500_charger_usb_get_property() - get the usb properties
2938  * @psy:        pointer to the power_supply structure
2939  * @psp:        pointer to the power_supply_property structure
2940  * @val:        pointer to the power_supply_propval union
2941  *
2942  * This function gets called when an application tries to get the usb
2943  * properties by reading the sysfs files.
2944  * USB properties are online, present and voltage.
2945  * online:     usb charging is in progress or not
2946  * present:    presence of the usb
2947  * voltage:    vbus voltage
2948  * Returns error code in case of failure else 0(on success)
2949  */
2950 static int ab8500_charger_usb_get_property(struct power_supply *psy,
2951 	enum power_supply_property psp,
2952 	union power_supply_propval *val)
2953 {
2954 	struct ab8500_charger *di;
2955 	int ret;
2956 
2957 	di = to_ab8500_charger_usb_device_info(psy_to_ux500_charger(psy));
2958 
2959 	switch (psp) {
2960 	case POWER_SUPPLY_PROP_HEALTH:
2961 		if (di->flags.usbchargernotok)
2962 			val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
2963 		else if (di->ac.wd_expired || di->usb.wd_expired)
2964 			val->intval = POWER_SUPPLY_HEALTH_DEAD;
2965 		else if (di->flags.usb_thermal_prot)
2966 			val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
2967 		else if (di->flags.vbus_ovv)
2968 			val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
2969 		else
2970 			val->intval = POWER_SUPPLY_HEALTH_GOOD;
2971 		break;
2972 	case POWER_SUPPLY_PROP_ONLINE:
2973 		val->intval = di->usb.charger_online;
2974 		break;
2975 	case POWER_SUPPLY_PROP_PRESENT:
2976 		val->intval = di->usb.charger_connected;
2977 		break;
2978 	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
2979 		ret = ab8500_charger_get_vbus_voltage(di);
2980 		if (ret >= 0)
2981 			di->usb.charger_voltage = ret;
2982 		val->intval = di->usb.charger_voltage * 1000;
2983 		break;
2984 	case POWER_SUPPLY_PROP_VOLTAGE_AVG:
2985 		/*
2986 		 * This property is used to indicate when CV mode is entered
2987 		 * for the USB charger
2988 		 */
2989 		di->usb.cv_active = ab8500_charger_usb_cv(di);
2990 		val->intval = di->usb.cv_active;
2991 		break;
2992 	case POWER_SUPPLY_PROP_CURRENT_NOW:
2993 		ret = ab8500_charger_get_usb_current(di);
2994 		if (ret >= 0)
2995 			di->usb.charger_current = ret;
2996 		val->intval = di->usb.charger_current * 1000;
2997 		break;
2998 	case POWER_SUPPLY_PROP_CURRENT_AVG:
2999 		/*
3000 		 * This property is used to indicate when VBUS has collapsed
3001 		 * due to too high output current from the USB charger
3002 		 */
3003 		if (di->flags.vbus_collapse)
3004 			val->intval = 1;
3005 		else
3006 			val->intval = 0;
3007 		break;
3008 	default:
3009 		return -EINVAL;
3010 	}
3011 	return 0;
3012 }
3013 
3014 /**
3015  * ab8500_charger_init_hw_registers() - Set up charger related registers
3016  * @di:		pointer to the ab8500_charger structure
3017  *
3018  * Set up charger OVV, watchdog and maximum voltage registers as well as
3019  * charging of the backup battery
3020  */
3021 static int ab8500_charger_init_hw_registers(struct ab8500_charger *di)
3022 {
3023 	int ret = 0;
3024 
3025 	/* Setup maximum charger current and voltage for ABB cut2.0 */
3026 	if (!is_ab8500_1p1_or_earlier(di->parent)) {
3027 		ret = abx500_set_register_interruptible(di->dev,
3028 			AB8500_CHARGER,
3029 			AB8500_CH_VOLT_LVL_MAX_REG, CH_VOL_LVL_4P6);
3030 		if (ret) {
3031 			dev_err(di->dev,
3032 				"failed to set CH_VOLT_LVL_MAX_REG\n");
3033 			goto out;
3034 		}
3035 
3036 		ret = abx500_set_register_interruptible(di->dev,
3037 			AB8500_CHARGER, AB8500_CH_OPT_CRNTLVL_MAX_REG,
3038 			CH_OP_CUR_LVL_1P6);
3039 		if (ret) {
3040 			dev_err(di->dev,
3041 				"failed to set CH_OPT_CRNTLVL_MAX_REG\n");
3042 			goto out;
3043 		}
3044 	}
3045 
3046 	if (is_ab8505_2p0(di->parent))
3047 		ret = abx500_mask_and_set_register_interruptible(di->dev,
3048 			AB8500_CHARGER,
3049 			AB8500_USBCH_CTRL2_REG,
3050 			VBUS_AUTO_IN_CURR_LIM_ENA,
3051 			VBUS_AUTO_IN_CURR_LIM_ENA);
3052 	else
3053 		/*
3054 		 * VBUS OVV set to 6.3V and enable automatic current limitation
3055 		 */
3056 		ret = abx500_set_register_interruptible(di->dev,
3057 			AB8500_CHARGER,
3058 			AB8500_USBCH_CTRL2_REG,
3059 			VBUS_OVV_SELECT_6P3V | VBUS_AUTO_IN_CURR_LIM_ENA);
3060 	if (ret) {
3061 		dev_err(di->dev,
3062 			"failed to set automatic current limitation\n");
3063 		goto out;
3064 	}
3065 
3066 	/* Enable main watchdog in OTP */
3067 	ret = abx500_set_register_interruptible(di->dev,
3068 		AB8500_OTP_EMUL, AB8500_OTP_CONF_15, OTP_ENABLE_WD);
3069 	if (ret) {
3070 		dev_err(di->dev, "failed to enable main WD in OTP\n");
3071 		goto out;
3072 	}
3073 
3074 	/* Enable main watchdog */
3075 	ret = abx500_set_register_interruptible(di->dev,
3076 		AB8500_SYS_CTRL2_BLOCK,
3077 		AB8500_MAIN_WDOG_CTRL_REG, MAIN_WDOG_ENA);
3078 	if (ret) {
3079 		dev_err(di->dev, "failed to enable main watchdog\n");
3080 		goto out;
3081 	}
3082 
3083 	/*
3084 	 * Due to internal synchronisation, Enable and Kick watchdog bits
3085 	 * cannot be enabled in a single write.
3086 	 * A minimum delay of 2*32 kHz period (62.5µs) must be inserted
3087 	 * between writing Enable then Kick bits.
3088 	 */
3089 	udelay(63);
3090 
3091 	/* Kick main watchdog */
3092 	ret = abx500_set_register_interruptible(di->dev,
3093 		AB8500_SYS_CTRL2_BLOCK,
3094 		AB8500_MAIN_WDOG_CTRL_REG,
3095 		(MAIN_WDOG_ENA | MAIN_WDOG_KICK));
3096 	if (ret) {
3097 		dev_err(di->dev, "failed to kick main watchdog\n");
3098 		goto out;
3099 	}
3100 
3101 	/* Disable main watchdog */
3102 	ret = abx500_set_register_interruptible(di->dev,
3103 		AB8500_SYS_CTRL2_BLOCK,
3104 		AB8500_MAIN_WDOG_CTRL_REG, MAIN_WDOG_DIS);
3105 	if (ret) {
3106 		dev_err(di->dev, "failed to disable main watchdog\n");
3107 		goto out;
3108 	}
3109 
3110 	/* Set watchdog timeout */
3111 	ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
3112 		AB8500_CH_WD_TIMER_REG, WD_TIMER);
3113 	if (ret) {
3114 		dev_err(di->dev, "failed to set charger watchdog timeout\n");
3115 		goto out;
3116 	}
3117 
3118 	ret = ab8500_charger_led_en(di, false);
3119 	if (ret < 0) {
3120 		dev_err(di->dev, "failed to disable LED\n");
3121 		goto out;
3122 	}
3123 
3124 	ret = abx500_set_register_interruptible(di->dev,
3125 		AB8500_RTC,
3126 		AB8500_RTC_BACKUP_CHG_REG,
3127 		(di->bm->bkup_bat_v & 0x3) | di->bm->bkup_bat_i);
3128 	if (ret) {
3129 		dev_err(di->dev, "failed to setup backup battery charging\n");
3130 		goto out;
3131 	}
3132 
3133 	/* Enable backup battery charging */
3134 	ret = abx500_mask_and_set_register_interruptible(di->dev,
3135 		AB8500_RTC, AB8500_RTC_CTRL_REG,
3136 		RTC_BUP_CH_ENA, RTC_BUP_CH_ENA);
3137 	if (ret < 0) {
3138 		dev_err(di->dev, "%s mask and set failed\n", __func__);
3139 		goto out;
3140 	}
3141 
3142 out:
3143 	return ret;
3144 }
3145 
3146 /*
3147  * ab8500 charger driver interrupts and their respective isr
3148  */
3149 static struct ab8500_charger_interrupts ab8500_charger_irq[] = {
3150 	{"MAIN_CH_UNPLUG_DET", ab8500_charger_mainchunplugdet_handler},
3151 	{"MAIN_CHARGE_PLUG_DET", ab8500_charger_mainchplugdet_handler},
3152 	{"MAIN_EXT_CH_NOT_OK", ab8500_charger_mainextchnotok_handler},
3153 	{"MAIN_CH_TH_PROT_R", ab8500_charger_mainchthprotr_handler},
3154 	{"MAIN_CH_TH_PROT_F", ab8500_charger_mainchthprotf_handler},
3155 	{"VBUS_DET_F", ab8500_charger_vbusdetf_handler},
3156 	{"VBUS_DET_R", ab8500_charger_vbusdetr_handler},
3157 	{"USB_LINK_STATUS", ab8500_charger_usblinkstatus_handler},
3158 	{"USB_CH_TH_PROT_R", ab8500_charger_usbchthprotr_handler},
3159 	{"USB_CH_TH_PROT_F", ab8500_charger_usbchthprotf_handler},
3160 	{"USB_CHARGER_NOT_OKR", ab8500_charger_usbchargernotokr_handler},
3161 	{"VBUS_OVV", ab8500_charger_vbusovv_handler},
3162 	{"CH_WD_EXP", ab8500_charger_chwdexp_handler},
3163 	{"VBUS_CH_DROP_END", ab8500_charger_vbuschdropend_handler},
3164 };
3165 
3166 static int ab8500_charger_usb_notifier_call(struct notifier_block *nb,
3167 		unsigned long event, void *power)
3168 {
3169 	struct ab8500_charger *di =
3170 		container_of(nb, struct ab8500_charger, nb);
3171 	enum ab8500_usb_state bm_usb_state;
3172 	unsigned mA = *((unsigned *)power);
3173 
3174 	if (!di)
3175 		return NOTIFY_DONE;
3176 
3177 	if (event != USB_EVENT_VBUS) {
3178 		dev_dbg(di->dev, "not a standard host, returning\n");
3179 		return NOTIFY_DONE;
3180 	}
3181 
3182 	/* TODO: State is fabricate  here. See if charger really needs USB
3183 	 * state or if mA is enough
3184 	 */
3185 	if ((di->usb_state.usb_current == 2) && (mA > 2))
3186 		bm_usb_state = AB8500_BM_USB_STATE_RESUME;
3187 	else if (mA == 0)
3188 		bm_usb_state = AB8500_BM_USB_STATE_RESET_HS;
3189 	else if (mA == 2)
3190 		bm_usb_state = AB8500_BM_USB_STATE_SUSPEND;
3191 	else if (mA >= 8) /* 8, 100, 500 */
3192 		bm_usb_state = AB8500_BM_USB_STATE_CONFIGURED;
3193 	else /* Should never occur */
3194 		bm_usb_state = AB8500_BM_USB_STATE_RESET_FS;
3195 
3196 	dev_dbg(di->dev, "%s usb_state: 0x%02x mA: %d\n",
3197 		__func__, bm_usb_state, mA);
3198 
3199 	spin_lock(&di->usb_state.usb_lock);
3200 	di->usb_state.state_tmp = bm_usb_state;
3201 	di->usb_state.usb_current_tmp = mA;
3202 	spin_unlock(&di->usb_state.usb_lock);
3203 
3204 	/*
3205 	 * wait for some time until you get updates from the usb stack
3206 	 * and negotiations are completed
3207 	 */
3208 	queue_delayed_work(di->charger_wq, &di->usb_state_changed_work, HZ/2);
3209 
3210 	return NOTIFY_OK;
3211 }
3212 
3213 static int __maybe_unused ab8500_charger_resume(struct device *dev)
3214 {
3215 	int ret;
3216 	struct ab8500_charger *di = dev_get_drvdata(dev);
3217 
3218 	/*
3219 	 * For ABB revision 1.0 and 1.1 there is a bug in the watchdog
3220 	 * logic. That means we have to continuously kick the charger
3221 	 * watchdog even when no charger is connected. This is only
3222 	 * valid once the AC charger has been enabled. This is
3223 	 * a bug that is not handled by the algorithm and the
3224 	 * watchdog have to be kicked by the charger driver
3225 	 * when the AC charger is disabled
3226 	 */
3227 	if (di->ac_conn && is_ab8500_1p1_or_earlier(di->parent)) {
3228 		ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
3229 			AB8500_CHARG_WD_CTRL, CHARG_WD_KICK);
3230 		if (ret)
3231 			dev_err(di->dev, "Failed to kick WD!\n");
3232 
3233 		/* If not already pending start a new timer */
3234 		queue_delayed_work(di->charger_wq, &di->kick_wd_work,
3235 				   round_jiffies(WD_KICK_INTERVAL));
3236 	}
3237 
3238 	/* If we still have a HW failure, schedule a new check */
3239 	if (di->flags.mainextchnotok || di->flags.vbus_ovv) {
3240 		queue_delayed_work(di->charger_wq,
3241 			&di->check_hw_failure_work, 0);
3242 	}
3243 
3244 	if (di->flags.vbus_drop_end)
3245 		queue_delayed_work(di->charger_wq, &di->vbus_drop_end_work, 0);
3246 
3247 	return 0;
3248 }
3249 
3250 static int __maybe_unused ab8500_charger_suspend(struct device *dev)
3251 {
3252 	struct ab8500_charger *di = dev_get_drvdata(dev);
3253 
3254 	/* Cancel any pending jobs */
3255 	cancel_delayed_work(&di->check_hw_failure_work);
3256 	cancel_delayed_work(&di->vbus_drop_end_work);
3257 
3258 	flush_delayed_work(&di->attach_work);
3259 	flush_delayed_work(&di->usb_charger_attached_work);
3260 	flush_delayed_work(&di->ac_charger_attached_work);
3261 	flush_delayed_work(&di->check_usbchgnotok_work);
3262 	flush_delayed_work(&di->check_vbat_work);
3263 	flush_delayed_work(&di->kick_wd_work);
3264 
3265 	flush_work(&di->usb_link_status_work);
3266 	flush_work(&di->ac_work);
3267 	flush_work(&di->detect_usb_type_work);
3268 
3269 	if (atomic_read(&di->current_stepping_sessions))
3270 		return -EAGAIN;
3271 
3272 	return 0;
3273 }
3274 
3275 static struct notifier_block charger_nb = {
3276 	.notifier_call = ab8500_external_charger_prepare,
3277 };
3278 
3279 static int ab8500_charger_remove(struct platform_device *pdev)
3280 {
3281 	struct ab8500_charger *di = platform_get_drvdata(pdev);
3282 	int i, irq, ret;
3283 
3284 	/* Disable AC charging */
3285 	ab8500_charger_ac_en(&di->ac_chg, false, 0, 0);
3286 
3287 	/* Disable USB charging */
3288 	ab8500_charger_usb_en(&di->usb_chg, false, 0, 0);
3289 
3290 	/* Disable interrupts */
3291 	for (i = 0; i < ARRAY_SIZE(ab8500_charger_irq); i++) {
3292 		irq = platform_get_irq_byname(pdev, ab8500_charger_irq[i].name);
3293 		free_irq(irq, di);
3294 	}
3295 
3296 	/* Backup battery voltage and current disable */
3297 	ret = abx500_mask_and_set_register_interruptible(di->dev,
3298 		AB8500_RTC, AB8500_RTC_CTRL_REG, RTC_BUP_CH_ENA, 0);
3299 	if (ret < 0)
3300 		dev_err(di->dev, "%s mask and set failed\n", __func__);
3301 
3302 	usb_unregister_notifier(di->usb_phy, &di->nb);
3303 	usb_put_phy(di->usb_phy);
3304 
3305 	/* Delete the work queue */
3306 	destroy_workqueue(di->charger_wq);
3307 
3308 	/* Unregister external charger enable notifier */
3309 	if (!di->ac_chg.enabled)
3310 		blocking_notifier_chain_unregister(
3311 			&charger_notifier_list, &charger_nb);
3312 
3313 	flush_scheduled_work();
3314 	if (di->usb_chg.enabled)
3315 		power_supply_unregister(di->usb_chg.psy);
3316 
3317 	if (di->ac_chg.enabled && !di->ac_chg.external)
3318 		power_supply_unregister(di->ac_chg.psy);
3319 
3320 	return 0;
3321 }
3322 
3323 static char *supply_interface[] = {
3324 	"ab8500_chargalg",
3325 	"ab8500_fg",
3326 	"ab8500_btemp",
3327 };
3328 
3329 static const struct power_supply_desc ab8500_ac_chg_desc = {
3330 	.name		= "ab8500_ac",
3331 	.type		= POWER_SUPPLY_TYPE_MAINS,
3332 	.properties	= ab8500_charger_ac_props,
3333 	.num_properties	= ARRAY_SIZE(ab8500_charger_ac_props),
3334 	.get_property	= ab8500_charger_ac_get_property,
3335 };
3336 
3337 static const struct power_supply_desc ab8500_usb_chg_desc = {
3338 	.name		= "ab8500_usb",
3339 	.type		= POWER_SUPPLY_TYPE_USB,
3340 	.properties	= ab8500_charger_usb_props,
3341 	.num_properties	= ARRAY_SIZE(ab8500_charger_usb_props),
3342 	.get_property	= ab8500_charger_usb_get_property,
3343 };
3344 
3345 static int ab8500_charger_probe(struct platform_device *pdev)
3346 {
3347 	struct device_node *np = pdev->dev.of_node;
3348 	struct power_supply_config ac_psy_cfg = {}, usb_psy_cfg = {};
3349 	struct ab8500_charger *di;
3350 	int irq, i, charger_status, ret = 0, ch_stat;
3351 	struct device *dev = &pdev->dev;
3352 
3353 	di = devm_kzalloc(dev, sizeof(*di), GFP_KERNEL);
3354 	if (!di)
3355 		return -ENOMEM;
3356 
3357 	di->bm = &ab8500_bm_data;
3358 
3359 	ret = ab8500_bm_of_probe(dev, np, di->bm);
3360 	if (ret) {
3361 		dev_err(dev, "failed to get battery information\n");
3362 		return ret;
3363 	}
3364 	di->autopower_cfg = of_property_read_bool(np, "autopower_cfg");
3365 
3366 	/* get parent data */
3367 	di->dev = dev;
3368 	di->parent = dev_get_drvdata(pdev->dev.parent);
3369 
3370 	/* Get ADC channels */
3371 	di->adc_main_charger_v = devm_iio_channel_get(dev, "main_charger_v");
3372 	if (IS_ERR(di->adc_main_charger_v)) {
3373 		ret = dev_err_probe(dev, PTR_ERR(di->adc_main_charger_v),
3374 				    "failed to get ADC main charger voltage\n");
3375 		return ret;
3376 	}
3377 	di->adc_main_charger_c = devm_iio_channel_get(dev, "main_charger_c");
3378 	if (IS_ERR(di->adc_main_charger_c)) {
3379 		ret = dev_err_probe(dev, PTR_ERR(di->adc_main_charger_c),
3380 				    "failed to get ADC main charger current\n");
3381 		return ret;
3382 	}
3383 	di->adc_vbus_v = devm_iio_channel_get(dev, "vbus_v");
3384 	if (IS_ERR(di->adc_vbus_v)) {
3385 		ret = dev_err_probe(dev, PTR_ERR(di->adc_vbus_v),
3386 				    "failed to get ADC USB charger voltage\n");
3387 		return ret;
3388 	}
3389 	di->adc_usb_charger_c = devm_iio_channel_get(dev, "usb_charger_c");
3390 	if (IS_ERR(di->adc_usb_charger_c)) {
3391 		ret = dev_err_probe(dev, PTR_ERR(di->adc_usb_charger_c),
3392 				    "failed to get ADC USB charger current\n");
3393 		return ret;
3394 	}
3395 
3396 	/* initialize lock */
3397 	spin_lock_init(&di->usb_state.usb_lock);
3398 	mutex_init(&di->usb_ipt_crnt_lock);
3399 
3400 	di->autopower = false;
3401 	di->invalid_charger_detect_state = 0;
3402 
3403 	/* AC and USB supply config */
3404 	ac_psy_cfg.supplied_to = supply_interface;
3405 	ac_psy_cfg.num_supplicants = ARRAY_SIZE(supply_interface);
3406 	ac_psy_cfg.drv_data = &di->ac_chg;
3407 	usb_psy_cfg.supplied_to = supply_interface;
3408 	usb_psy_cfg.num_supplicants = ARRAY_SIZE(supply_interface);
3409 	usb_psy_cfg.drv_data = &di->usb_chg;
3410 
3411 	/* AC supply */
3412 	/* ux500_charger sub-class */
3413 	di->ac_chg.ops.enable = &ab8500_charger_ac_en;
3414 	di->ac_chg.ops.check_enable = &ab8500_charger_ac_check_enable;
3415 	di->ac_chg.ops.kick_wd = &ab8500_charger_watchdog_kick;
3416 	di->ac_chg.ops.update_curr = &ab8500_charger_update_charger_current;
3417 	di->ac_chg.max_out_volt = ab8500_charger_voltage_map[
3418 		ARRAY_SIZE(ab8500_charger_voltage_map) - 1];
3419 	di->ac_chg.max_out_curr =
3420 		di->bm->chg_output_curr[di->bm->n_chg_out_curr - 1];
3421 	di->ac_chg.wdt_refresh = CHG_WD_INTERVAL;
3422 	di->ac_chg.enabled = di->bm->ac_enabled;
3423 	di->ac_chg.external = false;
3424 
3425 	/*notifier for external charger enabling*/
3426 	if (!di->ac_chg.enabled)
3427 		blocking_notifier_chain_register(
3428 			&charger_notifier_list, &charger_nb);
3429 
3430 	/* USB supply */
3431 	/* ux500_charger sub-class */
3432 	di->usb_chg.ops.enable = &ab8500_charger_usb_en;
3433 	di->usb_chg.ops.check_enable = &ab8500_charger_usb_check_enable;
3434 	di->usb_chg.ops.kick_wd = &ab8500_charger_watchdog_kick;
3435 	di->usb_chg.ops.update_curr = &ab8500_charger_update_charger_current;
3436 	di->usb_chg.max_out_volt = ab8500_charger_voltage_map[
3437 		ARRAY_SIZE(ab8500_charger_voltage_map) - 1];
3438 	di->usb_chg.max_out_curr =
3439 		di->bm->chg_output_curr[di->bm->n_chg_out_curr - 1];
3440 	di->usb_chg.wdt_refresh = CHG_WD_INTERVAL;
3441 	di->usb_chg.enabled = di->bm->usb_enabled;
3442 	di->usb_chg.external = false;
3443 	di->usb_state.usb_current = -1;
3444 
3445 	/* Create a work queue for the charger */
3446 	di->charger_wq = alloc_ordered_workqueue("ab8500_charger_wq",
3447 						 WQ_MEM_RECLAIM);
3448 	if (di->charger_wq == NULL) {
3449 		dev_err(dev, "failed to create work queue\n");
3450 		return -ENOMEM;
3451 	}
3452 
3453 	mutex_init(&di->charger_attached_mutex);
3454 
3455 	/* Init work for HW failure check */
3456 	INIT_DEFERRABLE_WORK(&di->check_hw_failure_work,
3457 		ab8500_charger_check_hw_failure_work);
3458 	INIT_DEFERRABLE_WORK(&di->check_usbchgnotok_work,
3459 		ab8500_charger_check_usbchargernotok_work);
3460 
3461 	INIT_DELAYED_WORK(&di->ac_charger_attached_work,
3462 			  ab8500_charger_ac_attached_work);
3463 	INIT_DELAYED_WORK(&di->usb_charger_attached_work,
3464 			  ab8500_charger_usb_attached_work);
3465 
3466 	/*
3467 	 * For ABB revision 1.0 and 1.1 there is a bug in the watchdog
3468 	 * logic. That means we have to continuously kick the charger
3469 	 * watchdog even when no charger is connected. This is only
3470 	 * valid once the AC charger has been enabled. This is
3471 	 * a bug that is not handled by the algorithm and the
3472 	 * watchdog have to be kicked by the charger driver
3473 	 * when the AC charger is disabled
3474 	 */
3475 	INIT_DEFERRABLE_WORK(&di->kick_wd_work,
3476 		ab8500_charger_kick_watchdog_work);
3477 
3478 	INIT_DEFERRABLE_WORK(&di->check_vbat_work,
3479 		ab8500_charger_check_vbat_work);
3480 
3481 	INIT_DELAYED_WORK(&di->attach_work,
3482 		ab8500_charger_usb_link_attach_work);
3483 
3484 	INIT_DELAYED_WORK(&di->usb_state_changed_work,
3485 		ab8500_charger_usb_state_changed_work);
3486 
3487 	INIT_DELAYED_WORK(&di->vbus_drop_end_work,
3488 		ab8500_charger_vbus_drop_end_work);
3489 
3490 	/* Init work for charger detection */
3491 	INIT_WORK(&di->usb_link_status_work,
3492 		ab8500_charger_usb_link_status_work);
3493 	INIT_WORK(&di->ac_work, ab8500_charger_ac_work);
3494 	INIT_WORK(&di->detect_usb_type_work,
3495 		ab8500_charger_detect_usb_type_work);
3496 
3497 	/* Init work for checking HW status */
3498 	INIT_WORK(&di->check_main_thermal_prot_work,
3499 		ab8500_charger_check_main_thermal_prot_work);
3500 	INIT_WORK(&di->check_usb_thermal_prot_work,
3501 		ab8500_charger_check_usb_thermal_prot_work);
3502 
3503 	/*
3504 	 * VDD ADC supply needs to be enabled from this driver when there
3505 	 * is a charger connected to avoid erroneous BTEMP_HIGH/LOW
3506 	 * interrupts during charging
3507 	 */
3508 	di->regu = devm_regulator_get(dev, "vddadc");
3509 	if (IS_ERR(di->regu)) {
3510 		ret = PTR_ERR(di->regu);
3511 		dev_err(dev, "failed to get vddadc regulator\n");
3512 		goto free_charger_wq;
3513 	}
3514 
3515 
3516 	/* Initialize OVV, and other registers */
3517 	ret = ab8500_charger_init_hw_registers(di);
3518 	if (ret) {
3519 		dev_err(dev, "failed to initialize ABB registers\n");
3520 		goto free_charger_wq;
3521 	}
3522 
3523 	/* Register AC charger class */
3524 	if (di->ac_chg.enabled) {
3525 		di->ac_chg.psy = power_supply_register(dev,
3526 						       &ab8500_ac_chg_desc,
3527 						       &ac_psy_cfg);
3528 		if (IS_ERR(di->ac_chg.psy)) {
3529 			dev_err(dev, "failed to register AC charger\n");
3530 			ret = PTR_ERR(di->ac_chg.psy);
3531 			goto free_charger_wq;
3532 		}
3533 	}
3534 
3535 	/* Register USB charger class */
3536 	if (di->usb_chg.enabled) {
3537 		di->usb_chg.psy = power_supply_register(dev,
3538 							&ab8500_usb_chg_desc,
3539 							&usb_psy_cfg);
3540 		if (IS_ERR(di->usb_chg.psy)) {
3541 			dev_err(dev, "failed to register USB charger\n");
3542 			ret = PTR_ERR(di->usb_chg.psy);
3543 			goto free_ac;
3544 		}
3545 	}
3546 
3547 	di->usb_phy = usb_get_phy(USB_PHY_TYPE_USB2);
3548 	if (IS_ERR_OR_NULL(di->usb_phy)) {
3549 		dev_err(dev, "failed to get usb transceiver\n");
3550 		ret = -EINVAL;
3551 		goto free_usb;
3552 	}
3553 	di->nb.notifier_call = ab8500_charger_usb_notifier_call;
3554 	ret = usb_register_notifier(di->usb_phy, &di->nb);
3555 	if (ret) {
3556 		dev_err(dev, "failed to register usb notifier\n");
3557 		goto put_usb_phy;
3558 	}
3559 
3560 	/* Identify the connected charger types during startup */
3561 	charger_status = ab8500_charger_detect_chargers(di, true);
3562 	if (charger_status & AC_PW_CONN) {
3563 		di->ac.charger_connected = 1;
3564 		di->ac_conn = true;
3565 		ab8500_power_supply_changed(di, di->ac_chg.psy);
3566 		sysfs_notify(&di->ac_chg.psy->dev.kobj, NULL, "present");
3567 	}
3568 
3569 	if (charger_status & USB_PW_CONN) {
3570 		di->vbus_detected = true;
3571 		di->vbus_detected_start = true;
3572 		queue_work(di->charger_wq,
3573 			&di->detect_usb_type_work);
3574 	}
3575 
3576 	/* Register interrupts */
3577 	for (i = 0; i < ARRAY_SIZE(ab8500_charger_irq); i++) {
3578 		irq = platform_get_irq_byname(pdev, ab8500_charger_irq[i].name);
3579 		if (irq < 0) {
3580 			ret = irq;
3581 			goto free_irq;
3582 		}
3583 
3584 		ret = request_threaded_irq(irq, NULL, ab8500_charger_irq[i].isr,
3585 			IRQF_SHARED | IRQF_NO_SUSPEND | IRQF_ONESHOT,
3586 			ab8500_charger_irq[i].name, di);
3587 
3588 		if (ret != 0) {
3589 			dev_err(dev, "failed to request %s IRQ %d: %d\n"
3590 				, ab8500_charger_irq[i].name, irq, ret);
3591 			goto free_irq;
3592 		}
3593 		dev_dbg(dev, "Requested %s IRQ %d: %d\n",
3594 			ab8500_charger_irq[i].name, irq, ret);
3595 	}
3596 
3597 	platform_set_drvdata(pdev, di);
3598 
3599 	mutex_lock(&di->charger_attached_mutex);
3600 
3601 	ch_stat = ab8500_charger_detect_chargers(di, false);
3602 
3603 	if ((ch_stat & AC_PW_CONN) == AC_PW_CONN) {
3604 		if (is_ab8500(di->parent))
3605 			queue_delayed_work(di->charger_wq,
3606 					   &di->ac_charger_attached_work,
3607 					   HZ);
3608 	}
3609 	if ((ch_stat & USB_PW_CONN) == USB_PW_CONN) {
3610 		if (is_ab8500(di->parent))
3611 			queue_delayed_work(di->charger_wq,
3612 					   &di->usb_charger_attached_work,
3613 					   HZ);
3614 	}
3615 
3616 	mutex_unlock(&di->charger_attached_mutex);
3617 
3618 	return ret;
3619 
3620 free_irq:
3621 	usb_unregister_notifier(di->usb_phy, &di->nb);
3622 
3623 	/* We also have to free all successfully registered irqs */
3624 	for (i = i - 1; i >= 0; i--) {
3625 		irq = platform_get_irq_byname(pdev, ab8500_charger_irq[i].name);
3626 		free_irq(irq, di);
3627 	}
3628 put_usb_phy:
3629 	usb_put_phy(di->usb_phy);
3630 free_usb:
3631 	if (di->usb_chg.enabled)
3632 		power_supply_unregister(di->usb_chg.psy);
3633 free_ac:
3634 	if (di->ac_chg.enabled)
3635 		power_supply_unregister(di->ac_chg.psy);
3636 free_charger_wq:
3637 	destroy_workqueue(di->charger_wq);
3638 	return ret;
3639 }
3640 
3641 static SIMPLE_DEV_PM_OPS(ab8500_charger_pm_ops, ab8500_charger_suspend, ab8500_charger_resume);
3642 
3643 static const struct of_device_id ab8500_charger_match[] = {
3644 	{ .compatible = "stericsson,ab8500-charger", },
3645 	{ },
3646 };
3647 
3648 static struct platform_driver ab8500_charger_driver = {
3649 	.probe = ab8500_charger_probe,
3650 	.remove = ab8500_charger_remove,
3651 	.driver = {
3652 		.name = "ab8500-charger",
3653 		.of_match_table = ab8500_charger_match,
3654 		.pm = &ab8500_charger_pm_ops,
3655 	},
3656 };
3657 
3658 static int __init ab8500_charger_init(void)
3659 {
3660 	return platform_driver_register(&ab8500_charger_driver);
3661 }
3662 
3663 static void __exit ab8500_charger_exit(void)
3664 {
3665 	platform_driver_unregister(&ab8500_charger_driver);
3666 }
3667 
3668 subsys_initcall_sync(ab8500_charger_init);
3669 module_exit(ab8500_charger_exit);
3670 
3671 MODULE_LICENSE("GPL v2");
3672 MODULE_AUTHOR("Johan Palsson, Karl Komierowski, Arun R Murthy");
3673 MODULE_ALIAS("platform:ab8500-charger");
3674 MODULE_DESCRIPTION("AB8500 charger management driver");
3675