bq27x00_battery.c 19.5 KB
Newer Older
1 2 3 4 5
/*
 * BQ27x00 battery driver
 *
 * Copyright (C) 2008 Rodolfo Giometti <giometti@linux.it>
 * Copyright (C) 2008 Eurotech S.p.A. <info@eurotech.it>
6
 * Copyright (C) 2010-2011 Lars-Peter Clausen <lars@metafoo.de>
7
 * Copyright (C) 2011 Pali Rohár <pali.rohar@gmail.com>
8 9 10 11 12 13 14 15 16 17 18 19
 *
 * Based on a previous work by Copyright (C) 2008 Texas Instruments, Inc.
 *
 * This package is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * THIS PACKAGE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
 * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
 *
 */
P
Pali Rohár 已提交
20 21 22 23 24 25 26

/*
 * Datasheets:
 * http://focus.ti.com/docs/prod/folders/print/bq27000.html
 * http://focus.ti.com/docs/prod/folders/print/bq27500.html
 */

27 28 29 30 31 32 33 34 35
#include <linux/module.h>
#include <linux/param.h>
#include <linux/jiffies.h>
#include <linux/workqueue.h>
#include <linux/delay.h>
#include <linux/platform_device.h>
#include <linux/power_supply.h>
#include <linux/idr.h>
#include <linux/i2c.h>
36
#include <linux/slab.h>
37
#include <asm/unaligned.h>
38

39 40
#include <linux/power/bq27x00_battery.h>

P
Pali Rohár 已提交
41
#define DRIVER_VERSION			"1.2.0"
42 43 44 45 46

#define BQ27x00_REG_TEMP		0x06
#define BQ27x00_REG_VOLT		0x08
#define BQ27x00_REG_AI			0x14
#define BQ27x00_REG_FLAGS		0x0A
47 48 49
#define BQ27x00_REG_TTE			0x16
#define BQ27x00_REG_TTF			0x18
#define BQ27x00_REG_TTECP		0x26
P
Pali Rohár 已提交
50 51 52 53
#define BQ27x00_REG_NAC			0x0C /* Nominal available capaciy */
#define BQ27x00_REG_LMD			0x12 /* Last measured discharge */
#define BQ27x00_REG_CYCT		0x2A /* Cycle count total */
#define BQ27x00_REG_AE			0x22 /* Available enery */
54

55
#define BQ27000_REG_RSOC		0x0B /* Relative State-of-Charge */
P
Pali Rohár 已提交
56
#define BQ27000_REG_ILMD		0x76 /* Initial last measured discharge */
57
#define BQ27000_FLAG_CHGS		BIT(7)
58
#define BQ27000_FLAG_FC			BIT(5)
59

P
Pali Rohár 已提交
60
#define BQ27500_REG_SOC			0x2C
P
Pali Rohár 已提交
61
#define BQ27500_REG_DCAP		0x3C /* Design capacity */
62 63
#define BQ27500_FLAG_DSC		BIT(0)
#define BQ27500_FLAG_FC			BIT(9)
64

P
Pali Rohár 已提交
65 66
#define BQ27000_RS			20 /* Resistor sense */

67 68
struct bq27x00_device_info;
struct bq27x00_access_methods {
69
	int (*read)(struct bq27x00_device_info *di, u8 reg, bool single);
70 71
};

72 73
enum bq27x00_chip { BQ27000, BQ27500 };

74 75 76 77 78
struct bq27x00_reg_cache {
	int temperature;
	int time_to_empty;
	int time_to_empty_avg;
	int time_to_full;
P
Pali Rohár 已提交
79
	int charge_full;
80
	int cycle_count;
81 82 83 84 85 86
	int capacity;
	int flags;

	int current_now;
};

87 88 89
struct bq27x00_device_info {
	struct device 		*dev;
	int			id;
90
	enum bq27x00_chip	chip;
91

92
	struct bq27x00_reg_cache cache;
P
Pali Rohár 已提交
93 94
	int charge_design_full;

95
	unsigned long last_update;
L
Lars-Peter Clausen 已提交
96
	struct delayed_work work;
97

98 99 100
	struct power_supply	bat;

