Blame view

drivers/power/pcf50633-charger.c 12.5 KB
f5714dc97   Balaji Rao   power_supply: PCF...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
  /* NXP PCF50633 Main Battery Charger Driver
   *
   * (C) 2006-2008 by Openmoko, Inc.
   * Author: Balaji Rao <balajirrao@openmoko.org>
   * All rights reserved.
   *
   * Broken down from monstrous PCF50633 driver mainly by
   * Harald Welte, Andy Green and Werner Almesberger
   *
   *  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/module.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
19
  #include <linux/slab.h>
f5714dc97   Balaji Rao   power_supply: PCF...
20
21
22
23
24
25
26
27
28
29
30
31
  #include <linux/init.h>
  #include <linux/types.h>
  #include <linux/device.h>
  #include <linux/sysfs.h>
  #include <linux/platform_device.h>
  #include <linux/power_supply.h>
  
  #include <linux/mfd/pcf50633/core.h>
  #include <linux/mfd/pcf50633/mbc.h>
  
  struct pcf50633_mbc {
  	struct pcf50633 *pcf;
f5714dc97   Balaji Rao   power_supply: PCF...
32
  	int adapter_online;
f5714dc97   Balaji Rao   power_supply: PCF...
33
  	int usb_online;
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
34
35
36
  	struct power_supply *usb;
  	struct power_supply *adapter;
  	struct power_supply *ac;
f5714dc97   Balaji Rao   power_supply: PCF...
37
38
39
40
41
42
43
  };
  
  int pcf50633_mbc_usb_curlim_set(struct pcf50633 *pcf, int ma)
  {
  	struct pcf50633_mbc *mbc = platform_get_drvdata(pcf->mbc_pdev);
  	int ret = 0;
  	u8 bits;
9705ecc5c   Balaji Rao   pcf50633_charger:...
44
45
  	int charging_start = 1;
  	u8 mbcs2, chgmod;
31b4ff06e   Balaji Rao   pcf50633: introdu...
46
  	unsigned int mbcc5;
f5714dc97   Balaji Rao   power_supply: PCF...
47

31b4ff06e   Balaji Rao   pcf50633: introdu...
48
  	if (ma >= 1000) {
f5714dc97   Balaji Rao   power_supply: PCF...
49
  		bits = PCF50633_MBCC7_USB_1000mA;
31b4ff06e   Balaji Rao   pcf50633: introdu...
50
51
  		ma = 1000;
  	} else if (ma >= 500) {
f5714dc97   Balaji Rao   power_supply: PCF...
52
  		bits = PCF50633_MBCC7_USB_500mA;
31b4ff06e   Balaji Rao   pcf50633: introdu...
53
54
  		ma = 500;
  	} else if (ma >= 100) {
f5714dc97   Balaji Rao   power_supply: PCF...
55
  		bits = PCF50633_MBCC7_USB_100mA;
31b4ff06e   Balaji Rao   pcf50633: introdu...
56
57
  		ma = 100;
  	} else {
f5714dc97   Balaji Rao   power_supply: PCF...
58
  		bits = PCF50633_MBCC7_USB_SUSPEND;
9705ecc5c   Balaji Rao   pcf50633_charger:...
59
  		charging_start = 0;
31b4ff06e   Balaji Rao   pcf50633: introdu...
60
  		ma = 0;
9705ecc5c   Balaji Rao   pcf50633_charger:...
61
  	}
f5714dc97   Balaji Rao   power_supply: PCF...
62
63
64
65
66
67
68
69
70
  
  	ret = pcf50633_reg_set_bit_mask(pcf, PCF50633_REG_MBCC7,
  					PCF50633_MBCC7_USB_MASK, bits);
  	if (ret)
  		dev_err(pcf->dev, "error setting usb curlim to %d mA
  ", ma);
  	else
  		dev_info(pcf->dev, "usb curlim to %d mA
  ", ma);
31b4ff06e   Balaji Rao   pcf50633: introdu...
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
  	/*
  	 * We limit the charging current to be the USB current limit.
  	 * The reason is that on pcf50633, when it enters PMU Standby mode,
  	 * which it does when the device goes "off", the USB current limit
  	 * reverts to the variant default.  In at least one common case, that
  	 * default is 500mA.  By setting the charging current to be the same
  	 * as the USB limit we set here before PMU standby, we enforce it only
  	 * using the correct amount of current even when the USB current limit
  	 * gets reset to the wrong thing
  	 */
  
  	if (mbc->pcf->pdata->charger_reference_current_ma) {
  		mbcc5 = (ma << 8) / mbc->pcf->pdata->charger_reference_current_ma;
  		if (mbcc5 > 255)
  			mbcc5 = 255;
  		pcf50633_reg_write(mbc->pcf, PCF50633_REG_MBCC5, mbcc5);
  	}
