sbs.c 19.2 KB
Newer Older
1
/*
2
 *  sbs.c - ACPI Smart Battery System Driver ($Revision: 2.0 $)
3
 *
4 5
 *  Copyright (c) 2007 Alexey Starikovskiy <astarikovskiy@suse.de>
 *  Copyright (c) 2005-2007 Vladimir Lebedev <vladimir.p.lebedev@intel.com>
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27
 *  Copyright (c) 2005 Rich Townsend <rhdt@bartol.udel.edu>
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or (at
 *  your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful, but
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 */

#include <linux/init.h>
28
#include <linux/slab.h>
29 30 31
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/kernel.h>
32

33
#include <linux/acpi.h>
34
#include <linux/timer.h>
35
#include <linux/jiffies.h>
36
#include <linux/delay.h>
37 38
#include <linux/power_supply.h>

39 40
#include "sbshc.h"

41 42
#define PREFIX "ACPI: "

43 44 45 46 47 48 49 50 51 52
#define ACPI_SBS_CLASS			"sbs"
#define ACPI_AC_CLASS			"ac_adapter"
#define ACPI_BATTERY_CLASS		"battery"
#define ACPI_SBS_DEVICE_NAME		"Smart Battery System"
#define ACPI_SBS_FILE_INFO		"info"
#define ACPI_SBS_FILE_STATE		"state"
#define ACPI_SBS_FILE_ALARM		"alarm"
#define ACPI_BATTERY_DIR_NAME		"BAT%i"
#define ACPI_AC_DIR_NAME		"AC0"

53 54
#define ACPI_SBS_NOTIFY_STATUS		0x80
#define ACPI_SBS_NOTIFY_INFO		0x81
55

56
MODULE_AUTHOR("Alexey Starikovskiy <astarikovskiy@suse.de>");
57 58 59
MODULE_DESCRIPTION("Smart Battery System ACPI interface driver");
MODULE_LICENSE("GPL");

60 61 62
static unsigned int cache_time = 1000;
module_param(cache_time, uint, 0644);
MODULE_PARM_DESC(cache_time, "cache time in milliseconds");
63

64
#define MAX_SBS_BAT			4
65 66
#define ACPI_SBS_BLOCK_MAX		32

67
static const struct acpi_device_id sbs_device_ids[] = {
68
	{"ACPI0002", 0},
69 70 71 72
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, sbs_device_ids);

73
struct acpi_battery {
74
	struct power_supply bat;
75
	struct acpi_sbs *sbs;
76 77
	unsigned long update_time;
	char name[8];
78 79 80
	char manufacturer_name[ACPI_SBS_BLOCK_MAX];
	char device_name[ACPI_SBS_BLOCK_MAX];
	char device_chemistry[ACPI_SBS_BLOCK_MAX];
81
	u16 alarm_capacity;
82 83 84 85
	u16 full_charge_capacity;
	u16 design_capacity;
	u16 design_voltage;
	u16 serial_number;
86 87
	u16 cycle_count;
	u16 temp_now;
88
	u16 voltage_now;
89 90
	s16 rate_now;
	s16 rate_avg;
91
	u16 capacity_now;
92
	u16 state_of_charge;
93 94
	u16 state;
	u16 mode;
95
	u16 spec;
96 97
	u8 id;
	u8 present:1;
J
Jeff Garzik 已提交
98
	u8 have_sysfs_alarm:1;
99 100
};

101
#define to_acpi_battery(x) container_of(x, struct acpi_battery, bat)
102

103
struct acpi_sbs {
104
	struct power_supply charger;
105
	struct acpi_device *device;
106
	struct acpi_smb_hc *hc;
107
	struct mutex lock;
108
	struct acpi_battery battery[MAX_SBS_BAT];
109
	u8 batteries_supported:4;
110 111
	u8 manager_present:1;
	u8 charger_present:1;
112 113
};