	struct bq27x00_access_methods bus;
L
Lars-Peter Clausen 已提交
101 102

	struct mutex lock;
103 104 105
};

static enum power_supply_property bq27x00_battery_props[] = {
106
	POWER_SUPPLY_PROP_STATUS,
107 108 109 110 111
	POWER_SUPPLY_PROP_PRESENT,
	POWER_SUPPLY_PROP_VOLTAGE_NOW,
	POWER_SUPPLY_PROP_CURRENT_NOW,
	POWER_SUPPLY_PROP_CAPACITY,
	POWER_SUPPLY_PROP_TEMP,
112 113 114
	POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
	POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG,
	POWER_SUPPLY_PROP_TIME_TO_FULL_NOW,
L
Lars-Peter Clausen 已提交
115
	POWER_SUPPLY_PROP_TECHNOLOGY,
P
Pali Rohár 已提交
116 117 118
	POWER_SUPPLY_PROP_CHARGE_FULL,
	POWER_SUPPLY_PROP_CHARGE_NOW,
	POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
119
	POWER_SUPPLY_PROP_CYCLE_COUNT,
P
Pali Rohár 已提交
120
	POWER_SUPPLY_PROP_ENERGY_NOW,
121 122
};

L
Lars-Peter Clausen 已提交
123 124 125 126 127
static unsigned int poll_interval = 360;
module_param(poll_interval, uint, 0644);
MODULE_PARM_DESC(poll_interval, "battery poll interval in seconds - " \
				"0 disables polling");

128 129 130 131
/*
 * Common code for BQ27x00 devices
 */

132
static inline int bq27x00_read(struct bq27x00_device_info *di, u8 reg,
133
		bool single)
134
{
135
	return di->bus.read(di, reg, single);
136 137 138
}

/*
139
 * Return the battery Relative State-of-Charge
140 141
 * Or < 0 if something fails.
 */
142
static int bq27x00_battery_read_rsoc(struct bq27x00_device_info *di)
143
{
144
	int rsoc;
145

146
	if (di->chip == BQ27500)
147
		rsoc = bq27x00_read(di, BQ27500_REG_SOC, false);
148
	else
149 150 151 152 153 154
		rsoc = bq27x00_read(di, BQ27000_REG_RSOC, true);

	if (rsoc < 0)
		dev_err(di->dev, "error reading relative State-of-Charge\n");

	return rsoc;
155 156
}

P
Pali Rohár 已提交
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
/*
 * Return a battery charge value in µAh
 * Or < 0 if something fails.
 */
static int bq27x00_battery_read_charge(struct bq27x00_device_info *di, u8 reg)
{
	int charge;

	charge = bq27x00_read(di, reg, false);
	if (charge < 0) {
		dev_err(di->dev, "error reading nominal available capacity\n");
		return charge;
	}

	if (di->chip == BQ27500)
		charge *= 1000;
	else
		charge = charge * 3570 / BQ27000_RS;

	return charge;
}

/*
 * Return the battery Nominal available capaciy in µAh
 * Or < 0 if something fails.
 */
static inline int bq27x00_battery_read_nac(struct bq27x00_device_info *di)
{
	return bq27x00_battery_read_charge(di, BQ27x00_REG_NAC);
}

/*
 * Return the battery Last measured discharge in µAh
 * Or < 0 if something fails.
 */
static inline int bq27x00_battery_read_lmd(struct bq27x00_device_info *di)
{
	return bq27x00_battery_read_charge(di, BQ27x00_REG_LMD);
}

/*
 * Return the battery Initial last measured discharge in µAh
 * Or < 0 if something fails.
 */
static int bq27x00_battery_read_ilmd(struct bq27x00_device_info *di)
{
	int ilmd;

	if (di->chip == BQ27500)
		ilmd = bq27x00_read(di, BQ27500_REG_DCAP, false);
	else
		ilmd = bq27x00_read(di, BQ27000_REG_ILMD, true);

	if (ilmd < 0) {
		dev_err(di->dev, "error reading initial last measured discharge\n");
		return ilmd;
	}

	if (di->chip == BQ27500)
		ilmd *= 1000;
	else
		ilmd = ilmd * 256 * 3570 / BQ27000_RS;

	return ilmd;
}