c32979505   Paul Fertser   pcf50633: Query c...
88
  	mbcs2 = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCS2);
9705ecc5c   Balaji Rao   pcf50633_charger:...
89
90
91
  	chgmod = (mbcs2 & PCF50633_MBCS2_MBC_MASK);
  
  	/* If chgmod == BATFULL, setting chgena has no effect.
1282b35a1   Paul Fertser   pcf50633: Properl...
92
93
  	 * Datasheet says we need to set resume instead but when autoresume is
  	 * used resume doesn't work. Clear and set chgena instead.
9705ecc5c   Balaji Rao   pcf50633_charger:...
94
95
96
97
  	 */
  	if (chgmod != PCF50633_MBCS2_MBC_BAT_FULL)
  		pcf50633_reg_set_bit_mask(pcf, PCF50633_REG_MBCC1,
  				PCF50633_MBCC1_CHGENA, PCF50633_MBCC1_CHGENA);
1282b35a1   Paul Fertser   pcf50633: Properl...
98
99
100
  	else {
  		pcf50633_reg_clear_bits(pcf, PCF50633_REG_MBCC1,
  				PCF50633_MBCC1_CHGENA);
9705ecc5c   Balaji Rao   pcf50633_charger:...
101
  		pcf50633_reg_set_bit_mask(pcf, PCF50633_REG_MBCC1,
1282b35a1   Paul Fertser   pcf50633: Properl...
102
103
  				PCF50633_MBCC1_CHGENA, PCF50633_MBCC1_CHGENA);
  	}
9705ecc5c   Balaji Rao   pcf50633_charger:...
104

297d716f6   Krzysztof Kozlowski   power_supply: Cha...
105
  	power_supply_changed(mbc->usb);
f5714dc97   Balaji Rao   power_supply: PCF...
106
107
108
109
110
111
112
113
114
  
  	return ret;
  }
  EXPORT_SYMBOL_GPL(pcf50633_mbc_usb_curlim_set);
  
  int pcf50633_mbc_get_status(struct pcf50633 *pcf)
  {
  	struct pcf50633_mbc *mbc  = platform_get_drvdata(pcf->mbc_pdev);
  	int status = 0;
c32979505   Paul Fertser   pcf50633: Query c...
115
116
117
118
119
120
121
  	u8 chgmod;
  
  	if (!mbc)
  		return 0;
  
  	chgmod = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCS2)
  		& PCF50633_MBCS2_MBC_MASK;
f5714dc97   Balaji Rao   power_supply: PCF...
122
123
124
  
  	if (mbc->usb_online)
  		status |= PCF50633_MBC_USB_ONLINE;
c32979505   Paul Fertser   pcf50633: Query c...
125
126
127
128
  	if (chgmod == PCF50633_MBCS2_MBC_USB_PRE ||
  	    chgmod == PCF50633_MBCS2_MBC_USB_PRE_WAIT ||
  	    chgmod == PCF50633_MBCS2_MBC_USB_FAST ||
  	    chgmod == PCF50633_MBCS2_MBC_USB_FAST_WAIT)
f5714dc97   Balaji Rao   power_supply: PCF...
129
130
131
  		status |= PCF50633_MBC_USB_ACTIVE;
  	if (mbc->adapter_online)
  		status |= PCF50633_MBC_ADAPTER_ONLINE;
c32979505   Paul Fertser   pcf50633: Query c...
132
133
134
135
  	if (chgmod == PCF50633_MBCS2_MBC_ADP_PRE ||
  	    chgmod == PCF50633_MBCS2_MBC_ADP_PRE_WAIT ||
  	    chgmod == PCF50633_MBCS2_MBC_ADP_FAST ||
  	    chgmod == PCF50633_MBCS2_MBC_ADP_FAST_WAIT)
f5714dc97   Balaji Rao   power_supply: PCF...
136
137
138
139
140
  		status |= PCF50633_MBC_ADAPTER_ACTIVE;
  
  	return status;
  }
  EXPORT_SYMBOL_GPL(pcf50633_mbc_get_status);