114 115
#define to_acpi_sbs(x) container_of(x, struct acpi_sbs, charger)

116
static int acpi_sbs_remove(struct acpi_device *device);
117 118
static int acpi_battery_get_state(struct acpi_battery *battery);

119
static inline int battery_scale(int log)
120
{
121 122 123 124
	int scale = 1;
	while (log--)
		scale *= 10;
	return scale;
125 126
}

127
static inline int acpi_battery_vscale(struct acpi_battery *battery)
128
{
129
	return battery_scale((battery->spec & 0x0f00) >> 8);
130 131
}

132
static inline int acpi_battery_ipscale(struct acpi_battery *battery)
133
{
134
	return battery_scale((battery->spec & 0xf000) >> 12);
135 136
}

137
static inline int acpi_battery_mode(struct acpi_battery *battery)
138
{
139
	return (battery->mode & 0x8000);
140
}
141

142
static inline int acpi_battery_scale(struct acpi_battery *battery)
143
{
144 145
	return (acpi_battery_mode(battery) ? 10 : 1) *
	    acpi_battery_ipscale(battery);
146 147
}

148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183
static int sbs_get_ac_property(struct power_supply *psy,
			       enum power_supply_property psp,
			       union power_supply_propval *val)
{
	struct acpi_sbs *sbs = to_acpi_sbs(psy);
	switch (psp) {
	case POWER_SUPPLY_PROP_ONLINE:
		val->intval = sbs->charger_present;
		break;
	default:
		return -EINVAL;
	}
	return 0;
}

static int acpi_battery_technology(struct acpi_battery *battery)
{
	if (!strcasecmp("NiCd", battery->device_chemistry))
		return POWER_SUPPLY_TECHNOLOGY_NiCd;
	if (!strcasecmp("NiMH", battery->device_chemistry))
		return POWER_SUPPLY_TECHNOLOGY_NiMH;
	if (!strcasecmp("LION", battery->device_chemistry))
		return POWER_SUPPLY_TECHNOLOGY_LION;
	if (!strcasecmp("LiP", battery->device_chemistry))
		return POWER_SUPPLY_TECHNOLOGY_LIPO;
	return POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
}

static int acpi_sbs_battery_get_property(struct power_supply *psy,
					 enum power_supply_property psp,
					 union power_supply_propval *val)
{
	struct acpi_battery *battery = to_acpi_battery(psy);

	if ((!battery->present) && psp != POWER_SUPPLY_PROP_PRESENT)
		return -ENODEV;
184 185