/*
 * Return the battery Cycle count total
 * Or < 0 if something fails.
 */
static int bq27x00_battery_read_cyct(struct bq27x00_device_info *di)
{
	int cyct;

	cyct = bq27x00_read(di, BQ27x00_REG_CYCT, false);
	if (cyct < 0)
		dev_err(di->dev, "error reading cycle count total\n");

	return cyct;
}

238
/*
239 240
 * Read a time register.
 * Return < 0 if something fails.
241
 */
242
static int bq27x00_battery_read_time(struct bq27x00_device_info *di, u8 reg)
243
{
244
	int tval;
245

246 247 248 249
	tval = bq27x00_read(di, reg, false);
	if (tval < 0) {
		dev_err(di->dev, "error reading register %02x: %d\n", reg, tval);
		return tval;
250 251
	}

252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269
	if (tval == 65535)
		return -ENODATA;

	return tval * 60;
}

static void bq27x00_update(struct bq27x00_device_info *di)
{
	struct bq27x00_reg_cache cache = {0, };
	bool is_bq27500 = di->chip == BQ27500;

	cache.flags = bq27x00_read(di, BQ27x00_REG_FLAGS, is_bq27500);
	if (cache.flags >= 0) {
		cache.capacity = bq27x00_battery_read_rsoc(di);
		cache.temperature = bq27x00_read(di, BQ27x00_REG_TEMP, false);
		cache.time_to_empty = bq27x00_battery_read_time(di, BQ27x00_REG_TTE);
		cache.time_to_empty_avg = bq27x00_battery_read_time(di, BQ27x00_REG_TTECP);
		cache.time_to_full = bq27x00_battery_read_time(di, BQ27x00_REG_TTF);
P
Pali Rohár 已提交
270
		cache.charge_full = bq27x00_battery_read_lmd(di);
271
		cache.cycle_count = bq27x00_battery_read_cyct(di);
272 273 274

		if (!is_bq27500)
			cache.current_now = bq27x00_read(di, BQ27x00_REG_AI, false);
P
Pali Rohár 已提交
275 276 277 278

		/* We only have to read charge design full once */
		if (di->charge_design_full <= 0)
			di->charge_design_full = bq27x00_battery_read_ilmd(di);
279 280 281 282 283 284 285 286 287 288 289 290
	}

	/* Ignore current_now which is a snapshot of the current battery state
	 * and is likely to be different even between two consecutive reads */
	if (memcmp(&di->cache, &cache, sizeof(cache) - sizeof(int)) != 0) {
		di->cache = cache;
		power_supply_changed(&di->bat);
	}

	di->last_update = jiffies;
}

L
Lars-Peter Clausen 已提交
291 292 293 294 295 296 297 298 299 300 301 302 303 304 305
static void bq27x00_battery_poll(struct work_struct *work)
{
	struct bq27x00_device_info *di =
		container_of(work, struct bq27x00_device_info, work.work);

	bq27x00_update(di);

	if (poll_interval > 0) {
		/* The timer does not have to be accurate. */
		set_timer_slack(&di->work.timer, poll_interval * HZ / 4);
		schedule_delayed_work(&di->work, poll_interval * HZ);
	}
}


306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321
/*
 * Return the battery temperature in tenths of degree Celsius
 * Or < 0 if something fails.
 */
static int bq27x00_battery_temperature(struct bq27x00_device_info *di,
	union power_supply_propval *val)
{
	if (di->cache.temperature < 0)
		return di->cache.temperature;

	if (di->chip == BQ27500)
		val->intval = di->cache.temperature - 2731;
	else
		val->intval = ((di->cache.temperature * 5) - 5463) / 2;

	return 0;
322 323 324
}

/*
P
Pali Rohár 已提交
325
 * Return the battery average current in µA
326 327 328
 * Note that current can be negative signed as well
 * Or 0 if something fails.
 */
329 330
static int bq27x00_battery_current(struct bq27x00_device_info *di,
	union power_supply_propval *val)
