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
 * 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
	int capacity;
	int flags;
};

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
	POWER_SUPPLY_PROP_CHARGE_FULL,
	POWER_SUPPLY_PROP_CHARGE_NOW,
	POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
117
	POWER_SUPPLY_PROP_CYCLE_COUNT,
P
Pali Rohár 已提交
118
	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
		cache.charge_full = bq27x00_battery_read_lmd(di);
269
		cache.cycle_count = bq27x00_battery_read_cyct(di);
270

P
Pali Rohár 已提交
271 272 273
		/* We only have to read charge design full once */
		if (di->charge_design_full <= 0)
			di->charge_design_full = bq27x00_battery_read_ilmd(di);
274 275
	}

276
	if (memcmp(&di->cache, &cache, sizeof(cache)) != 0) {
277 278 279 280 281 282 283
		di->cache = cache;
		power_supply_changed(&di->bat);
	}

	di->last_update = jiffies;
}

L
Lars-Peter Clausen 已提交
284 285 286 287 288 289 290 291 292 293 294 295 296 297 298
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);
	}
}


299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314
/*
 * 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;
315 316 317
}

/*
P
Pali Rohár 已提交
318
 * Return the battery average current in µA
319 320 321
 * Note that current can be negative signed as well
 * Or 0 if something fails.
 */
322 323
static int bq27x00_battery_current(struct bq27x00_device_info *di,
	union power_supply_propval *val)
324
{
325
	int curr;
326
	int flags;
327

328
	curr = bq27x00_read(di, BQ27x00_REG_AI, false);
329 330
	if (curr < 0)
		return curr;
331 332 333

	if (di->chip == BQ27500) {
		/* bq27500 returns signed value */
334
		val->intval = (int)((s16)curr) * 1000;
335
	} else {
336 337
		flags = bq27x00_read(di, BQ27x00_REG_FLAGS, false);
		if (flags & BQ27000_FLAG_CHGS) {
338
			dev_dbg(di->dev, "negative current!\n");
339
			curr = -curr;
340
		}
341

342
		val->intval = curr * 3570 / BQ27000_RS;
343 344
	}

345
	return 0;
346 347
}

348
static int bq27x00_battery_status(struct bq27x00_device_info *di,
349
	union power_supply_propval *val)
350 351 352 353
{
	int status;

	if (di->chip == BQ27500) {
354
		if (di->cache.flags & BQ27500_FLAG_FC)
355
			status = POWER_SUPPLY_STATUS_FULL;
356
		else if (di->cache.flags & BQ27500_FLAG_DSC)
357 358 359 360
			status = POWER_SUPPLY_STATUS_DISCHARGING;
		else
			status = POWER_SUPPLY_STATUS_CHARGING;
	} else {
361 362 363
		if (di->cache.flags & BQ27000_FLAG_FC)
			status = POWER_SUPPLY_STATUS_FULL;
		else if (di->cache.flags & BQ27000_FLAG_CHGS)
364
			status = POWER_SUPPLY_STATUS_CHARGING;
365 366
		else if (power_supply_am_i_supplied(&di->bat))
			status = POWER_SUPPLY_STATUS_NOT_CHARGING;
367 368 369 370 371
		else
			status = POWER_SUPPLY_STATUS_DISCHARGING;
	}

	val->intval = status;
372

373 374 375 376
	return 0;
}

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

385 386 387
	volt = bq27x00_read(di, BQ27x00_REG_VOLT, false);
	if (volt < 0)
		return volt;
388

389 390 391 392 393
	val->intval = volt * 1000;

	return 0;
}

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


420 421 422 423 424 425 426
static int bq27x00_simple_value(int value,
	union power_supply_propval *val)
{
	if (value < 0)
		return value;

	val->intval = value;
427 428 429 430

	return 0;
}

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

L
Lars-Peter Clausen 已提交
441 442 443 444 445 446
	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);
447 448

	if (psp != POWER_SUPPLY_PROP_PRESENT && di->cache.flags < 0)
449
		return -ENODEV;
450 451

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

501
	return ret;
502 503
}

L
Lars-Peter Clausen 已提交
504 505 506 507 508 509 510 511
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);
}

512
static int bq27x00_powersupply_init(struct bq27x00_device_info *di)
513
{
514 515
	int ret;

516 517 518 519
	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 已提交
520 521 522 523
	di->bat.external_power_changed = bq27x00_external_power_changed;

	INIT_DELAYED_WORK(&di->work, bq27x00_battery_poll);
	mutex_init(&di->lock);
524 525 526 527 528 529 530 531 532

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

533 534
	bq27x00_update(di);

535
	return 0;
536 537
}

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

547 548 549 550 551 552

/* i2c specific code */
#ifdef CONFIG_BATTERY_BQ27X00_I2C

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

557
static int bq27x00_read_i2c(struct bq27x00_device_info *di, u8 reg, bool single)
558
{
559
	struct i2c_client *client = to_i2c_client(di->dev);
560
	struct i2c_msg msg[2];
561
	unsigned char data[2];
562
	int ret;
563 564 565 566

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

567 568 569 570 571 572 573
	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;
574
	if (single)
575
		msg[1].len = 1;
576
	else
577
		msg[1].len = 2;
578

579
	ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
580 581 582 583 584 585 586
	if (ret < 0)
		return ret;

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

588
	return ret;
589 590
}

591
static int bq27x00_battery_probe(struct i2c_client *client,
592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608
				 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;

609
	name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
610 611 612 613 614 615 616 617 618 619 620 621
	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;
	}
622

623
	di->id = num;
624
	di->dev = &client->dev;
625
	di->chip = id->driver_data;
626 627
	di->bat.name = name;
	di->bus.read = &bq27x00_read_i2c;
628

629
	if (bq27x00_powersupply_init(di))
630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647
		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;
}

648
static int bq27x00_battery_remove(struct i2c_client *client)
649 650 651
{
	struct bq27x00_device_info *di = i2c_get_clientdata(client);

L
Lars-Peter Clausen 已提交
652
	bq27x00_powersupply_unregister(di);
653 654 655 656 657 658 659 660 661 662 663 664

	kfree(di->bat.name);

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

	kfree(di);

	return 0;
}

665 666 667
static const struct i2c_device_id bq27x00_id[] = {
	{ "bq27200", BQ27000 },	/* bq27200 is same as bq27000, but with i2c */
	{ "bq27500", BQ27500 },
668 669
	{},
};
P
Pali Rohár 已提交
670
MODULE_DEVICE_TABLE(i2c, bq27x00_id);
671

672
static struct i2c_driver bq27x00_battery_driver = {
673
	.driver = {
674
		.name = "bq27x00-battery",
675
	},
676 677 678
	.probe = bq27x00_battery_probe,
	.remove = bq27x00_battery_remove,
	.id_table = bq27x00_id,
679 680
};

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

733
		return (upper << 8) | lower;
734
	}
735 736

	return pdata->read(dev, reg);
737 738 739 740 741 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
}

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

788 789 790 791 792 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
	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
 */

828 829 830 831
static int __init bq27x00_battery_init(void)
{
	int ret;

832 833 834 835 836
	ret = bq27x00_battery_i2c_init();
	if (ret)
		return ret;

	ret = bq27x00_battery_platform_init();
837
	if (ret)
838
		bq27x00_battery_i2c_exit();
839 840 841 842 843 844 845

	return ret;
}
module_init(bq27x00_battery_init);

static void __exit bq27x00_battery_exit(void)
{
846 847
	bq27x00_battery_platform_exit();
	bq27x00_battery_i2c_exit();
848 849 850 851 852 853
}
module_exit(bq27x00_battery_exit);

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