	acpi_battery_get_state(battery);
186 187
	switch (psp) {
	case POWER_SUPPLY_PROP_STATUS:
188
		if (battery->rate_now < 0)
189
			val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
190
		else if (battery->rate_now > 0)
191 192 193 194 195 196 197 198 199 200
			val->intval = POWER_SUPPLY_STATUS_CHARGING;
		else
			val->intval = POWER_SUPPLY_STATUS_FULL;
		break;
	case POWER_SUPPLY_PROP_PRESENT:
		val->intval = battery->present;
		break;
	case POWER_SUPPLY_PROP_TECHNOLOGY:
		val->intval = acpi_battery_technology(battery);
		break;
201 202 203
	case POWER_SUPPLY_PROP_CYCLE_COUNT:
		val->intval = battery->cycle_count;
		break;
204 205 206 207 208 209 210 211 212
	case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
		val->intval = battery->design_voltage *
			acpi_battery_vscale(battery) * 1000;
		break;
	case POWER_SUPPLY_PROP_VOLTAGE_NOW:
		val->intval = battery->voltage_now *
				acpi_battery_vscale(battery) * 1000;
		break;
	case POWER_SUPPLY_PROP_CURRENT_NOW:
213 214
	case POWER_SUPPLY_PROP_POWER_NOW:
		val->intval = abs(battery->rate_now) *
215
				acpi_battery_ipscale(battery) * 1000;
216 217 218
		val->intval *= (acpi_battery_mode(battery)) ?
				(battery->voltage_now *
				acpi_battery_vscale(battery) / 1000) : 1;
219 220
		break;
	case POWER_SUPPLY_PROP_CURRENT_AVG:
221 222
	case POWER_SUPPLY_PROP_POWER_AVG:
		val->intval = abs(battery->rate_avg) *
223
				acpi_battery_ipscale(battery) * 1000;
224 225 226
		val->intval *= (acpi_battery_mode(battery)) ?
				(battery->voltage_now *
				acpi_battery_vscale(battery) / 1000) : 1;
227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268
		break;
	case POWER_SUPPLY_PROP_CAPACITY:
		val->intval = battery->state_of_charge;
		break;
	case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
	case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
		val->intval = battery->design_capacity *
			acpi_battery_scale(battery) * 1000;
		break;
	case POWER_SUPPLY_PROP_CHARGE_FULL:
	case POWER_SUPPLY_PROP_ENERGY_FULL:
		val->intval = battery->full_charge_capacity *
			acpi_battery_scale(battery) * 1000;
		break;
	case POWER_SUPPLY_PROP_CHARGE_NOW:
	case POWER_SUPPLY_PROP_ENERGY_NOW:
		val->intval = battery->capacity_now *
				acpi_battery_scale(battery) * 1000;
		break;
	case POWER_SUPPLY_PROP_TEMP:
		val->intval = battery->temp_now - 2730;	// dK -> dC
		break;
	case POWER_SUPPLY_PROP_MODEL_NAME:
		val->strval = battery->device_name;
		break;
	case POWER_SUPPLY_PROP_MANUFACTURER:
		val->strval = battery->manufacturer_name;
		break;
	default:
		return -EINVAL;
	}
	return 0;
}

static enum power_supply_property sbs_ac_props[] = {
	POWER_SUPPLY_PROP_ONLINE,
};

static enum power_supply_property sbs_charge_battery_props[] = {
	POWER_SUPPLY_PROP_STATUS,
	POWER_SUPPLY_PROP_PRESENT,
	POWER_SUPPLY_PROP_TECHNOLOGY,
269
	POWER_SUPPLY_PROP_CYCLE_COUNT,
270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290
	POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
	POWER_SUPPLY_PROP_VOLTAGE_NOW,
	POWER_SUPPLY_PROP_CURRENT_NOW,
	POWER_SUPPLY_PROP_CURRENT_AVG,
	POWER_SUPPLY_PROP_CAPACITY,
	POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
	POWER_SUPPLY_PROP_CHARGE_FULL,
	POWER_SUPPLY_PROP_CHARGE_NOW,
	POWER_SUPPLY_PROP_TEMP,
	POWER_SUPPLY_PROP_MODEL_NAME,
	POWER_SUPPLY_PROP_MANUFACTURER,
};

static enum power_supply_property sbs_energy_battery_props[] = {
	POWER_SUPPLY_PROP_STATUS,
	POWER_SUPPLY_PROP_PRESENT,
	POWER_SUPPLY_PROP_TECHNOLOGY,
	POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
	POWER_SUPPLY_PROP_VOLTAGE_NOW,
	POWER_SUPPLY_PROP_CURRENT_NOW,
	POWER_SUPPLY_PROP_CURRENT_AVG,
291 292
	POWER_SUPPLY_PROP_POWER_NOW,
	POWER_SUPPLY_PROP_POWER_AVG,
293 294 295 296 297 298 299 300
	POWER_SUPPLY_PROP_CAPACITY,
	POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,
	POWER_SUPPLY_PROP_ENERGY_FULL,
	POWER_SUPPLY_PROP_ENERGY_NOW,
	POWER_SUPPLY_PROP_TEMP,
	POWER_SUPPLY_PROP_MODEL_NAME,
	POWER_SUPPLY_PROP_MANUFACTURER,
};
301