331
{
332
	int curr;
333

334 335 336 337 338 339 340
	if (di->chip == BQ27500)
	    curr = bq27x00_read(di, BQ27x00_REG_AI, false);
	else
	    curr = di->cache.current_now;

	if (curr < 0)
		return curr;
341 342 343

	if (di->chip == BQ27500) {
		/* bq27500 returns signed value */
344
		val->intval = (int)((s16)curr) * 1000;
345
	} else {
346
		if (di->cache.flags & BQ27000_FLAG_CHGS) {
347
			dev_dbg(di->dev, "negative current!\n");
348
			curr = -curr;
349
		}
350

351
		val->intval = curr * 3570 / BQ27000_RS;
352 353
	}

354
	return 0;
355 356
}

357
static int bq27x00_battery_status(struct bq27x00_device_info *di,
358
	union power_supply_propval *val)
359 360 361 362
{
	int status;

	if (di->chip == BQ27500) {
363
		if (di->cache.flags & BQ27500_FLAG_FC)
364
			status = POWER_SUPPLY_STATUS_FULL;
365
		else if (di->cache.flags & BQ27500_FLAG_DSC)
366 367 368 369
			status = POWER_SUPPLY_STATUS_DISCHARGING;
		else
			status = POWER_SUPPLY_STATUS_CHARGING;
	} else {
370 371 372
		if (di->cache.flags & BQ27000_FLAG_FC)
			status = POWER_SUPPLY_STATUS_FULL;
		else if (di->cache.flags & BQ27000_FLAG_CHGS)
373
			status = POWER_SUPPLY_STATUS_CHARGING;
374 375
		else if (power_supply_am_i_supplied(&di->bat))
			status = POWER_SUPPLY_STATUS_NOT_CHARGING;
376 377 378 379 380
		else
			status = POWER_SUPPLY_STATUS_DISCHARGING;
	}

	val->intval = status;
381

382 383 384 385
	return 0;
}

/*
386 387
 * Return the battery Voltage in milivolts
 * Or < 0 if something fails.
388
 */
389 390
static int bq27x00_battery_voltage(struct bq27x00_device_info *di,
	union power_supply_propval *val)
391
{
392
	int volt;
393

394 395 396
	volt = bq27x00_read(di, BQ27x00_REG_VOLT, false);
	if (volt < 0)
		return volt;
397

398 399 400 401 402
	val->intval = volt * 1000;

	return 0;
}

P
Pali Rohár 已提交
403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428
/*
 * Return the battery Available energy in µWh
 * Or < 0 if something fails.
 */
static int bq27x00_battery_energy(struct bq27x00_device_info *di,
	union power_supply_propval *val)
{
	int ae;

	ae = bq27x00_read(di, BQ27x00_REG_AE, false);
	if (ae < 0) {
		dev_err(di->dev, "error reading available energy\n");
		return ae;
	}

	if (di->chip == BQ27500)
		ae *= 1000;
	else
		ae = ae * 29200 / BQ27000_RS;

	val->intval = ae;

	return 0;
}


429 430 431 432 433 434 435
static int bq27x00_simple_value(int value,
	union power_supply_propval *val)
{
	if (value < 0)
		return value;

	val->intval = value;
436 437 438 439

	return 0;
}

440 441 442 443 444 445 446
#define to_bq27x00_device_info(x) container_of((x), \
				struct bq27x00_device_info, bat);

static int bq27x00_battery_get_property(struct power_supply *psy,
					enum power_supply_property psp,
					union power_supply_propval *val)
{
447
	int ret = 0;
448
	struct bq27x00_device_info *di = to_bq27x00_device_info(psy);
449

L
Lars-Peter Clausen 已提交
450 451 452 453 454 455
	mutex_lock(&di->lock);
	if (time_is_before_jiffies(di->last_update + 5 * HZ)) {
		cancel_delayed_work_sync(&di->work);
		bq27x00_battery_poll(&di->work.work);
	}
	mutex_unlock(&di->lock);
456 457

	if (psp != POWER_SUPPLY_PROP_PRESENT && di->cache.flags < 0)
458
		return -ENODEV;
459 460