c32979505   Paul Fertser   pcf50633: Query c...
141
142
143
144
145
146
147
148
149
150
  int pcf50633_mbc_get_usb_online_status(struct pcf50633 *pcf)
  {
  	struct pcf50633_mbc *mbc  = platform_get_drvdata(pcf->mbc_pdev);
  
  	if (!mbc)
  		return 0;
  
  	return mbc->usb_online;
  }
  EXPORT_SYMBOL_GPL(pcf50633_mbc_get_usb_online_status);
f5714dc97   Balaji Rao   power_supply: PCF...
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
  static ssize_t
  show_chgmode(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct pcf50633_mbc *mbc = dev_get_drvdata(dev);
  
  	u8 mbcs2 = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCS2);
  	u8 chgmod = (mbcs2 & PCF50633_MBCS2_MBC_MASK);
  
  	return sprintf(buf, "%d
  ", chgmod);
  }
  static DEVICE_ATTR(chgmode, S_IRUGO, show_chgmode, NULL);
  
  static ssize_t
  show_usblim(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct pcf50633_mbc *mbc = dev_get_drvdata(dev);
  	u8 usblim = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCC7) &
  						PCF50633_MBCC7_USB_MASK;
  	unsigned int ma;
  
  	if (usblim == PCF50633_MBCC7_USB_1000mA)
  		ma = 1000;
  	else if (usblim == PCF50633_MBCC7_USB_500mA)
  		ma = 500;
  	else if (usblim == PCF50633_MBCC7_USB_100mA)
  		ma = 100;
  	else
  		ma = 0;
  
  	return sprintf(buf, "%u
  ", ma);
  }
  
  static ssize_t set_usblim(struct device *dev,
  		struct device_attribute *attr, const char *buf, size_t count)
  {
  	struct pcf50633_mbc *mbc = dev_get_drvdata(dev);
  	unsigned long ma;
  	int ret;
4b43eb67a   Jingoo Han   power_supply: Rep...
191
  	ret = kstrtoul(buf, 10, &ma);
f5714dc97   Balaji Rao   power_supply: PCF...
192
  	if (ret)
4b43eb67a   Jingoo Han   power_supply: Rep...
193
  		return ret;
f5714dc97   Balaji Rao   power_supply: PCF...
194
195
196
197
198
199
200
  
  	pcf50633_mbc_usb_curlim_set(mbc->pcf, ma);
  
  	return count;
  }
  
  static DEVICE_ATTR(usb_curlim, S_IRUGO | S_IWUSR, show_usblim, set_usblim);
31b4ff06e   Balaji Rao   pcf50633: introdu...
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
  static ssize_t
  show_chglim(struct device *dev, struct device_attribute *attr, char *buf)
  {
  	struct pcf50633_mbc *mbc = dev_get_drvdata(dev);
  	u8 mbcc5 = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCC5);
  	unsigned int ma;
  
  	if (!mbc->pcf->pdata->charger_reference_current_ma)
  		return -ENODEV;
  
  	ma = (mbc->pcf->pdata->charger_reference_current_ma *  mbcc5) >> 8;
  
  	return sprintf(buf, "%u
  ", ma);
  }
  
  static ssize_t set_chglim(struct device *dev,
  		struct device_attribute *attr, const char *buf, size_t count)
  {
  	struct pcf50633_mbc *mbc = dev_get_drvdata(dev);
  	unsigned long ma;
  	unsigned int mbcc5;
  	int ret;
  
  	if (!mbc->pcf->pdata->charger_reference_current_ma)
  		return -ENODEV;
4b43eb67a   Jingoo Han   power_supply: Rep...
227
  	ret = kstrtoul(buf, 10, &ma);
31b4ff06e   Balaji Rao   pcf50633: introdu...
228
  	if (ret)
4b43eb67a   Jingoo Han   power_supply: Rep...
229
  		return ret;
31b4ff06e   Balaji Rao   pcf50633: introdu...
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
  
  	mbcc5 = (ma << 8) / mbc->pcf->pdata->charger_reference_current_ma;
  	if (mbcc5 > 255)
  		mbcc5 = 255;
  	pcf50633_reg_write(mbc->pcf, PCF50633_REG_MBCC5, mbcc5);
  
  	return count;
  }
  
  /*
   * This attribute allows to change MBC charging limit on the fly
   * independently of usb current limit. It also gets set automatically every
   * time usb current limit is changed.
   */
  static DEVICE_ATTR(chg_curlim, S_IRUGO | S_IWUSR, show_chglim, set_chglim);