302

303 304 305
/* --------------------------------------------------------------------------
                            Smart Battery System Management
   -------------------------------------------------------------------------- */
306

307 308 309 310 311
struct acpi_battery_reader {
	u8 command;		/* command for battery */
	u8 mode;		/* word or block? */
	size_t offset;		/* offset inside struct acpi_sbs_battery */
};
312

313 314 315 316 317 318 319 320 321 322 323 324 325
static struct acpi_battery_reader info_readers[] = {
	{0x01, SMBUS_READ_WORD, offsetof(struct acpi_battery, alarm_capacity)},
	{0x03, SMBUS_READ_WORD, offsetof(struct acpi_battery, mode)},
	{0x10, SMBUS_READ_WORD, offsetof(struct acpi_battery, full_charge_capacity)},
	{0x17, SMBUS_READ_WORD, offsetof(struct acpi_battery, cycle_count)},
	{0x18, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_capacity)},
	{0x19, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_voltage)},
	{0x1a, SMBUS_READ_WORD, offsetof(struct acpi_battery, spec)},
	{0x1c, SMBUS_READ_WORD, offsetof(struct acpi_battery, serial_number)},
	{0x20, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, manufacturer_name)},
	{0x21, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_name)},
	{0x22, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_chemistry)},
};
326

327 328 329
static struct acpi_battery_reader state_readers[] = {
	{0x08, SMBUS_READ_WORD, offsetof(struct acpi_battery, temp_now)},
	{0x09, SMBUS_READ_WORD, offsetof(struct acpi_battery, voltage_now)},
330 331
	{0x0a, SMBUS_READ_WORD, offsetof(struct acpi_battery, rate_now)},
	{0x0b, SMBUS_READ_WORD, offsetof(struct acpi_battery, rate_avg)},
332 333 334 335
	{0x0f, SMBUS_READ_WORD, offsetof(struct acpi_battery, capacity_now)},
	{0x0e, SMBUS_READ_WORD, offsetof(struct acpi_battery, state_of_charge)},
	{0x16, SMBUS_READ_WORD, offsetof(struct acpi_battery, state)},
};
336

337
static int acpi_manager_get_info(struct acpi_sbs *sbs)
338 339
{
	int result = 0;
340
	u16 battery_system_info;
341

342
	result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER,
343
				 0x04, (u8 *)&battery_system_info);
344 345
	if (!result)
		sbs->batteries_supported = battery_system_info & 0x000f;
346
	return result;
347 348 349 350
}

static int acpi_battery_get_info(struct acpi_battery *battery)
{
351
	int i, result = 0;
352

353
	for (i = 0; i < ARRAY_SIZE(info_readers); ++i) {
354 355 356 357 358 359
		result = acpi_smbus_read(battery->sbs->hc,
					 info_readers[i].mode,
					 ACPI_SBS_BATTERY,
					 info_readers[i].command,
					 (u8 *) battery +
						info_readers[i].offset);
360 361
		if (result)
			break;
362
	}
363
	return result;
364 365 366 367
}

static int acpi_battery_get_state(struct acpi_battery *battery)
{
368
	int i, result = 0;
369

370 371
	if (battery->update_time &&
	    time_before(jiffies, battery->update_time +
372 373 374 375 376 377 378 379 380 381
				msecs_to_jiffies(cache_time)))
		return 0;
	for (i = 0; i < ARRAY_SIZE(state_readers); ++i) {
		result = acpi_smbus_read(battery->sbs->hc,
					 state_readers[i].mode,
					 ACPI_SBS_BATTERY,
					 state_readers[i].command,
				         (u8 *)battery +
						state_readers[i].offset);
		if (result)
382 383 384
			goto end;
	}
      end:
385
	battery->update_time = jiffies;
386
	return result;
387 388
}