	switch (psp) {
461 462 463
	case POWER_SUPPLY_PROP_STATUS:
		ret = bq27x00_battery_status(di, val);
		break;
464
	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
465
		ret = bq27x00_battery_voltage(di, val);
466
		break;
467
	case POWER_SUPPLY_PROP_PRESENT:
468
		val->intval = di->cache.flags < 0 ? 0 : 1;
469 470
		break;
	case POWER_SUPPLY_PROP_CURRENT_NOW:
471
		ret = bq27x00_battery_current(di, val);
472 473
		break;
	case POWER_SUPPLY_PROP_CAPACITY:
474
		ret = bq27x00_simple_value(di->cache.capacity, val);
475 476
		break;
	case POWER_SUPPLY_PROP_TEMP:
477
		ret = bq27x00_battery_temperature(di, val);
478
		break;
479
	case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW:
480
		ret = bq27x00_simple_value(di->cache.time_to_empty, val);
481 482
		break;
	case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
483
		ret = bq27x00_simple_value(di->cache.time_to_empty_avg, val);
484 485
		break;
	case POWER_SUPPLY_PROP_TIME_TO_FULL_NOW:
486
		ret = bq27x00_simple_value(di->cache.time_to_full, val);
487
		break;
L
Lars-Peter Clausen 已提交
488 489 490
	case POWER_SUPPLY_PROP_TECHNOLOGY:
		val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
		break;
P
Pali Rohár 已提交
491 492 493 494 495 496 497 498 499
	case POWER_SUPPLY_PROP_CHARGE_NOW:
		ret = bq27x00_simple_value(bq27x00_battery_read_nac(di), val);
		break;
	case POWER_SUPPLY_PROP_CHARGE_FULL:
		ret = bq27x00_simple_value(di->cache.charge_full, val);
		break;
	case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
		ret = bq27x00_simple_value(di->charge_design_full, val);
		break;
500 501
	case POWER_SUPPLY_PROP_CYCLE_COUNT:
		ret = bq27x00_simple_value(di->cache.cycle_count, val);
P
Pali Rohár 已提交
502 503 504 505
		break;
	case POWER_SUPPLY_PROP_ENERGY_NOW:
		ret = bq27x00_battery_energy(di, val);
		break;
506 507 508 509
	default:
		return -EINVAL;
	}

510
	return ret;
511 512
}

L
Lars-Peter Clausen 已提交
513 514 515 516 517 518 519 520
static void bq27x00_external_power_changed(struct power_supply *psy)
{
	struct bq27x00_device_info *di = to_bq27x00_device_info(psy);

	cancel_delayed_work_sync(&di->work);
	schedule_delayed_work(&di->work, 0);
}

521
static int bq27x00_powersupply_init(struct bq27x00_device_info *di)
522
{
523 524
	int ret;

525 526 527 528
	di->bat.type = POWER_SUPPLY_TYPE_BATTERY;
	di->bat.properties = bq27x00_battery_props;
	di->bat.num_properties = ARRAY_SIZE(bq27x00_battery_props);
	di->bat.get_property = bq27x00_battery_get_property;
L
Lars-Peter Clausen 已提交
529 530 531 532
	di->bat.external_power_changed = bq27x00_external_power_changed;

	INIT_DELAYED_WORK(&di->work, bq27x00_battery_poll);
	mutex_init(&di->lock);
533 534 535 536 537 538 539 540 541

	ret = power_supply_register(di->dev, &di->bat);
	if (ret) {
		dev_err(di->dev, "failed to register battery: %d\n", ret);
		return ret;
	}

	dev_info(di->dev, "support ver. %s enabled\n", DRIVER_VERSION);

542 543
	bq27x00_update(di);

544
	return 0;
545 546
}

L
Lars-Peter Clausen 已提交
547 548 549 550 551 552 553 554 555
static void bq27x00_powersupply_unregister(struct bq27x00_device_info *di)
{
	cancel_delayed_work_sync(&di->work);

	power_supply_unregister(&di->bat);

	mutex_destroy(&di->lock);
}

556 557 558 559 560 561

/* i2c specific code */
#ifdef CONFIG_BATTERY_BQ27X00_I2C

/* If the system has several batteries we need a different name for each
 * of them...
562
 */
563 564
static DEFINE_IDR(battery_id);
static DEFINE_MUTEX(battery_mutex);
565

