Merge branch 'sh/hwblk' into sh-latest
[deliverable/linux.git] / drivers / power / bq27x00_battery.c
CommitLineData
b996ad0e
RG
1/*
2 * BQ27x00 battery driver
3 *
4 * Copyright (C) 2008 Rodolfo Giometti <giometti@linux.it>
5 * Copyright (C) 2008 Eurotech S.p.A. <info@eurotech.it>
7fb7ba58 6 * Copyright (C) 2010-2011 Lars-Peter Clausen <lars@metafoo.de>
73c244a8 7 * Copyright (C) 2011 Pali Rohár <pali.rohar@gmail.com>
b996ad0e
RG
8 *
9 * Based on a previous work by Copyright (C) 2008 Texas Instruments, Inc.
10 *
11 * This package is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
14 *
15 * THIS PACKAGE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
17 * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
18 *
19 */
631c17ee
PR
20
21/*
22 * Datasheets:
23 * http://focus.ti.com/docs/prod/folders/print/bq27000.html
24 * http://focus.ti.com/docs/prod/folders/print/bq27500.html
25 */
26
b996ad0e
RG
27#include <linux/module.h>
28#include <linux/param.h>
29#include <linux/jiffies.h>
30#include <linux/workqueue.h>
31#include <linux/delay.h>
32#include <linux/platform_device.h>
33#include <linux/power_supply.h>
34#include <linux/idr.h>
b996ad0e 35#include <linux/i2c.h>
5a0e3ad6 36#include <linux/slab.h>
8aef7e8f 37#include <asm/unaligned.h>
b996ad0e 38
7fb7ba58
LPC
39#include <linux/power/bq27x00_battery.h>
40
631c17ee 41#define DRIVER_VERSION "1.2.0"
b996ad0e
RG
42
43#define BQ27x00_REG_TEMP 0x06
44#define BQ27x00_REG_VOLT 0x08
b996ad0e
RG
45#define BQ27x00_REG_AI 0x14
46#define BQ27x00_REG_FLAGS 0x0A
4e924a81
GI
47#define BQ27x00_REG_TTE 0x16
48#define BQ27x00_REG_TTF 0x18
49#define BQ27x00_REG_TTECP 0x26
631c17ee
PR
50#define BQ27x00_REG_NAC 0x0C /* Nominal available capaciy */
51#define BQ27x00_REG_LMD 0x12 /* Last measured discharge */
52#define BQ27x00_REG_CYCT 0x2A /* Cycle count total */
53#define BQ27x00_REG_AE 0x22 /* Available enery */
b996ad0e 54
e20908d9 55#define BQ27000_REG_RSOC 0x0B /* Relative State-of-Charge */
631c17ee 56#define BQ27000_REG_ILMD 0x76 /* Initial last measured discharge */
4e924a81 57#define BQ27000_FLAG_CHGS BIT(7)
c1b9ab67 58#define BQ27000_FLAG_FC BIT(5)
e20908d9 59
bf7d4140 60#define BQ27500_REG_SOC 0x2C
631c17ee 61#define BQ27500_REG_DCAP 0x3C /* Design capacity */
4e924a81
GI
62#define BQ27500_FLAG_DSC BIT(0)
63#define BQ27500_FLAG_FC BIT(9)
e20908d9 64
a2e5118c
PR
65#define BQ27000_RS 20 /* Resistor sense */
66
b996ad0e
RG
67struct bq27x00_device_info;
68struct bq27x00_access_methods {
297a533b 69 int (*read)(struct bq27x00_device_info *di, u8 reg, bool single);
b996ad0e
RG
70};
71
e20908d9
GI
72enum bq27x00_chip { BQ27000, BQ27500 };
73
297a533b
LPC
74struct bq27x00_reg_cache {
75 int temperature;
76 int time_to_empty;
77 int time_to_empty_avg;
78 int time_to_full;
631c17ee 79 int charge_full;
73c244a8 80 int cycle_count;
297a533b
LPC
81 int capacity;
82 int flags;
83
84 int current_now;
85};
86
b996ad0e
RG
87struct bq27x00_device_info {
88 struct device *dev;
89 int id;
e20908d9 90 enum bq27x00_chip chip;
b996ad0e 91
297a533b 92 struct bq27x00_reg_cache cache;
631c17ee
PR
93 int charge_design_full;
94
297a533b 95 unsigned long last_update;
740b755a 96 struct delayed_work work;
297a533b 97
a40402ef
LPC
98 struct power_supply bat;
99
100 struct bq27x00_access_methods bus;
740b755a
LPC
101
102 struct mutex lock;
b996ad0e
RG
103};
104
105static enum power_supply_property bq27x00_battery_props[] = {
4e924a81 106 POWER_SUPPLY_PROP_STATUS,
b996ad0e
RG
107 POWER_SUPPLY_PROP_PRESENT,
108 POWER_SUPPLY_PROP_VOLTAGE_NOW,
109 POWER_SUPPLY_PROP_CURRENT_NOW,
110 POWER_SUPPLY_PROP_CAPACITY,
111 POWER_SUPPLY_PROP_TEMP,
4e924a81
GI
112 POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
113 POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
114 POWER_SUPPLY_PROP_TIME_TO_FULL_NOW,
5661f334 115 POWER_SUPPLY_PROP_TECHNOLOGY,
631c17ee
PR
116 POWER_SUPPLY_PROP_CHARGE_FULL,
117 POWER_SUPPLY_PROP_CHARGE_NOW,
118 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
73c244a8 119 POWER_SUPPLY_PROP_CYCLE_COUNT,
631c17ee 120 POWER_SUPPLY_PROP_ENERGY_NOW,
b996ad0e
RG
121};
122
740b755a
LPC
123static unsigned int poll_interval = 360;
124module_param(poll_interval, uint, 0644);
125MODULE_PARM_DESC(poll_interval, "battery poll interval in seconds - " \
126 "0 disables polling");
127
b996ad0e
RG
128/*
129 * Common code for BQ27x00 devices
130 */
131
a40402ef 132static inline int bq27x00_read(struct bq27x00_device_info *di, u8 reg,
297a533b 133 bool single)
b996ad0e 134{
297a533b 135 return di->bus.read(di, reg, single);
b996ad0e
RG
136}
137
138/*
297a533b 139 * Return the battery Relative State-of-Charge
b996ad0e
RG
140 * Or < 0 if something fails.
141 */
297a533b 142static int bq27x00_battery_read_rsoc(struct bq27x00_device_info *di)
b996ad0e 143{
297a533b 144 int rsoc;
b996ad0e 145
e20908d9 146 if (di->chip == BQ27500)
297a533b 147 rsoc = bq27x00_read(di, BQ27500_REG_SOC, false);
e20908d9 148 else
297a533b
LPC
149 rsoc = bq27x00_read(di, BQ27000_REG_RSOC, true);
150
151 if (rsoc < 0)
152 dev_err(di->dev, "error reading relative State-of-Charge\n");
153
154 return rsoc;
b996ad0e
RG
155}
156
631c17ee
PR
157/*
158 * Return a battery charge value in µAh
159 * Or < 0 if something fails.
160 */
161static int bq27x00_battery_read_charge(struct bq27x00_device_info *di, u8 reg)
162{
163 int charge;
164
165 charge = bq27x00_read(di, reg, false);
166 if (charge < 0) {
167 dev_err(di->dev, "error reading nominal available capacity\n");
168 return charge;
169 }
170
171 if (di->chip == BQ27500)
172 charge *= 1000;
173 else
174 charge = charge * 3570 / BQ27000_RS;
175
176 return charge;
177}
178
179/*
180 * Return the battery Nominal available capaciy in µAh
181 * Or < 0 if something fails.
182 */
183static inline int bq27x00_battery_read_nac(struct bq27x00_device_info *di)
184{
185 return bq27x00_battery_read_charge(di, BQ27x00_REG_NAC);
186}
187
188/*
189 * Return the battery Last measured discharge in µAh
190 * Or < 0 if something fails.
191 */
192static inline int bq27x00_battery_read_lmd(struct bq27x00_device_info *di)
193{
194 return bq27x00_battery_read_charge(di, BQ27x00_REG_LMD);
195}
196
197/*
198 * Return the battery Initial last measured discharge in µAh
199 * Or < 0 if something fails.
200 */
201static int bq27x00_battery_read_ilmd(struct bq27x00_device_info *di)
202{
203 int ilmd;
204
205 if (di->chip == BQ27500)
206 ilmd = bq27x00_read(di, BQ27500_REG_DCAP, false);
207 else
208 ilmd = bq27x00_read(di, BQ27000_REG_ILMD, true);
209
210 if (ilmd < 0) {
211 dev_err(di->dev, "error reading initial last measured discharge\n");
212 return ilmd;
213 }
214
215 if (di->chip == BQ27500)
216 ilmd *= 1000;
217 else
218 ilmd = ilmd * 256 * 3570 / BQ27000_RS;
219
220 return ilmd;
221}
222
223/*
224 * Return the battery Cycle count total
225 * Or < 0 if something fails.
226 */
227static int bq27x00_battery_read_cyct(struct bq27x00_device_info *di)
228{
229 int cyct;
230
231 cyct = bq27x00_read(di, BQ27x00_REG_CYCT, false);
232 if (cyct < 0)
233 dev_err(di->dev, "error reading cycle count total\n");
234
235 return cyct;
236}
237
b996ad0e 238/*
297a533b
LPC
239 * Read a time register.
240 * Return < 0 if something fails.
b996ad0e 241 */
297a533b 242static int bq27x00_battery_read_time(struct bq27x00_device_info *di, u8 reg)
b996ad0e 243{
297a533b 244 int tval;
b996ad0e 245
297a533b
LPC
246 tval = bq27x00_read(di, reg, false);
247 if (tval < 0) {
248 dev_err(di->dev, "error reading register %02x: %d\n", reg, tval);
249 return tval;
b996ad0e
RG
250 }
251
297a533b
LPC
252 if (tval == 65535)
253 return -ENODATA;
254
255 return tval * 60;
256}
257
258static void bq27x00_update(struct bq27x00_device_info *di)
259{
260 struct bq27x00_reg_cache cache = {0, };
261 bool is_bq27500 = di->chip == BQ27500;
262
263 cache.flags = bq27x00_read(di, BQ27x00_REG_FLAGS, is_bq27500);
264 if (cache.flags >= 0) {
265 cache.capacity = bq27x00_battery_read_rsoc(di);
266 cache.temperature = bq27x00_read(di, BQ27x00_REG_TEMP, false);
267 cache.time_to_empty = bq27x00_battery_read_time(di, BQ27x00_REG_TTE);
268 cache.time_to_empty_avg = bq27x00_battery_read_time(di, BQ27x00_REG_TTECP);
269 cache.time_to_full = bq27x00_battery_read_time(di, BQ27x00_REG_TTF);
631c17ee 270 cache.charge_full = bq27x00_battery_read_lmd(di);
73c244a8 271 cache.cycle_count = bq27x00_battery_read_cyct(di);
297a533b
LPC
272
273 if (!is_bq27500)
274 cache.current_now = bq27x00_read(di, BQ27x00_REG_AI, false);
631c17ee
PR
275
276 /* We only have to read charge design full once */
277 if (di->charge_design_full <= 0)
278 di->charge_design_full = bq27x00_battery_read_ilmd(di);
297a533b
LPC
279 }
280
281 /* Ignore current_now which is a snapshot of the current battery state
282 * and is likely to be different even between two consecutive reads */
283 if (memcmp(&di->cache, &cache, sizeof(cache) - sizeof(int)) != 0) {
284 di->cache = cache;
285 power_supply_changed(&di->bat);
286 }
287
288 di->last_update = jiffies;
289}
290
740b755a
LPC
291static void bq27x00_battery_poll(struct work_struct *work)
292{
293 struct bq27x00_device_info *di =
294 container_of(work, struct bq27x00_device_info, work.work);
295
296 bq27x00_update(di);
297
298 if (poll_interval > 0) {
299 /* The timer does not have to be accurate. */
300 set_timer_slack(&di->work.timer, poll_interval * HZ / 4);
301 schedule_delayed_work(&di->work, poll_interval * HZ);
302 }
303}
304
305
297a533b
LPC
306/*
307 * Return the battery temperature in tenths of degree Celsius
308 * Or < 0 if something fails.
309 */
310static int bq27x00_battery_temperature(struct bq27x00_device_info *di,
311 union power_supply_propval *val)
312{
313 if (di->cache.temperature < 0)
314 return di->cache.temperature;
315
316 if (di->chip == BQ27500)
317 val->intval = di->cache.temperature - 2731;
318 else
319 val->intval = ((di->cache.temperature * 5) - 5463) / 2;
320
321 return 0;
b996ad0e
RG
322}
323
324/*
bf7d4140 325 * Return the battery average current in µA
b996ad0e
RG
326 * Note that current can be negative signed as well
327 * Or 0 if something fails.
328 */
297a533b
LPC
329static int bq27x00_battery_current(struct bq27x00_device_info *di,
330 union power_supply_propval *val)
b996ad0e 331{
297a533b 332 int curr;
b996ad0e 333
297a533b
LPC
334 if (di->chip == BQ27500)
335 curr = bq27x00_read(di, BQ27x00_REG_AI, false);
336 else
337 curr = di->cache.current_now;
338
339 if (curr < 0)
340 return curr;
e20908d9
GI
341
342 if (di->chip == BQ27500) {
343 /* bq27500 returns signed value */
297a533b 344 val->intval = (int)((s16)curr) * 1000;
e20908d9 345 } else {
297a533b 346 if (di->cache.flags & BQ27000_FLAG_CHGS) {
e20908d9 347 dev_dbg(di->dev, "negative current!\n");
afbc74fd 348 curr = -curr;
e20908d9 349 }
b996ad0e 350
297a533b 351 val->intval = curr * 3570 / BQ27000_RS;
b996ad0e
RG
352 }
353
297a533b 354 return 0;
b996ad0e
RG
355}
356
4e924a81 357static int bq27x00_battery_status(struct bq27x00_device_info *di,
297a533b 358 union power_supply_propval *val)
4e924a81 359{
4e924a81 360 int status;
4e924a81
GI
361
362 if (di->chip == BQ27500) {
297a533b 363 if (di->cache.flags & BQ27500_FLAG_FC)
4e924a81 364 status = POWER_SUPPLY_STATUS_FULL;
297a533b 365 else if (di->cache.flags & BQ27500_FLAG_DSC)
4e924a81
GI
366 status = POWER_SUPPLY_STATUS_DISCHARGING;
367 else
368 status = POWER_SUPPLY_STATUS_CHARGING;
369 } else {
c1b9ab67
LPC
370 if (di->cache.flags & BQ27000_FLAG_FC)
371 status = POWER_SUPPLY_STATUS_FULL;
372 else if (di->cache.flags & BQ27000_FLAG_CHGS)
4e924a81 373 status = POWER_SUPPLY_STATUS_CHARGING;
c1b9ab67
LPC
374 else if (power_supply_am_i_supplied(&di->bat))
375 status = POWER_SUPPLY_STATUS_NOT_CHARGING;
4e924a81
GI
376 else
377 status = POWER_SUPPLY_STATUS_DISCHARGING;
378 }
379
380 val->intval = status;
297a533b 381
4e924a81
GI
382 return 0;
383}
384
385/*
297a533b
LPC
386 * Return the battery Voltage in milivolts
387 * Or < 0 if something fails.
4e924a81 388 */
297a533b
LPC
389static int bq27x00_battery_voltage(struct bq27x00_device_info *di,
390 union power_supply_propval *val)
4e924a81 391{
297a533b 392 int volt;
4e924a81 393
297a533b
LPC
394 volt = bq27x00_read(di, BQ27x00_REG_VOLT, false);
395 if (volt < 0)
396 return volt;
4e924a81 397
297a533b
LPC
398 val->intval = volt * 1000;
399
400 return 0;
401}
402
631c17ee
PR
403/*
404 * Return the battery Available energy in µWh
405 * Or < 0 if something fails.
406 */
407static int bq27x00_battery_energy(struct bq27x00_device_info *di,
408 union power_supply_propval *val)
409{
410 int ae;
411
412 ae = bq27x00_read(di, BQ27x00_REG_AE, false);
413 if (ae < 0) {
414 dev_err(di->dev, "error reading available energy\n");
415 return ae;
416 }
417
418 if (di->chip == BQ27500)
419 ae *= 1000;
420 else
421 ae = ae * 29200 / BQ27000_RS;
422
423 val->intval = ae;
424
425 return 0;
426}
427
428
297a533b
LPC
429static int bq27x00_simple_value(int value,
430 union power_supply_propval *val)
431{
432 if (value < 0)
433 return value;
434
435 val->intval = value;
4e924a81 436
4e924a81
GI
437 return 0;
438}
439
b996ad0e
RG
440#define to_bq27x00_device_info(x) container_of((x), \
441 struct bq27x00_device_info, bat);
442
443static int bq27x00_battery_get_property(struct power_supply *psy,
444 enum power_supply_property psp,
445 union power_supply_propval *val)
446{
4e924a81 447 int ret = 0;
b996ad0e 448 struct bq27x00_device_info *di = to_bq27x00_device_info(psy);
3413b4ea 449
740b755a
LPC
450 mutex_lock(&di->lock);
451 if (time_is_before_jiffies(di->last_update + 5 * HZ)) {
452 cancel_delayed_work_sync(&di->work);
453 bq27x00_battery_poll(&di->work.work);
454 }
455 mutex_unlock(&di->lock);
297a533b
LPC
456
457 if (psp != POWER_SUPPLY_PROP_PRESENT && di->cache.flags < 0)
3413b4ea 458 return -ENODEV;
b996ad0e
RG
459
460 switch (psp) {
4e924a81
GI
461 case POWER_SUPPLY_PROP_STATUS:
462 ret = bq27x00_battery_status(di, val);
463 break;
b996ad0e 464 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
297a533b 465 ret = bq27x00_battery_voltage(di, val);
3413b4ea 466 break;
b996ad0e 467 case POWER_SUPPLY_PROP_PRESENT:
297a533b 468 val->intval = di->cache.flags < 0 ? 0 : 1;
b996ad0e
RG
469 break;
470 case POWER_SUPPLY_PROP_CURRENT_NOW:
297a533b 471 ret = bq27x00_battery_current(di, val);
b996ad0e
RG
472 break;
473 case POWER_SUPPLY_PROP_CAPACITY:
297a533b 474 ret = bq27x00_simple_value(di->cache.capacity, val);
b996ad0e
RG
475 break;
476 case POWER_SUPPLY_PROP_TEMP:
297a533b 477 ret = bq27x00_battery_temperature(di, val);
b996ad0e 478 break;
4e924a81 479 case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW:
297a533b 480 ret = bq27x00_simple_value(di->cache.time_to_empty, val);
4e924a81
GI
481 break;
482 case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
297a533b 483 ret = bq27x00_simple_value(di->cache.time_to_empty_avg, val);
4e924a81
GI
484 break;
485 case POWER_SUPPLY_PROP_TIME_TO_FULL_NOW:
297a533b 486 ret = bq27x00_simple_value(di->cache.time_to_full, val);
4e924a81 487 break;
5661f334
LPC
488 case POWER_SUPPLY_PROP_TECHNOLOGY:
489 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
490 break;
631c17ee
PR
491 case POWER_SUPPLY_PROP_CHARGE_NOW:
492 ret = bq27x00_simple_value(bq27x00_battery_read_nac(di), val);
493 break;
494 case POWER_SUPPLY_PROP_CHARGE_FULL:
495 ret = bq27x00_simple_value(di->cache.charge_full, val);
496 break;
497 case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
498 ret = bq27x00_simple_value(di->charge_design_full, val);
499 break;
73c244a8
PR
500 case POWER_SUPPLY_PROP_CYCLE_COUNT:
501 ret = bq27x00_simple_value(di->cache.cycle_count, val);
631c17ee
PR
502 break;
503 case POWER_SUPPLY_PROP_ENERGY_NOW:
504 ret = bq27x00_battery_energy(di, val);
505 break;
b996ad0e
RG
506 default:
507 return -EINVAL;
508 }
509
4e924a81 510 return ret;
b996ad0e
RG
511}
512
740b755a
LPC
513static void bq27x00_external_power_changed(struct power_supply *psy)
514{
515 struct bq27x00_device_info *di = to_bq27x00_device_info(psy);
516
517 cancel_delayed_work_sync(&di->work);
518 schedule_delayed_work(&di->work, 0);
519}
520
a40402ef 521static int bq27x00_powersupply_init(struct bq27x00_device_info *di)
b996ad0e 522{
a40402ef
LPC
523 int ret;
524
b996ad0e
RG
525 di->bat.type = POWER_SUPPLY_TYPE_BATTERY;
526 di->bat.properties = bq27x00_battery_props;
527 di->bat.num_properties = ARRAY_SIZE(bq27x00_battery_props);
528 di->bat.get_property = bq27x00_battery_get_property;
740b755a
LPC
529 di->bat.external_power_changed = bq27x00_external_power_changed;
530
531 INIT_DELAYED_WORK(&di->work, bq27x00_battery_poll);
532 mutex_init(&di->lock);
a40402ef
LPC
533
534 ret = power_supply_register(di->dev, &di->bat);
535 if (ret) {
536 dev_err(di->dev, "failed to register battery: %d\n", ret);
537 return ret;
538 }
539
540 dev_info(di->dev, "support ver. %s enabled\n", DRIVER_VERSION);
541
297a533b
LPC
542 bq27x00_update(di);
543
a40402ef 544 return 0;
b996ad0e
RG
545}
546
740b755a
LPC
547static void bq27x00_powersupply_unregister(struct bq27x00_device_info *di)
548{
549 cancel_delayed_work_sync(&di->work);
550
551 power_supply_unregister(&di->bat);
552
553 mutex_destroy(&di->lock);
554}
555
7fb7ba58
LPC
556
557/* i2c specific code */
558#ifdef CONFIG_BATTERY_BQ27X00_I2C
559
560/* If the system has several batteries we need a different name for each
561 * of them...
b996ad0e 562 */
7fb7ba58
LPC
563static DEFINE_IDR(battery_id);
564static DEFINE_MUTEX(battery_mutex);
b996ad0e 565
297a533b 566static int bq27x00_read_i2c(struct bq27x00_device_info *di, u8 reg, bool single)
b996ad0e 567{
a40402ef 568 struct i2c_client *client = to_i2c_client(di->dev);
9e912f45 569 struct i2c_msg msg[2];
b996ad0e 570 unsigned char data[2];
297a533b 571 int ret;
b996ad0e
RG
572
573 if (!client->adapter)
574 return -ENODEV;
575
9e912f45
GI
576 msg[0].addr = client->addr;
577 msg[0].flags = 0;
578 msg[0].buf = &reg;
579 msg[0].len = sizeof(reg);
580 msg[1].addr = client->addr;
581 msg[1].flags = I2C_M_RD;
582 msg[1].buf = data;
2ec523a8 583 if (single)
9e912f45 584 msg[1].len = 1;
2ec523a8 585 else
9e912f45 586 msg[1].len = 2;
2ec523a8 587
9e912f45 588 ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
2ec523a8
LPC
589 if (ret < 0)
590 return ret;
591
592 if (!single)
593 ret = get_unaligned_le16(data);
594 else
595 ret = data[0];
b996ad0e 596
297a533b 597 return ret;
b996ad0e
RG
598}
599
e20908d9 600static int bq27x00_battery_probe(struct i2c_client *client,
b996ad0e
RG
601 const struct i2c_device_id *id)
602{
603 char *name;
604 struct bq27x00_device_info *di;
b996ad0e
RG
605 int num;
606 int retval = 0;
607
608 /* Get new ID for the new battery device */
609 retval = idr_pre_get(&battery_id, GFP_KERNEL);
610 if (retval == 0)
611 return -ENOMEM;
612 mutex_lock(&battery_mutex);
613 retval = idr_get_new(&battery_id, client, &num);
614 mutex_unlock(&battery_mutex);
615 if (retval < 0)
616 return retval;
617
e20908d9 618 name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
b996ad0e
RG
619 if (!name) {
620 dev_err(&client->dev, "failed to allocate device name\n");
621 retval = -ENOMEM;
622 goto batt_failed_1;
623 }
624
625 di = kzalloc(sizeof(*di), GFP_KERNEL);
626 if (!di) {
627 dev_err(&client->dev, "failed to allocate device info data\n");
628 retval = -ENOMEM;
629 goto batt_failed_2;
630 }
a40402ef 631
b996ad0e 632 di->id = num;
a40402ef 633 di->dev = &client->dev;
e20908d9 634 di->chip = id->driver_data;
a40402ef
LPC
635 di->bat.name = name;
636 di->bus.read = &bq27x00_read_i2c;
b996ad0e 637
a40402ef 638 if (bq27x00_powersupply_init(di))
b996ad0e 639 goto batt_failed_3;
b996ad0e
RG
640
641 i2c_set_clientdata(client, di);
b996ad0e
RG
642
643 return 0;
644
b996ad0e
RG
645batt_failed_3:
646 kfree(di);
647batt_failed_2:
648 kfree(name);
649batt_failed_1:
650 mutex_lock(&battery_mutex);
651 idr_remove(&battery_id, num);
652 mutex_unlock(&battery_mutex);
653
654 return retval;
655}
656
e20908d9 657static int bq27x00_battery_remove(struct i2c_client *client)
b996ad0e
RG
658{
659 struct bq27x00_device_info *di = i2c_get_clientdata(client);
660
740b755a 661 bq27x00_powersupply_unregister(di);
b996ad0e
RG
662
663 kfree(di->bat.name);
664
665 mutex_lock(&battery_mutex);
666 idr_remove(&battery_id, di->id);
667 mutex_unlock(&battery_mutex);
668
669 kfree(di);
670
671 return 0;
672}
673
e20908d9
GI
674static const struct i2c_device_id bq27x00_id[] = {
675 { "bq27200", BQ27000 }, /* bq27200 is same as bq27000, but with i2c */
676 { "bq27500", BQ27500 },
b996ad0e
RG
677 {},
678};
fd9b958c 679MODULE_DEVICE_TABLE(i2c, bq27x00_id);
b996ad0e 680
e20908d9 681static struct i2c_driver bq27x00_battery_driver = {
b996ad0e 682 .driver = {
e20908d9 683 .name = "bq27x00-battery",
b996ad0e 684 },
e20908d9
GI
685 .probe = bq27x00_battery_probe,
686 .remove = bq27x00_battery_remove,
687 .id_table = bq27x00_id,
b996ad0e
RG
688};
689
7fb7ba58
LPC
690static inline int bq27x00_battery_i2c_init(void)
691{
692 int ret = i2c_add_driver(&bq27x00_battery_driver);
693 if (ret)
694 printk(KERN_ERR "Unable to register BQ27x00 i2c driver\n");
695
696 return ret;
697}
698
699static inline void bq27x00_battery_i2c_exit(void)
700{
701 i2c_del_driver(&bq27x00_battery_driver);
702}
703
704#else
705
706static inline int bq27x00_battery_i2c_init(void) { return 0; }
707static inline void bq27x00_battery_i2c_exit(void) {};
708
709#endif
710
711/* platform specific code */
712#ifdef CONFIG_BATTERY_BQ27X00_PLATFORM
713
714static int bq27000_read_platform(struct bq27x00_device_info *di, u8 reg,
297a533b 715 bool single)
7fb7ba58
LPC
716{
717 struct device *dev = di->dev;
718 struct bq27000_platform_data *pdata = dev->platform_data;
719 unsigned int timeout = 3;
720 int upper, lower;
721 int temp;
722
723 if (!single) {
724 /* Make sure the value has not changed in between reading the
725 * lower and the upper part */
726 upper = pdata->read(dev, reg + 1);
727 do {
728 temp = upper;
729 if (upper < 0)
730 return upper;
731
732 lower = pdata->read(dev, reg);
733 if (lower < 0)
734 return lower;
735
736 upper = pdata->read(dev, reg + 1);
737 } while (temp != upper && --timeout);
738
739 if (timeout == 0)
740 return -EIO;
741
297a533b 742 return (upper << 8) | lower;
7fb7ba58 743 }
297a533b
LPC
744
745 return pdata->read(dev, reg);
7fb7ba58
LPC
746}
747
748static int __devinit bq27000_battery_probe(struct platform_device *pdev)
749{
750 struct bq27x00_device_info *di;
751 struct bq27000_platform_data *pdata = pdev->dev.platform_data;
752 int ret;
753
754 if (!pdata) {
755 dev_err(&pdev->dev, "no platform_data supplied\n");
756 return -EINVAL;
757 }
758
759 if (!pdata->read) {
760 dev_err(&pdev->dev, "no hdq read callback supplied\n");
761 return -EINVAL;
762 }
763
764 di = kzalloc(sizeof(*di), GFP_KERNEL);
765 if (!di) {
766 dev_err(&pdev->dev, "failed to allocate device info data\n");
767 return -ENOMEM;
768 }
769
770 platform_set_drvdata(pdev, di);
771
772 di->dev = &pdev->dev;
773 di->chip = BQ27000;
774
775 di->bat.name = pdata->name ?: dev_name(&pdev->dev);
776 di->bus.read = &bq27000_read_platform;
777
778 ret = bq27x00_powersupply_init(di);
779 if (ret)
780 goto err_free;
781
782 return 0;
783
784err_free:
785 platform_set_drvdata(pdev, NULL);
786 kfree(di);
787
788 return ret;
789}
790
791static int __devexit bq27000_battery_remove(struct platform_device *pdev)
792{
793 struct bq27x00_device_info *di = platform_get_drvdata(pdev);
794
740b755a
LPC
795 bq27x00_powersupply_unregister(di);
796
7fb7ba58
LPC
797 platform_set_drvdata(pdev, NULL);
798 kfree(di);
799
800 return 0;
801}
802
803static struct platform_driver bq27000_battery_driver = {
804 .probe = bq27000_battery_probe,
805 .remove = __devexit_p(bq27000_battery_remove),
806 .driver = {
807 .name = "bq27000-battery",
808 .owner = THIS_MODULE,
809 },
810};
811
812static inline int bq27x00_battery_platform_init(void)
813{
814 int ret = platform_driver_register(&bq27000_battery_driver);
815 if (ret)
816 printk(KERN_ERR "Unable to register BQ27000 platform driver\n");
817
818 return ret;
819}
820
821static inline void bq27x00_battery_platform_exit(void)
822{
823 platform_driver_unregister(&bq27000_battery_driver);
824}
825
826#else
827
828static inline int bq27x00_battery_platform_init(void) { return 0; }
829static inline void bq27x00_battery_platform_exit(void) {};
830
831#endif
832
833/*
834 * Module stuff
835 */
836
b996ad0e
RG
837static int __init bq27x00_battery_init(void)
838{
839 int ret;
840
7fb7ba58
LPC
841 ret = bq27x00_battery_i2c_init();
842 if (ret)
843 return ret;
844
845 ret = bq27x00_battery_platform_init();
b996ad0e 846 if (ret)
7fb7ba58 847 bq27x00_battery_i2c_exit();
b996ad0e
RG
848
849 return ret;
850}
851module_init(bq27x00_battery_init);
852
853static void __exit bq27x00_battery_exit(void)
854{
7fb7ba58
LPC
855 bq27x00_battery_platform_exit();
856 bq27x00_battery_i2c_exit();
b996ad0e
RG
857}
858module_exit(bq27x00_battery_exit);
859
860MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>");
861MODULE_DESCRIPTION("BQ27x00 battery monitor driver");
862MODULE_LICENSE("GPL");
This page took 0.324215 seconds and 5 git commands to generate.