Blame view

drivers/power/da9150-charger.c 17.1 KB
c1a281e34   Adam Thomson   power: Add suppor...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
  /*
   * DA9150 Charger Driver
   *
   * Copyright (c) 2014 Dialog Semiconductor
   *
   * Author: Adam Thomson <Adam.Thomson.Opensource@diasemi.com>
   *
   * This program is free software; you can redistribute  it and/or modify it
   * under  the terms of  the GNU General  Public License as published by the
   * Free Software Foundation;  either version 2 of the  License, or (at your
   * option) any later version.
   */
  
  #include <linux/kernel.h>
  #include <linux/slab.h>
  #include <linux/module.h>
  #include <linux/platform_device.h>
  #include <linux/of.h>
  #include <linux/of_platform.h>
  #include <linux/interrupt.h>
  #include <linux/power_supply.h>
  #include <linux/notifier.h>
  #include <linux/usb/phy.h>
  #include <linux/iio/consumer.h>
  #include <linux/mfd/da9150/core.h>
  #include <linux/mfd/da9150/registers.h>
  
  /* Private data */
  struct da9150_charger {
  	struct da9150 *da9150;
  	struct device *dev;
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
32
33
  	struct power_supply *usb;
  	struct power_supply *battery;
c1a281e34   Adam Thomson   power: Add suppor...
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
  	struct power_supply *supply_online;
  
  	struct usb_phy *usb_phy;
  	struct notifier_block otg_nb;
  	struct work_struct otg_work;
  	unsigned long usb_event;
  
  	struct iio_channel *ibus_chan;
  	struct iio_channel *vbus_chan;
  	struct iio_channel *tjunc_chan;
  	struct iio_channel *vbat_chan;
  };
  
  static inline int da9150_charger_supply_online(struct da9150_charger *charger,
  					       struct power_supply *psy,
  					       union power_supply_propval *val)
  {
  	val->intval = (psy == charger->supply_online) ? 1 : 0;
  
  	return 0;
  }
  
  /* Charger Properties */
  static int da9150_charger_vbus_voltage_now(struct da9150_charger *charger,
  					   union power_supply_propval *val)
  {
  	int v_val, ret;
  
  	/* Read processed value - mV units */
  	ret = iio_read_channel_processed(charger->vbus_chan, &v_val);
  	if (ret < 0)
  		return ret;
  
  	/* Convert voltage to expected uV units */
  	val->intval = v_val * 1000;
  
  	return 0;
  }
  
  static int da9150_charger_ibus_current_avg(struct da9150_charger *charger,
  					   union power_supply_propval *val)
  {
  	int i_val, ret;
  
  	/* Read processed value - mA units */
  	ret = iio_read_channel_processed(charger->ibus_chan, &i_val);
  	if (ret < 0)
  		return ret;
  
  	/* Convert current to expected uA units */
  	val->intval = i_val * 1000;
  
  	return 0;
  }
  
  static int da9150_charger_tjunc_temp(struct da9150_charger *charger,
  				     union power_supply_propval *val)
  {
  	int t_val, ret;
  
  	/* Read processed value - 0.001 degrees C units */
  	ret = iio_read_channel_processed(charger->tjunc_chan, &t_val);
  	if (ret < 0)
  		return ret;
  
  	/* Convert temp to expect 0.1 degrees C units */
  	val->intval = t_val / 100;
  
  	return 0;
  }
  
  static enum power_supply_property da9150_charger_props[] = {
  	POWER_SUPPLY_PROP_ONLINE,
  	POWER_SUPPLY_PROP_VOLTAGE_NOW,
  	POWER_SUPPLY_PROP_CURRENT_AVG,
  	POWER_SUPPLY_PROP_TEMP,
  };
  
  static int da9150_charger_get_prop(struct power_supply *psy,
  				   enum power_supply_property psp,
  				   union power_supply_propval *val)
  {
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
116
  	struct da9150_charger *charger = dev_get_drvdata(psy->dev.parent);
c1a281e34   Adam Thomson   power: Add suppor...
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
  	int ret;
  
  	switch (psp) {
  	case POWER_SUPPLY_PROP_ONLINE:
  		ret = da9150_charger_supply_online(charger, psy, val);
  		break;
  	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  		ret = da9150_charger_vbus_voltage_now(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_CURRENT_AVG:
  		ret = da9150_charger_ibus_current_avg(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_TEMP:
  		ret = da9150_charger_tjunc_temp(charger, val);
  		break;
  	default:
  		ret = -EINVAL;
  		break;
  	}
  
  	return ret;
  }
  
  /* Battery Properties */
  static int da9150_charger_battery_status(struct da9150_charger *charger,
  					 union power_supply_propval *val)
  {
  	u8 reg;
  
  	/* Check to see if battery is discharging */
  	reg = da9150_reg_read(charger->da9150, DA9150_STATUS_H);
  
  	if (((reg & DA9150_VBUS_STAT_MASK) == DA9150_VBUS_STAT_OFF) ||
  	    ((reg & DA9150_VBUS_STAT_MASK) == DA9150_VBUS_STAT_WAIT)) {
  		val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  
  		return 0;
  	}
  
  	reg = da9150_reg_read(charger->da9150, DA9150_STATUS_J);
  
  	/* Now check for other states */
  	switch (reg & DA9150_CHG_STAT_MASK) {
  	case DA9150_CHG_STAT_ACT:
  	case DA9150_CHG_STAT_PRE:
  	case DA9150_CHG_STAT_CC:
  	case DA9150_CHG_STAT_CV:
  		val->intval = POWER_SUPPLY_STATUS_CHARGING;
  		break;
  	case DA9150_CHG_STAT_OFF:
  	case DA9150_CHG_STAT_SUSP:
  	case DA9150_CHG_STAT_TEMP:
  	case DA9150_CHG_STAT_TIME:
  	case DA9150_CHG_STAT_BAT:
  		val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
  		break;
  	case DA9150_CHG_STAT_FULL:
  		val->intval = POWER_SUPPLY_STATUS_FULL;
  		break;
  	default:
  		val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
  		break;
  	}
  
  	return 0;
  }
  
  static int da9150_charger_battery_health(struct da9150_charger *charger,
  					 union power_supply_propval *val)
  {
  	u8 reg;
  
  	reg = da9150_reg_read(charger->da9150, DA9150_STATUS_J);
  
  	/* Check if temperature limit reached */
  	switch (reg & DA9150_CHG_TEMP_MASK) {
  	case DA9150_CHG_TEMP_UNDER:
  		val->intval = POWER_SUPPLY_HEALTH_COLD;
  		return 0;
  	case DA9150_CHG_TEMP_OVER:
  		val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
  		return 0;
  	default:
  		break;
  	}
  
  	/* Check for other health states */
  	switch (reg & DA9150_CHG_STAT_MASK) {
  	case DA9150_CHG_STAT_ACT:
  	case DA9150_CHG_STAT_PRE:
  		val->intval = POWER_SUPPLY_HEALTH_DEAD;
  		break;
  	case DA9150_CHG_STAT_TIME:
  		val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
  		break;
  	default:
  		val->intval = POWER_SUPPLY_HEALTH_GOOD;
  		break;
  	}
  
  	return 0;
  }
  
  static int da9150_charger_battery_present(struct da9150_charger *charger,
  					  union power_supply_propval *val)
  {
  	u8 reg;
  
  	/* Check if battery present or removed */
  	reg = da9150_reg_read(charger->da9150, DA9150_STATUS_J);
  	if ((reg & DA9150_CHG_STAT_MASK) == DA9150_CHG_STAT_BAT)
  		val->intval = 0;
  	else
  		val->intval = 1;
  
  	return 0;
  }
  
  static int da9150_charger_battery_charge_type(struct da9150_charger *charger,
  					      union power_supply_propval *val)
  {
  	u8 reg;
  
  	reg = da9150_reg_read(charger->da9150, DA9150_STATUS_J);
  
  	switch (reg & DA9150_CHG_STAT_MASK) {
  	case DA9150_CHG_STAT_CC:
  		val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST;
  		break;
  	case DA9150_CHG_STAT_ACT:
  	case DA9150_CHG_STAT_PRE:
  	case DA9150_CHG_STAT_CV:
  		val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
  		break;
  	default:
  		val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
  		break;
  	}
  
  	return 0;
  }
  
  static int da9150_charger_battery_voltage_min(struct da9150_charger *charger,
  					      union power_supply_propval *val)
  {
  	u8 reg;
  
  	reg = da9150_reg_read(charger->da9150, DA9150_PPR_CHGCTRL_C);
  
  	/* Value starts at 2500 mV, 50 mV increments, presented in uV */
  	val->intval = ((reg & DA9150_CHG_VFAULT_MASK) * 50000) + 2500000;
  
  	return 0;
  }
  
  static int da9150_charger_battery_voltage_now(struct da9150_charger *charger,
  					      union power_supply_propval *val)
  {
  	int v_val, ret;
  
  	/* Read processed value - mV units */
  	ret = iio_read_channel_processed(charger->vbat_chan, &v_val);
  	if (ret < 0)
  		return ret;
  
  	val->intval = v_val * 1000;
  
  	return 0;
  }
  
  static int da9150_charger_battery_current_max(struct da9150_charger *charger,
  					      union power_supply_propval *val)
  {
  	int reg;
  
  	reg = da9150_reg_read(charger->da9150, DA9150_PPR_CHGCTRL_D);
  
  	/* 25mA increments */
  	val->intval = reg * 25000;
  
  	return 0;
  }
  
  static int da9150_charger_battery_voltage_max(struct da9150_charger *charger,
  					      union power_supply_propval *val)
  {
  	u8 reg;
  
  	reg = da9150_reg_read(charger->da9150, DA9150_PPR_CHGCTRL_B);
  
  	/* Value starts at 3650 mV, 25 mV increments, presented in uV */
  	val->intval = ((reg & DA9150_CHG_VBAT_MASK) * 25000) + 3650000;
  	return 0;
  }
  
  static enum power_supply_property da9150_charger_bat_props[] = {
  	POWER_SUPPLY_PROP_STATUS,
  	POWER_SUPPLY_PROP_ONLINE,
  	POWER_SUPPLY_PROP_HEALTH,
  	POWER_SUPPLY_PROP_PRESENT,
  	POWER_SUPPLY_PROP_CHARGE_TYPE,
  	POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
  	POWER_SUPPLY_PROP_VOLTAGE_NOW,
  	POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
  	POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
  };
  
  static int da9150_charger_battery_get_prop(struct power_supply *psy,
  					   enum power_supply_property psp,
  					   union power_supply_propval *val)
  {
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
328
  	struct da9150_charger *charger = dev_get_drvdata(psy->dev.parent);
c1a281e34   Adam Thomson   power: Add suppor...
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
  	int ret;
  
  	switch (psp) {
  	case POWER_SUPPLY_PROP_STATUS:
  		ret = da9150_charger_battery_status(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_ONLINE:
  		ret = da9150_charger_supply_online(charger, psy, val);
  		break;
  	case POWER_SUPPLY_PROP_HEALTH:
  		ret = da9150_charger_battery_health(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_PRESENT:
  		ret = da9150_charger_battery_present(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_CHARGE_TYPE:
  		ret = da9150_charger_battery_charge_type(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
  		ret = da9150_charger_battery_voltage_min(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  		ret = da9150_charger_battery_voltage_now(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
  		ret = da9150_charger_battery_current_max(charger, val);
  		break;
  	case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
  		ret = da9150_charger_battery_voltage_max(charger, val);
  		break;
  	default:
  		ret = -EINVAL;
  		break;
  	}
  
  	return ret;
  }
  
  static irqreturn_t da9150_charger_chg_irq(int irq, void *data)
  {
  	struct da9150_charger *charger = data;
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
370
  	power_supply_changed(charger->battery);
c1a281e34   Adam Thomson   power: Add suppor...
371
372
373
374
375
376
377
378
379
380
381
  
  	return IRQ_HANDLED;
  }
  
  static irqreturn_t da9150_charger_tjunc_irq(int irq, void *data)
  {
  	struct da9150_charger *charger = data;
  
  	/* Nothing we can really do except report this. */
  	dev_crit(charger->dev, "TJunc over temperature!!!
  ");
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
382
  	power_supply_changed(charger->usb);
c1a281e34   Adam Thomson   power: Add suppor...
383
384
385
386
387
388
389
390
391
392
393
  
  	return IRQ_HANDLED;
  }
  
  static irqreturn_t da9150_charger_vfault_irq(int irq, void *data)
  {
  	struct da9150_charger *charger = data;
  
  	/* Nothing we can really do except report this. */
  	dev_crit(charger->dev, "VSYS under voltage!!!
  ");
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
394
395
  	power_supply_changed(charger->usb);
  	power_supply_changed(charger->battery);
c1a281e34   Adam Thomson   power: Add suppor...
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
  
  	return IRQ_HANDLED;
  }
  
  static irqreturn_t da9150_charger_vbus_irq(int irq, void *data)
  {
  	struct da9150_charger *charger = data;
  	u8 reg;
  
  	reg = da9150_reg_read(charger->da9150, DA9150_STATUS_H);
  
  	/* Charger plugged in or battery only */
  	switch (reg & DA9150_VBUS_STAT_MASK) {
  	case DA9150_VBUS_STAT_OFF:
  	case DA9150_VBUS_STAT_WAIT:
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
411
  		charger->supply_online = charger->battery;
c1a281e34   Adam Thomson   power: Add suppor...
412
413
  		break;
  	case DA9150_VBUS_STAT_CHG:
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
414
  		charger->supply_online = charger->usb;
c1a281e34   Adam Thomson   power: Add suppor...
415
416
417
418
419
420
421
422
  		break;
  	default:
  		dev_warn(charger->dev, "Unknown VBUS state - reg = 0x%x
  ",
  			 reg);
  		charger->supply_online = NULL;
  		break;
  	}
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
423
424
  	power_supply_changed(charger->usb);
  	power_supply_changed(charger->battery);
c1a281e34   Adam Thomson   power: Add suppor...
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
  
  	return IRQ_HANDLED;
  }
  
  static void da9150_charger_otg_work(struct work_struct *data)
  {
  	struct da9150_charger *charger =
  		container_of(data, struct da9150_charger, otg_work);
  
  	switch (charger->usb_event) {
  	case USB_EVENT_ID:
  		/* Enable OTG Boost */
  		da9150_set_bits(charger->da9150, DA9150_PPR_BKCTRL_A,
  				DA9150_VBUS_MODE_MASK, DA9150_VBUS_MODE_OTG);
  		break;
  	case USB_EVENT_NONE:
  		/* Revert to charge mode */
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
442
443
  		power_supply_changed(charger->usb);
  		power_supply_changed(charger->battery);
c1a281e34   Adam Thomson   power: Add suppor...
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
  		da9150_set_bits(charger->da9150, DA9150_PPR_BKCTRL_A,
  				DA9150_VBUS_MODE_MASK, DA9150_VBUS_MODE_CHG);
  		break;
  	}
  }
  
  static int da9150_charger_otg_ncb(struct notifier_block *nb, unsigned long val,
  				  void *priv)
  {
  	struct da9150_charger *charger =
  		container_of(nb, struct da9150_charger, otg_nb);
  
  	dev_dbg(charger->dev, "DA9150 OTG notify %lu
  ", val);
  
  	charger->usb_event = val;
  	schedule_work(&charger->otg_work);
  
  	return NOTIFY_OK;
  }
  
  static int da9150_charger_register_irq(struct platform_device *pdev,
  				       irq_handler_t handler,
  				       const char *irq_name)
  {
  	struct device *dev = &pdev->dev;
  	struct da9150_charger *charger = platform_get_drvdata(pdev);
  	int irq, ret;
  
  	irq = platform_get_irq_byname(pdev, irq_name);
  	if (irq < 0) {
  		dev_err(dev, "Failed to get IRQ CHG_STATUS: %d
  ", irq);
  		return irq;
  	}
  
  	ret = request_threaded_irq(irq, NULL, handler, IRQF_ONESHOT, irq_name,
  				   charger);
  	if (ret)
  		dev_err(dev, "Failed to request IRQ %d: %d
  ", irq, ret);
  
  	return ret;
  }
  
  static void da9150_charger_unregister_irq(struct platform_device *pdev,
  					  const char *irq_name)
  {
  	struct device *dev = &pdev->dev;
  	struct da9150_charger *charger = platform_get_drvdata(pdev);
  	int irq;
  
  	irq = platform_get_irq_byname(pdev, irq_name);
  	if (irq < 0) {
  		dev_err(dev, "Failed to get IRQ CHG_STATUS: %d
  ", irq);
  		return;
  	}
  
  	free_irq(irq, charger);
  }
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
  static const struct power_supply_desc usb_desc = {
  	.name		= "da9150-usb",
  	.type		= POWER_SUPPLY_TYPE_USB,
  	.properties	= da9150_charger_props,
  	.num_properties	= ARRAY_SIZE(da9150_charger_props),
  	.get_property	= da9150_charger_get_prop,
  };
  
  static const struct power_supply_desc battery_desc = {
  	.name		= "da9150-battery",
  	.type		= POWER_SUPPLY_TYPE_BATTERY,
  	.properties	= da9150_charger_bat_props,
  	.num_properties	= ARRAY_SIZE(da9150_charger_bat_props),
  	.get_property	= da9150_charger_battery_get_prop,
  };
c1a281e34   Adam Thomson   power: Add suppor...
520
521
522
523
524
  static int da9150_charger_probe(struct platform_device *pdev)
  {
  	struct device *dev = &pdev->dev;
  	struct da9150 *da9150 = dev_get_drvdata(dev->parent);
  	struct da9150_charger *charger;
c1a281e34   Adam Thomson   power: Add suppor...
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
  	u8 reg;
  	int ret;
  
  	charger = devm_kzalloc(dev, sizeof(struct da9150_charger), GFP_KERNEL);
  	if (!charger)
  		return -ENOMEM;
  
  	platform_set_drvdata(pdev, charger);
  	charger->da9150 = da9150;
  	charger->dev = dev;
  
  	/* Acquire ADC channels */
  	charger->ibus_chan = iio_channel_get(dev, "CHAN_IBUS");
  	if (IS_ERR(charger->ibus_chan)) {
  		ret = PTR_ERR(charger->ibus_chan);
  		goto ibus_chan_fail;
  	}
  
  	charger->vbus_chan = iio_channel_get(dev, "CHAN_VBUS");
  	if (IS_ERR(charger->vbus_chan)) {
  		ret = PTR_ERR(charger->vbus_chan);
  		goto vbus_chan_fail;
  	}
  
  	charger->tjunc_chan = iio_channel_get(dev, "CHAN_TJUNC");
  	if (IS_ERR(charger->tjunc_chan)) {
  		ret = PTR_ERR(charger->tjunc_chan);
  		goto tjunc_chan_fail;
  	}
  
  	charger->vbat_chan = iio_channel_get(dev, "CHAN_VBAT");
  	if (IS_ERR(charger->vbat_chan)) {
  		ret = PTR_ERR(charger->vbat_chan);
  		goto vbat_chan_fail;
  	}
  
  	/* Register power supplies */
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
562
563
564
  	charger->usb = power_supply_register(dev, &usb_desc, NULL);
  	if (IS_ERR(charger->usb)) {
  		ret = PTR_ERR(charger->usb);
c1a281e34   Adam Thomson   power: Add suppor...
565
  		goto usb_fail;
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
566
  	}
c1a281e34   Adam Thomson   power: Add suppor...
567

297d716f6   Krzysztof Kozlowski   power_supply: Cha...
568
569
570
  	charger->battery = power_supply_register(dev, &battery_desc, NULL);
  	if (IS_ERR(charger->battery)) {
  		ret = PTR_ERR(charger->battery);
c1a281e34   Adam Thomson   power: Add suppor...
571
  		goto battery_fail;
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
572
  	}
c1a281e34   Adam Thomson   power: Add suppor...
573
574
575
576
577
578
579
  
  	/* Get initial online supply */
  	reg = da9150_reg_read(da9150, DA9150_STATUS_H);
  
  	switch (reg & DA9150_VBUS_STAT_MASK) {
  	case DA9150_VBUS_STAT_OFF:
  	case DA9150_VBUS_STAT_WAIT:
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
580
  		charger->supply_online = charger->battery;
c1a281e34   Adam Thomson   power: Add suppor...
581
582
  		break;
  	case DA9150_VBUS_STAT_CHG:
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
583
  		charger->supply_online = charger->usb;
c1a281e34   Adam Thomson   power: Add suppor...
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
  		break;
  	default:
  		dev_warn(dev, "Unknown VBUS state - reg = 0x%x
  ", reg);
  		charger->supply_online = NULL;
  		break;
  	}
  
  	/* Setup OTG reporting & configuration */
  	charger->usb_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2);
  	if (!IS_ERR_OR_NULL(charger->usb_phy)) {
  		INIT_WORK(&charger->otg_work, da9150_charger_otg_work);
  		charger->otg_nb.notifier_call = da9150_charger_otg_ncb;
  		usb_register_notifier(charger->usb_phy, &charger->otg_nb);
  	}
  
  	/* Register IRQs */
  	ret = da9150_charger_register_irq(pdev, da9150_charger_chg_irq,
  					  "CHG_STATUS");
  	if (ret < 0)
  		goto chg_irq_fail;
  
  	ret = da9150_charger_register_irq(pdev, da9150_charger_tjunc_irq,
  					  "CHG_TJUNC");
  	if (ret < 0)
  		goto tjunc_irq_fail;
  
  	ret = da9150_charger_register_irq(pdev, da9150_charger_vfault_irq,
  					  "CHG_VFAULT");
  	if (ret < 0)
  		goto vfault_irq_fail;
  
  	ret = da9150_charger_register_irq(pdev, da9150_charger_vbus_irq,
  					  "CHG_VBUS");
  	if (ret < 0)
  		goto vbus_irq_fail;
  
  	return 0;
  
  
  vbus_irq_fail:
  	da9150_charger_unregister_irq(pdev, "CHG_VFAULT");
  vfault_irq_fail:
  	da9150_charger_unregister_irq(pdev, "CHG_TJUNC");
  tjunc_irq_fail:
  	da9150_charger_unregister_irq(pdev, "CHG_STATUS");
  chg_irq_fail:
  	if (!IS_ERR_OR_NULL(charger->usb_phy))
  		usb_unregister_notifier(charger->usb_phy, &charger->otg_nb);
  battery_fail:
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
634
  	power_supply_unregister(charger->usb);
c1a281e34   Adam Thomson   power: Add suppor...
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
  
  usb_fail:
  	iio_channel_release(charger->vbat_chan);
  
  vbat_chan_fail:
  	iio_channel_release(charger->tjunc_chan);
  
  tjunc_chan_fail:
  	iio_channel_release(charger->vbus_chan);
  
  vbus_chan_fail:
  	iio_channel_release(charger->ibus_chan);
  
  ibus_chan_fail:
  	return ret;
  }
  
  static int da9150_charger_remove(struct platform_device *pdev)
  {
  	struct da9150_charger *charger = platform_get_drvdata(pdev);
  	int irq;
  
  	/* Make sure IRQs are released before unregistering power supplies */
  	irq = platform_get_irq_byname(pdev, "CHG_VBUS");
  	free_irq(irq, charger);
  
  	irq = platform_get_irq_byname(pdev, "CHG_VFAULT");
  	free_irq(irq, charger);
  
  	irq = platform_get_irq_byname(pdev, "CHG_TJUNC");
  	free_irq(irq, charger);
  
  	irq = platform_get_irq_byname(pdev, "CHG_STATUS");
  	free_irq(irq, charger);
  
  	if (!IS_ERR_OR_NULL(charger->usb_phy))
  		usb_unregister_notifier(charger->usb_phy, &charger->otg_nb);
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
672
673
  	power_supply_unregister(charger->battery);
  	power_supply_unregister(charger->usb);
c1a281e34   Adam Thomson   power: Add suppor...
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
  
  	/* Release ADC channels */
  	iio_channel_release(charger->ibus_chan);
  	iio_channel_release(charger->vbus_chan);
  	iio_channel_release(charger->tjunc_chan);
  	iio_channel_release(charger->vbat_chan);
  
  	return 0;
  }
  
  static struct platform_driver da9150_charger_driver = {
  	.driver = {
  		.name = "da9150-charger",
  	},
  	.probe = da9150_charger_probe,
  	.remove = da9150_charger_remove,
  };
  
  module_platform_driver(da9150_charger_driver);
  
  MODULE_DESCRIPTION("Charger Driver for DA9150");
  MODULE_AUTHOR("Adam Thomson <Adam.Thomson.Opensource@diasemi.com>");
  MODULE_LICENSE("GPL");