bq27x00_battery.c 19.2 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 8 9 10 11 12 13 14 15 16 17 18
 *
 * 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 已提交
19 20 21 22 23 24 25

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

26 27 28 29 30 31 32 33 34
#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>
35
#include <linux/slab.h>
36
#include <asm/unaligned.h>
37

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

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

#define BQ27x00_REG_TEMP		0x06
#define BQ27x00_REG_VOLT		0x08
#define BQ27x00_REG_AI			0x14
#define BQ27x00_REG_FLAGS		0x0A
46 47 48
#define BQ27x00_REG_TTE			0x16
#define BQ27x00_REG_TTF			0x18
#define BQ27x00_REG_TTECP		0x26
P
Pali Rohár 已提交
49 50 51 52
#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 */
53

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

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

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

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

70 71
enum bq27x00_chip { BQ27000, BQ27500 };

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

	int current_now;
};

85 86 87
struct bq27x00_device_info {
	struct device 		*dev;
	int			id;
88
	enum bq27x00_chip	chip;
89

90
	struct bq27x00_reg_cache cache;
P
Pali Rohár 已提交
91 92
	int charge_design_full;

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

96 97 98
	struct power_supply	bat;

	struct bq27x00_access_methods bus;
L
Lars-Peter Clausen 已提交
99 100

	struct mutex lock;
101 102 103
};

static enum power_supply_property bq27x00_battery_props[] = {
104
	POWER_SUPPLY_PROP_STATUS,
105 106 107 108 109
	POWER_SUPPLY_PROP_PRESENT,
	POWER_SUPPLY_PROP_VOLTAGE_NOW,
	POWER_SUPPLY_PROP_CURRENT_NOW,
	POWER_SUPPLY_PROP_CAPACITY,
	POWER_SUPPLY_PROP_TEMP,
110 111 112
	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 已提交
113
	POWER_SUPPLY_PROP_TECHNOLOGY,
P
Pali Rohár 已提交
114 115 116 117 118
	POWER_SUPPLY_PROP_CHARGE_FULL,
	POWER_SUPPLY_PROP_CHARGE_NOW,
	POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
	POWER_SUPPLY_PROP_CHARGE_COUNTER,
	POWER_SUPPLY_PROP_ENERGY_NOW,
119 120
};

L
Lars-Peter Clausen 已提交
121 122 123 124 125
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");

126 127 128 129
/*
 * Common code for BQ27x00 devices
 */

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

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

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

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

	return rsoc;
153 154
}

P
Pali Rohár 已提交
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
/*
 * 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;
}

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

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

250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267
	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 已提交
268 269
		cache.charge_full = bq27x00_battery_read_lmd(di);
		cache.charge_counter = bq27x00_battery_read_cyct(di);
270 271 272

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

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

	/* 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 已提交
289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
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);
	}
}


304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319
/*
 * 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;
320 321 322 323 324 325 326
}

/*
 * Return the battery average current
 * Note that current can be negative signed as well
 * Or 0 if something fails.
 */
327 328
static int bq27x00_battery_current(struct bq27x00_device_info *di,
	union power_supply_propval *val)
329
{
330
	int curr;
331

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

	if (curr < 0)
		return curr;
339 340 341

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

349
		val->intval = curr * 3570 / BQ27000_RS;
350 351
	}

352
	return 0;
353 354
}

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

	if (di->chip == BQ27500) {
361
		if (di->cache.flags & BQ27500_FLAG_FC)
362
			status = POWER_SUPPLY_STATUS_FULL;
363
		else if (di->cache.flags & BQ27500_FLAG_DSC)
364 365 366 367
			status = POWER_SUPPLY_STATUS_DISCHARGING;
		else
			status = POWER_SUPPLY_STATUS_CHARGING;
	} else {
368
		if (di->cache.flags & BQ27000_FLAG_CHGS)
369 370 371 372 373 374
			status = POWER_SUPPLY_STATUS_CHARGING;
		else
			status = POWER_SUPPLY_STATUS_DISCHARGING;
	}

	val->intval = status;
375

376 377 378 379
	return 0;
}

/*
380 381
 * Return the battery Voltage in milivolts
 * Or < 0 if something fails.
382
 */
383 384
static int bq27x00_battery_voltage(struct bq27x00_device_info *di,
	union power_supply_propval *val)
385
{
386
	int volt;
387

388 389 390
	volt = bq27x00_read(di, BQ27x00_REG_VOLT, false);
	if (volt < 0)
		return volt;
391

392 393 394 395 396
	val->intval = volt * 1000;

	return 0;
}