f5714dc97   Balaji Rao   power_supply: PCF...
245
246
247
  static struct attribute *pcf50633_mbc_sysfs_entries[] = {
  	&dev_attr_chgmode.attr,
  	&dev_attr_usb_curlim.attr,
31b4ff06e   Balaji Rao   pcf50633: introdu...
248
  	&dev_attr_chg_curlim.attr,
f5714dc97   Balaji Rao   power_supply: PCF...
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
  	NULL,
  };
  
  static struct attribute_group mbc_attr_group = {
  	.name	= NULL,			/* put in device directory */
  	.attrs	= pcf50633_mbc_sysfs_entries,
  };
  
  static void
  pcf50633_mbc_irq_handler(int irq, void *data)
  {
  	struct pcf50633_mbc *mbc = data;
  
  	/* USB */
  	if (irq == PCF50633_IRQ_USBINS) {
  		mbc->usb_online = 1;
  	} else if (irq == PCF50633_IRQ_USBREM) {
  		mbc->usb_online = 0;
f5714dc97   Balaji Rao   power_supply: PCF...
267
268
269
270
  		pcf50633_mbc_usb_curlim_set(mbc->pcf, 0);
  	}
  
  	/* Adapter */
c32979505   Paul Fertser   pcf50633: Query c...
271
  	if (irq == PCF50633_IRQ_ADPINS)
f5714dc97   Balaji Rao   power_supply: PCF...
272
  		mbc->adapter_online = 1;
c32979505   Paul Fertser   pcf50633: Query c...
273
  	else if (irq == PCF50633_IRQ_ADPREM)
f5714dc97   Balaji Rao   power_supply: PCF...
274
  		mbc->adapter_online = 0;
f5714dc97   Balaji Rao   power_supply: PCF...
275

297d716f6   Krzysztof Kozlowski   power_supply: Cha...
276
277
278
  	power_supply_changed(mbc->ac);
  	power_supply_changed(mbc->usb);
  	power_supply_changed(mbc->adapter);
f5714dc97   Balaji Rao   power_supply: PCF...
279
280
281
282
283
284
285
286
287
  
  	if (mbc->pcf->pdata->mbc_event_callback)
  		mbc->pcf->pdata->mbc_event_callback(mbc->pcf, irq);
  }
  
  static int adapter_get_property(struct power_supply *psy,
  			enum power_supply_property psp,
  			union power_supply_propval *val)
  {
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
288
  	struct pcf50633_mbc *mbc = power_supply_get_drvdata(psy);
f5714dc97   Balaji Rao   power_supply: PCF...
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
  	int ret = 0;
  
  	switch (psp) {
  	case POWER_SUPPLY_PROP_ONLINE:
  		val->intval =  mbc->adapter_online;
  		break;
  	default:
  		ret = -EINVAL;
  		break;
  	}
  	return ret;
  }
  
  static int usb_get_property(struct power_supply *psy,
  			enum power_supply_property psp,
  			union power_supply_propval *val)
  {
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
306
  	struct pcf50633_mbc *mbc = power_supply_get_drvdata(psy);
f5714dc97   Balaji Rao   power_supply: PCF...
307
  	int ret = 0;
7677f33f0   Sean McNeil   pcf50633: Add ac ...
308
309
  	u8 usblim = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCC7) &
  						PCF50633_MBCC7_USB_MASK;
f5714dc97   Balaji Rao   power_supply: PCF...
310
311
312
  
  	switch (psp) {
  	case POWER_SUPPLY_PROP_ONLINE:
7677f33f0   Sean McNeil   pcf50633: Add ac ...
313
314
315
316
317
318
319
320
321
322
323
324
325
326
  		val->intval = mbc->usb_online &&
  				(usblim <= PCF50633_MBCC7_USB_500mA);
  		break;
  	default:
  		ret = -EINVAL;
  		break;
  	}
  	return ret;
  }
  
  static int ac_get_property(struct power_supply *psy,
  			enum power_supply_property psp,
  			union power_supply_propval *val)
  {
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
327
  	struct pcf50633_mbc *mbc = power_supply_get_drvdata(psy);
7677f33f0   Sean McNeil   pcf50633: Add ac ...
328
329
330
  	int ret = 0;
  	u8 usblim = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCC7) &
  						PCF50633_MBCC7_USB_MASK;