566
static int bq27x00_read_i2c(struct bq27x00_device_info *di, u8 reg, bool single)
567
{
568
	struct i2c_client *client = to_i2c_client(di->dev);
569
	struct i2c_msg msg[2];
570
	unsigned char data[2];
571
	int ret;
572 573 574 575

	if (!client->adapter)
		return -ENODEV;

576 577 578 579 580 581 582
	msg[0].addr = client->addr;
	msg[0].flags = 0;
	msg[0].buf = &reg;
	msg[0].len = sizeof(reg);
	msg[1].addr = client->addr;
	msg[1].flags = I2C_M_RD;
	msg[1].buf = data;
583
	if (single)
584
		msg[1].len = 1;
585
	else
586
		msg[1].len = 2;
587

588
	ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
589 590 591 592 593 594 595
	if (ret < 0)
		return ret;

	if (!single)
		ret = get_unaligned_le16(data);
	else
		ret = data[0];
596

597
	return ret;
598 599
}

600
static int bq27x00_battery_probe(struct i2c_client *client,
601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617
				 const struct i2c_device_id *id)
{
	char *name;
	struct bq27x00_device_info *di;
	int num;
	int retval = 0;

	/* Get new ID for the new battery device */
	retval = idr_pre_get(&battery_id, GFP_KERNEL);
	if (retval == 0)
		return -ENOMEM;
	mutex_lock(&battery_mutex);
	retval = idr_get_new(&battery_id, client, &num);
	mutex_unlock(&battery_mutex);
	if (retval < 0)
		return retval;

618
	name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
619 620 621 622 623 624 625 626 627 628 629 630
	if (!name) {
		dev_err(&client->dev, "failed to allocate device name\n");
		retval = -ENOMEM;
		goto batt_failed_1;
	}

	di = kzalloc(sizeof(*di), GFP_KERNEL);
	if (!di) {
		dev_err(&client->dev, "failed to allocate device info data\n");
		retval = -ENOMEM;
		goto batt_failed_2;
	}
631

632
	di->id = num;
633
	di->dev = &client->dev;
634
	di->chip = id->driver_data;
635 636
	di->bat.name = name;
	di->bus.read = &bq27x00_read_i2c;
637

638
	if (bq27x00_powersupply_init(di))
639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656
		goto batt_failed_3;

	i2c_set_clientdata(client, di);

	return 0;

batt_failed_3:
	kfree(di);
batt_failed_2:
	kfree(name);
batt_failed_1:
	mutex_lock(&battery_mutex);
	idr_remove(&battery_id, num);
	mutex_unlock(&battery_mutex);

	return retval;
}

657
static int bq27x00_battery_remove(struct i2c_client *client)
658 659 660
{
	struct bq27x00_device_info *di = i2c_get_clientdata(client);

L
Lars-Peter Clausen 已提交
661
	bq27x00_powersupply_unregister(di);
662 663 664 665 666 667 668 669 670 671 672 673

	kfree(di->bat.name);

	mutex_lock(&battery_mutex);
	idr_remove(&battery_id, di->id);
	mutex_unlock(&battery_mutex);

	kfree(di);

	return 0;
}

674 675 676
static const struct i2c_device_id bq27x00_id[] = {
	{ "bq27200", BQ27000 },	/* bq27200 is same as bq27000, but with i2c */
	{ "bq27500", BQ27500 },
677 678
	{},
};
P
Pali Rohár 已提交
679
MODULE_DEVICE_TABLE(i2c, bq27x00_id);
680

681
static struct i2c_driver bq27x00_battery_driver = {
682
	.driver = {
683
		.name = "bq27x00-battery",
684
	},
685 686 687
	.probe = bq27x00_battery_probe,
	.remove = bq27x00_battery_remove,
	.id_table = bq27x00_id,
688 689
};

690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714
static inline int bq27x00_battery_i2c_init(void)
{
	int ret = i2c_add_driver(&bq27x00_battery_driver);
	if (ret)
		printk(KERN_ERR "Unable to register BQ27x00 i2c driver\n");

	return ret;
}

static inline void bq27x00_battery_i2c_exit(void)
{
	i2c_del_driver(&bq27x00_battery_driver);
}