389
static int acpi_battery_get_alarm(struct acpi_battery *battery)
390
{
391 392
	return acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD,
				 ACPI_SBS_BATTERY, 0x01,
393
				 (u8 *)&battery->alarm_capacity);
394 395
}

396
static int acpi_battery_set_alarm(struct acpi_battery *battery)
397
{
398
	struct acpi_sbs *sbs = battery->sbs;
399 400 401 402
	u16 value, sel = 1 << (battery->id + 12);

	int ret;

403

404
	if (sbs->manager_present) {
405
		ret = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER,
406
				0x01, (u8 *)&value);
407 408 409 410 411 412 413 414 415 416 417
		if (ret)
			goto end;
		if ((value & 0xf000) != sel) {
			value &= 0x0fff;
			value |= sel;
		ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD,
					 ACPI_SBS_MANAGER,
					 0x01, (u8 *)&value, 2);
		if (ret)
			goto end;
		}
418
	}
419 420 421 422
	ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD, ACPI_SBS_BATTERY,
				0x01, (u8 *)&battery->alarm_capacity, 2);
      end:
	return ret;
423 424 425 426
}

static int acpi_ac_get_present(struct acpi_sbs *sbs)
{
427 428
	int result;
	u16 status;
429

430 431 432 433
	result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_CHARGER,
				 0x13, (u8 *) & status);
	if (!result)
		sbs->charger_present = (status >> 15) & 0x1;
434
	return result;
435 436
}

A
Alexey Starikovskiy 已提交
437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461
static ssize_t acpi_battery_alarm_show(struct device *dev,
					struct device_attribute *attr,
					char *buf)
{
	struct acpi_battery *battery = to_acpi_battery(dev_get_drvdata(dev));
	acpi_battery_get_alarm(battery);
	return sprintf(buf, "%d\n", battery->alarm_capacity *
				acpi_battery_scale(battery) * 1000);
}

static ssize_t acpi_battery_alarm_store(struct device *dev,
					struct device_attribute *attr,
					const char *buf, size_t count)
{
	unsigned long x;
	struct acpi_battery *battery = to_acpi_battery(dev_get_drvdata(dev));
	if (sscanf(buf, "%ld\n", &x) == 1)
		battery->alarm_capacity = x /
			(1000 * acpi_battery_scale(battery));
	if (battery->present)
		acpi_battery_set_alarm(battery);
	return count;
}

static struct device_attribute alarm_attr = {
462
	.attr = {.name = "alarm", .mode = 0644},
A
Alexey Starikovskiy 已提交
463 464 465 466
	.show = acpi_battery_alarm_show,
	.store = acpi_battery_alarm_store,
};

467 468 469
/* --------------------------------------------------------------------------
                                 Driver Interface
   -------------------------------------------------------------------------- */
470
static int acpi_battery_read(struct acpi_battery *battery)
471
{
472 473
	int result = 0, saved_present = battery->present;
	u16 state;
474

475 476 477 478 479 480 481 482 483 484 485 486 487
	if (battery->sbs->manager_present) {
		result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD,
				ACPI_SBS_MANAGER, 0x01, (u8 *)&state);
		if (!result)
			battery->present = state & (1 << battery->id);
		state &= 0x0fff;
		state |= 1 << (battery->id + 12);
		acpi_smbus_write(battery->sbs->hc, SMBUS_WRITE_WORD,
				  ACPI_SBS_MANAGER, 0x01, (u8 *)&state, 2);
	} else if (battery->id == 0)
		battery->present = 1;
	if (result || !battery->present)
		return result;
488

489 490 491 492 493 494 495 496 497
	if (saved_present != battery->present) {
		battery->update_time = 0;
		result = acpi_battery_get_info(battery);
		if (result)
			return result;
	}
	result = acpi_battery_get_state(battery);
	return result;
}
498