f5714dc97   Balaji Rao   power_supply: PCF...
331
332
333
  
  	switch (psp) {
  	case POWER_SUPPLY_PROP_ONLINE:
7677f33f0   Sean McNeil   pcf50633: Add ac ...
334
335
  		val->intval = mbc->usb_online &&
  				(usblim == PCF50633_MBCC7_USB_1000mA);
f5714dc97   Balaji Rao   power_supply: PCF...
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
  		break;
  	default:
  		ret = -EINVAL;
  		break;
  	}
  	return ret;
  }
  
  static enum power_supply_property power_props[] = {
  	POWER_SUPPLY_PROP_ONLINE,
  };
  
  static const u8 mbc_irq_handlers[] = {
  	PCF50633_IRQ_ADPINS,
  	PCF50633_IRQ_ADPREM,
  	PCF50633_IRQ_USBINS,
  	PCF50633_IRQ_USBREM,
  	PCF50633_IRQ_BATFULL,
  	PCF50633_IRQ_CHGHALT,
  	PCF50633_IRQ_THLIMON,
  	PCF50633_IRQ_THLIMOFF,
  	PCF50633_IRQ_USBLIMON,
  	PCF50633_IRQ_USBLIMOFF,
  	PCF50633_IRQ_LOWSYS,
  	PCF50633_IRQ_LOWBAT,
  };
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
  static const struct power_supply_desc pcf50633_mbc_adapter_desc = {
  	.name		= "adapter",
  	.type		= POWER_SUPPLY_TYPE_MAINS,
  	.properties	= power_props,
  	.num_properties	= ARRAY_SIZE(power_props),
  	.get_property	= &adapter_get_property,
  };
  
  static const struct power_supply_desc pcf50633_mbc_usb_desc = {
  	.name		= "usb",
  	.type		= POWER_SUPPLY_TYPE_USB,
  	.properties	= power_props,
  	.num_properties	= ARRAY_SIZE(power_props),
  	.get_property	= usb_get_property,
  };
  
  static const struct power_supply_desc pcf50633_mbc_ac_desc = {
  	.name		= "ac",
  	.type		= POWER_SUPPLY_TYPE_MAINS,
  	.properties	= power_props,
  	.num_properties	= ARRAY_SIZE(power_props),
  	.get_property	= ac_get_property,
  };
c8afa6406   Bill Pemberton   power: remove use...
385
  static int pcf50633_mbc_probe(struct platform_device *pdev)