P
Pali Rohár 已提交
397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422
/*
 * 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;
}


423 424 425 426 427 428 429
static int bq27x00_simple_value(int value,
	union power_supply_propval *val)
{
	if (value < 0)
		return value;

	val->intval = value;
430 431 432 433

	return 0;
}

434 435 436 437 438 439 440
#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)
{
441
	int ret = 0;
442
	struct bq27x00_device_info *di = to_bq27x00_device_info(psy);
443

L
Lars-Peter Clausen 已提交
444 445 446 447 448 449
	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);
450 451

	if (psp != POWER_SUPPLY_PROP_PRESENT && di->cache.flags < 0)
452
		return -ENODEV;
453 454

	switch (psp) {
455 456 457
	case POWER_SUPPLY_PROP_STATUS:
		ret = bq27x00_battery_status(di, val);
		break;
458
	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
459
		ret = bq27x00_battery_voltage(di, val);
460
		break;
461
	case POWER_SUPPLY_PROP_PRESENT:
462
		val->intval = di->cache.flags < 0 ? 0 : 1;
463 464
		break;
	case POWER_SUPPLY_PROP_CURRENT_NOW:
465
		ret = bq27x00_battery_current(di, val);
466 467
		break;
	case POWER_SUPPLY_PROP_CAPACITY:
468
		ret = bq27x00_simple_value(di->cache.capacity, val);
469 470
		break;
	case POWER_SUPPLY_PROP_TEMP:
471
		ret = bq27x00_battery_temperature(di, val);
472
		break;
473
	case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW:
474
		ret = bq27x00_simple_value(di->cache.time_to_empty, val);
475 476
		break;
	case POWER_SUPPLY_PROP_TIME_TO_EMPTY_AVG:
477
		ret = bq27x00_simple_value(di->cache.time_to_empty_avg, val);
478 479
		break;
	case POWER_SUPPLY_PROP_TIME_TO_FULL_NOW:
480
		ret = bq27x00_simple_value(di->cache.time_to_full, val);
481
		break;
L
Lars-Peter Clausen 已提交
482 483 484
	case POWER_SUPPLY_PROP_TECHNOLOGY:
		val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
		break;
P
Pali Rohár 已提交
485 486 487 488 489 490 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;
	case POWER_SUPPLY_PROP_CHARGE_COUNTER:
		ret = bq27x00_simple_value(di->cache.charge_counter, val);
		break;
	case POWER_SUPPLY_PROP_ENERGY_NOW:
		ret = bq27x00_battery_energy(di, val);
		break;
500 501 502 503
	default:
		return -EINVAL;
	}

504
	return ret;
505 506
}

L
Lars-Peter Clausen 已提交
507 508 509 510 511 512 513 514
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);
}

515
static int bq27x00_powersupply_init(struct bq27x00_device_info *di)
516
{
517 518
	int ret;

519 520 521 522
	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 已提交
523 524 525 526
	di->bat.external_power_changed = bq27x00_external_power_changed;

	INIT_DELAYED_WORK(&di->work, bq27x00_battery_poll);
	mutex_init(&di->lock);
527 528 529 530 531 532 533 534 535

	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);

536 537
	bq27x00_update(di);

538
	return 0;
539 540
}

L
Lars-Peter Clausen 已提交
541 542 543 544 545 546 547 548 549
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);
}

550 551 552 553 554 555

/* i2c specific code */
#ifdef CONFIG_BATTERY_BQ27X00_I2C

/* If the system has several batteries we need a different name for each
 * of them...
556
 */
557 558
static DEFINE_IDR(battery_id);
static DEFINE_MUTEX(battery_mutex);
559

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

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

	msg->addr = client->addr;
	msg->flags = 0;
	msg->len = 1;
	msg->buf = data;

	data[0] = reg;
576
	ret = i2c_transfer(client->adapter, msg, 1);
577

578
	if (ret >= 0) {
579
		if (!single)
580 581 582 583 584
			msg->len = 2;
		else
			msg->len = 1;

		msg->flags = I2C_M_RD;
585 586
		ret = i2c_transfer(client->adapter, msg, 1);
		if (ret >= 0) {
587
			if (!single)
588
				ret = get_unaligned_le16(data);
589
			else
590
				ret = data[0];
591 592
		}
	}
593
	return ret;
594 595
}

596
static int bq27x00_battery_probe(struct i2c_client *client,
597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613
				 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;

614
	name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
615 616 617 618 619 620 621 622 623 624 625 626
	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;
	}
627

628
	di->id = num;
629
	di->dev = &client->dev;
630
	di->chip = id->driver_data;
631 632
	di->bat.name = name;
	di->bus.read = &bq27x00_read_i2c;
633

634
	if (bq27x00_powersupply_init(di))
635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652
		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;
}

653
static int bq27x00_battery_remove(struct i2c_client *client)
654 655 656
{
	struct bq27x00_device_info *di = i2c_get_clientdata(client);

L
Lars-Peter Clausen 已提交
657
	bq27x00_powersupply_unregister(di);
658 659 660 661 662 663 664 665 666 667 668 669

	kfree(di->bat.name);

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

	kfree(di);

	return 0;
}

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

677
static struct i2c_driver bq27x00_battery_driver = {
678
	.driver = {
679
		.name = "bq27x00-battery",
680
	},
681 682 683
	.probe = bq27x00_battery_probe,
	.remove = bq27x00_battery_remove,
	.id_table = bq27x00_id,
684 685
};

686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710
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,
711
			bool single)
712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737
{
	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;

738
		return (upper << 8) | lower;
739
	}
740 741

	return pdata->read(dev, reg);
742 743 744 745 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
}

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 已提交
791 792
	bq27x00_powersupply_unregister(di);

793 794 795 796 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
	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
 */

833 834 835 836
static int __init bq27x00_battery_init(void)
{
	int ret;

837 838 839 840 841
	ret = bq27x00_battery_i2c_init();
	if (ret)
		return ret;

	ret = bq27x00_battery_platform_init();
842
	if (ret)
843
		bq27x00_battery_i2c_exit();
844 845 846 847 848 849 850

	return ret;
}
module_init(bq27x00_battery_init);

static void __exit bq27x00_battery_exit(void)
{
851 852
	bq27x00_battery_platform_exit();
	bq27x00_battery_i2c_exit();
853 854 855 856 857 858
}
module_exit(bq27x00_battery_exit);

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