499
/* Smart Battery */
500 501 502
static int acpi_battery_add(struct acpi_sbs *sbs, int id)
{
	struct acpi_battery *battery = &sbs->battery[id];
503 504
	int result;

505 506
	battery->id = id;
	battery->sbs = sbs;
507 508 509
	result = acpi_battery_read(battery);
	if (result)
		return result;
510

511
	sprintf(battery->name, ACPI_BATTERY_DIR_NAME, id);
512 513 514 515 516 517 518 519 520 521 522 523 524
	battery->bat.name = battery->name;
	battery->bat.type = POWER_SUPPLY_TYPE_BATTERY;
	if (!acpi_battery_mode(battery)) {
		battery->bat.properties = sbs_charge_battery_props;
		battery->bat.num_properties =
		    ARRAY_SIZE(sbs_charge_battery_props);
	} else {
		battery->bat.properties = sbs_energy_battery_props;
		battery->bat.num_properties =
		    ARRAY_SIZE(sbs_energy_battery_props);
	}
	battery->bat.get_property = acpi_sbs_battery_get_property;
	result = power_supply_register(&sbs->device->dev, &battery->bat);
J
Jeff Garzik 已提交
525 526 527 528 529 530 531
	if (result)
		goto end;
	result = device_create_file(battery->bat.dev, &alarm_attr);
	if (result)
		goto end;
	battery->have_sysfs_alarm = 1;
      end:
532
	printk(KERN_INFO PREFIX "%s [%s]: Battery Slot [%s] (battery %s)\n",
533
	       ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device),
534
	       battery->name, battery->present ? "present" : "absent");
535
	return result;
536 537 538 539
}

static void acpi_battery_remove(struct acpi_sbs *sbs, int id)
{
J
Jeff Garzik 已提交
540
	struct acpi_battery *battery = &sbs->battery[id];
541

J
Jeff Garzik 已提交
542 543 544 545
	if (battery->bat.dev) {
		if (battery->have_sysfs_alarm)
			device_remove_file(battery->bat.dev, &alarm_attr);
		power_supply_unregister(&battery->bat);
546 547 548
	}
}

549
static int acpi_charger_add(struct acpi_sbs *sbs)
550 551 552 553
{
	int result;

	result = acpi_ac_get_present(sbs);
554
	if (result)
555
		goto end;
556

557 558 559 560 561 562
	sbs->charger.name = "sbs-charger";
	sbs->charger.type = POWER_SUPPLY_TYPE_MAINS;
	sbs->charger.properties = sbs_ac_props;
	sbs->charger.num_properties = ARRAY_SIZE(sbs_ac_props);
	sbs->charger.get_property = sbs_get_ac_property;
	power_supply_register(&sbs->device->dev, &sbs->charger);
563 564
	printk(KERN_INFO PREFIX "%s [%s]: AC Adapter [%s] (%s)\n",
	       ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device),
565
	       ACPI_AC_DIR_NAME, sbs->charger_present ? "on-line" : "off-line");
566
      end:
567
	return result;
568 569
}

570
static void acpi_charger_remove(struct acpi_sbs *sbs)
571
{
572 573
	if (sbs->charger.dev)
		power_supply_unregister(&sbs->charger);
574 575
}

A
Adrian Bunk 已提交
576
static void acpi_sbs_callback(void *context)
577
{
578 579 580 581 582 583
	int id;
	struct acpi_sbs *sbs = context;
	struct acpi_battery *bat;
	u8 saved_charger_state = sbs->charger_present;
	u8 saved_battery_state;
	acpi_ac_get_present(sbs);
584
	if (sbs->charger_present != saved_charger_state)
585
		kobject_uevent(&sbs->charger.dev->kobj, KOBJ_CHANGE);
586

587 588 589 590 591 592 593 594 595
	if (sbs->manager_present) {
		for (id = 0; id < MAX_SBS_BAT; ++id) {
			if (!(sbs->batteries_supported & (1 << id)))
				continue;
			bat = &sbs->battery[id];
			saved_battery_state = bat->present;
			acpi_battery_read(bat);
			if (saved_battery_state == bat->present)
				continue;
596
			kobject_uevent(&bat->bat.dev->kobj, KOBJ_CHANGE);
597 598 599 600 601 602
		}
	}
}