f5714dc97   Balaji Rao   power_supply: PCF...
386
  {
2dc9215d7   Krzysztof Kozlowski   power_supply: Mov...
387
  	struct power_supply_config psy_cfg = {};
f5714dc97   Balaji Rao   power_supply: PCF...
388
  	struct pcf50633_mbc *mbc;
f5714dc97   Balaji Rao   power_supply: PCF...
389
390
391
  	int ret;
  	int i;
  	u8 mbcs1;
c09dd7dab   Jingoo Han   pcf50633-charger:...
392
  	mbc = devm_kzalloc(&pdev->dev, sizeof(*mbc), GFP_KERNEL);
f5714dc97   Balaji Rao   power_supply: PCF...
393
394
395
396
  	if (!mbc)
  		return -ENOMEM;
  
  	platform_set_drvdata(pdev, mbc);
68d641efd   Lars-Peter Clausen   mfd: Fix memleak ...
397
  	mbc->pcf = dev_to_pcf50633(pdev->dev.parent);
f5714dc97   Balaji Rao   power_supply: PCF...
398
399
400
401
402
  
  	/* Set up IRQ handlers */
  	for (i = 0; i < ARRAY_SIZE(mbc_irq_handlers); i++)
  		pcf50633_register_irq(mbc->pcf, mbc_irq_handlers[i],
  					pcf50633_mbc_irq_handler, mbc);
2dc9215d7   Krzysztof Kozlowski   power_supply: Mov...
403
404
  	psy_cfg.supplied_to		= mbc->pcf->pdata->batteries;
  	psy_cfg.num_supplicants		= mbc->pcf->pdata->num_batteries;
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
405
  	psy_cfg.drv_data		= mbc;
2dc9215d7   Krzysztof Kozlowski   power_supply: Mov...
406

f5714dc97   Balaji Rao   power_supply: PCF...
407
  	/* Create power supplies */
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
408
409
410
411
  	mbc->adapter = power_supply_register(&pdev->dev,
  					     &pcf50633_mbc_adapter_desc,
  					     &psy_cfg);
  	if (IS_ERR(mbc->adapter)) {
f5714dc97   Balaji Rao   power_supply: PCF...
412
413
  		dev_err(mbc->pcf->dev, "failed to register adapter
  ");
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
414
  		ret = PTR_ERR(mbc->adapter);
f5714dc97   Balaji Rao   power_supply: PCF...
415
416
  		return ret;
  	}
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
417
418
419
  	mbc->usb = power_supply_register(&pdev->dev, &pcf50633_mbc_usb_desc,
  					 &psy_cfg);
  	if (IS_ERR(mbc->usb)) {
f5714dc97   Balaji Rao   power_supply: PCF...
420
421
  		dev_err(mbc->pcf->dev, "failed to register usb
  ");
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
422
423
  		power_supply_unregister(mbc->adapter);
  		ret = PTR_ERR(mbc->usb);
f5714dc97   Balaji Rao   power_supply: PCF...
424
425
  		return ret;
  	}
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
426
427
428
  	mbc->ac = power_supply_register(&pdev->dev, &pcf50633_mbc_ac_desc,
  					&psy_cfg);
  	if (IS_ERR(mbc->ac)) {
7677f33f0   Sean McNeil   pcf50633: Add ac ...
429
430
  		dev_err(mbc->pcf->dev, "failed to register ac
  ");
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
431
432
433
  		power_supply_unregister(mbc->adapter);
  		power_supply_unregister(mbc->usb);
  		ret = PTR_ERR(mbc->ac);
7677f33f0   Sean McNeil   pcf50633: Add ac ...
434
435
  		return ret;
  	}
9705ecc5c   Balaji Rao   pcf50633_charger:...
436

f5714dc97   Balaji Rao   power_supply: PCF...
437
438
439
440
441
442
443
444
445
446
447
448
449
  	ret = sysfs_create_group(&pdev->dev.kobj, &mbc_attr_group);
  	if (ret)
  		dev_err(mbc->pcf->dev, "failed to create sysfs entries
  ");
  
  	mbcs1 = pcf50633_reg_read(mbc->pcf, PCF50633_REG_MBCS1);
  	if (mbcs1 & PCF50633_MBCS1_USBPRES)
  		pcf50633_mbc_irq_handler(PCF50633_IRQ_USBINS, mbc);
  	if (mbcs1 & PCF50633_MBCS1_ADAPTPRES)
  		pcf50633_mbc_irq_handler(PCF50633_IRQ_ADPINS, mbc);
  
  	return 0;
  }
415ec69fb   Bill Pemberton   power: remove use...
450
  static int pcf50633_mbc_remove(struct platform_device *pdev)
f5714dc97   Balaji Rao   power_supply: PCF...
451
452
453
454
455
456
457
  {
  	struct pcf50633_mbc *mbc = platform_get_drvdata(pdev);
  	int i;
  
  	/* Remove IRQ handlers */
  	for (i = 0; i < ARRAY_SIZE(mbc_irq_handlers); i++)
  		pcf50633_free_irq(mbc->pcf, mbc_irq_handlers[i]);
305da8f50   Axel Lin   pcf50633-charger:...
458
  	sysfs_remove_group(&pdev->dev.kobj, &mbc_attr_group);
297d716f6   Krzysztof Kozlowski   power_supply: Cha...
459
460
461
  	power_supply_unregister(mbc->usb);
  	power_supply_unregister(mbc->adapter);
  	power_supply_unregister(mbc->ac);
9705ecc5c   Balaji Rao   pcf50633_charger:...
462

f5714dc97   Balaji Rao   power_supply: PCF...
463
464
465
466
467
468
469
470
  	return 0;
  }
  
  static struct platform_driver pcf50633_mbc_driver = {
  	.driver = {
  		.name = "pcf50633-mbc",
  	},
  	.probe = pcf50633_mbc_probe,
28ea73f4c   Bill Pemberton   power: remove use...
471
  	.remove = pcf50633_mbc_remove,
f5714dc97   Balaji Rao   power_supply: PCF...
472
  };
300bac7fb   Axel Lin   power_supply: Con...
473
  module_platform_driver(pcf50633_mbc_driver);
f5714dc97   Balaji Rao   power_supply: PCF...
474
475
476
477
478
  
  MODULE_AUTHOR("Balaji Rao <balajirrao@openmoko.org>");
  MODULE_DESCRIPTION("PCF50633 mbc driver");
  MODULE_LICENSE("GPL");
  MODULE_ALIAS("platform:pcf50633-mbc");