#else

static inline int bq27x00_battery_i2c_init(void) { return 0; }
static inline void bq27x00_battery_i2c_exit(void) {};

#endif

/* platform specific code */
#ifdef CONFIG_BATTERY_BQ27X00_PLATFORM

static int bq27000_read_platform(struct bq27x00_device_info *di, u8 reg,
715
			bool single)
716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741
{
	struct device *dev = di->dev;
	struct bq27000_platform_data *pdata = dev->platform_data;
	unsigned int timeout = 3;
	int upper, lower;
	int temp;

	if (!single) {
		/* Make sure the value has not changed in between reading the
		 * lower and the upper part */
		upper = pdata->read(dev, reg + 1);
		do {
			temp = upper;
			if (upper < 0)
				return upper;

			lower = pdata->read(dev, reg);
			if (lower < 0)
				return lower;

			upper = pdata->read(dev, reg + 1);
		} while (temp != upper && --timeout);

		if (timeout == 0)
			return -EIO;

742
		return (upper << 8) | lower;
743
	}
744 745

	return pdata->read(dev, reg);
746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794
}

static int __devinit bq27000_battery_probe(struct platform_device *pdev)
{
	struct bq27x00_device_info *di;
	struct bq27000_platform_data *pdata = pdev->dev.platform_data;
	int ret;

	if (!pdata) {
		dev_err(&pdev->dev, "no platform_data supplied\n");
		return -EINVAL;
	}

	if (!pdata->read) {
		dev_err(&pdev->dev, "no hdq read callback supplied\n");
		return -EINVAL;
	}

	di = kzalloc(sizeof(*di), GFP_KERNEL);
	if (!di) {
		dev_err(&pdev->dev, "failed to allocate device info data\n");
		return -ENOMEM;
	}

	platform_set_drvdata(pdev, di);

	di->dev = &pdev->dev;
	di->chip = BQ27000;

	di->bat.name = pdata->name ?: dev_name(&pdev->dev);
	di->bus.read = &bq27000_read_platform;

	ret = bq27x00_powersupply_init(di);
	if (ret)
		goto err_free;

	return 0;

err_free:
	platform_set_drvdata(pdev, NULL);
	kfree(di);

	return ret;
}

static int __devexit bq27000_battery_remove(struct platform_device *pdev)
{
	struct bq27x00_device_info *di = platform_get_drvdata(pdev);

L
Lars-Peter Clausen 已提交
795 796
	bq27x00_powersupply_unregister(di);

797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836
	platform_set_drvdata(pdev, NULL);
	kfree(di);

	return 0;
}

static struct platform_driver bq27000_battery_driver = {
	.probe	= bq27000_battery_probe,
	.remove = __devexit_p(bq27000_battery_remove),
	.driver = {
		.name = "bq27000-battery",
		.owner = THIS_MODULE,
	},
};

static inline int bq27x00_battery_platform_init(void)
{
	int ret = platform_driver_register(&bq27000_battery_driver);
	if (ret)
		printk(KERN_ERR "Unable to register BQ27000 platform driver\n");

	return ret;
}

static inline void bq27x00_battery_platform_exit(void)
{
	platform_driver_unregister(&bq27000_battery_driver);
}

#else

static inline int bq27x00_battery_platform_init(void) { return 0; }
static inline void bq27x00_battery_platform_exit(void) {};

#endif

/*
 * Module stuff
 */

837 838 839 840
static int __init bq27x00_battery_init(void)
{
	int ret;

841 842 843 844 845
	ret = bq27x00_battery_i2c_init();
	if (ret)
		return ret;

	ret = bq27x00_battery_platform_init();
846
	if (ret)
847
		bq27x00_battery_i2c_exit();
848 849 850 851 852 853 854

	return ret;
}
module_init(bq27x00_battery_init);

static void __exit bq27x00_battery_exit(void)
{
855 856
	bq27x00_battery_platform_exit();
	bq27x00_battery_i2c_exit();
857 858 859 860 861 862
}
module_exit(bq27x00_battery_exit);

MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>");
MODULE_DESCRIPTION("BQ27x00 battery monitor driver");
MODULE_LICENSE("GPL");