static int acpi_sbs_add(struct acpi_device *device)
{
603 604
	struct acpi_sbs *sbs;
	int result = 0;
605
	int id;
606

607
	sbs = kzalloc(sizeof(struct acpi_sbs), GFP_KERNEL);
608
	if (!sbs) {
609 610
		result = -ENOMEM;
		goto end;
611 612
	}

613
	mutex_init(&sbs->lock);
614

615
	sbs->hc = acpi_driver_data(device->parent);
616
	sbs->device = device;
617 618
	strcpy(acpi_device_name(device), ACPI_SBS_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_SBS_CLASS);
619
	device->driver_data = sbs;
620

621
	result = acpi_charger_add(sbs);
622 623
	if (result)
		goto end;
624

625 626 627 628 629 630 631 632 633
	result = acpi_manager_get_info(sbs);
	if (!result) {
		sbs->manager_present = 1;
		for (id = 0; id < MAX_SBS_BAT; ++id)
			if ((sbs->batteries_supported & (1 << id)))
				acpi_battery_add(sbs, id);
	} else
		acpi_battery_add(sbs, 0);
	acpi_smbus_register_callback(sbs->hc, acpi_sbs_callback, sbs);
634
      end:
635
	if (result)
636
		acpi_sbs_remove(device);
637
	return result;
638 639
}

640
static int acpi_sbs_remove(struct acpi_device *device)
641
{
L
Len Brown 已提交
642
	struct acpi_sbs *sbs;
643 644
	int id;

645
	if (!device)
646
		return -EINVAL;
647
	sbs = acpi_driver_data(device);
648
	if (!sbs)
649
		return -EINVAL;
650 651 652
	mutex_lock(&sbs->lock);
	acpi_smbus_unregister_callback(sbs->hc);
	for (id = 0; id < MAX_SBS_BAT; ++id)
653
		acpi_battery_remove(sbs, id);
654 655 656
	acpi_charger_remove(sbs);
	mutex_unlock(&sbs->lock);
	mutex_destroy(&sbs->lock);
657
	kfree(sbs);
658
	return 0;
659 660
}

661
#ifdef CONFIG_PM_SLEEP
662
static int acpi_sbs_resume(struct device *dev)
663 664
{
	struct acpi_sbs *sbs;
665
	if (!dev)
666
		return -EINVAL;
667
	sbs = to_acpi_device(dev)->driver_data;
668
	acpi_sbs_callback(sbs);
669 670
	return 0;
}
671
#endif
672

673 674
static SIMPLE_DEV_PM_OPS(acpi_sbs_pm, NULL, acpi_sbs_resume);

675 676 677 678 679 680 681 682
static struct acpi_driver acpi_sbs_driver = {
	.name = "sbs",
	.class = ACPI_SBS_CLASS,
	.ids = sbs_device_ids,
	.ops = {
		.add = acpi_sbs_add,
		.remove = acpi_sbs_remove,
		},
683
	.drv.pm = &acpi_sbs_pm,
684 685
};

686 687 688 689
static int __init acpi_sbs_init(void)
{
	int result = 0;

690 691
	if (acpi_disabled)
		return -ENODEV;
692

693
	result = acpi_bus_register_driver(&acpi_sbs_driver);
694
	if (result < 0)
695
		return -ENODEV;
696

697
	return 0;
698 699 700 701 702
}

static void __exit acpi_sbs_exit(void)
{
	acpi_bus_unregister_driver(&acpi_sbs_driver);
703
	return;
704 705 706 707
}

module_init(acpi_sbs_init);
module_exit(acpi_sbs_exit);