sbs.c 40.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
/*
 *  acpi_sbs.c - ACPI Smart Battery System Driver ($Revision: 1.16 $)
 *
 *  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>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/kernel.h>
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
#include <asm/uaccess.h>
#include <linux/acpi.h>
33
#include <linux/timer.h>
34
#include <linux/jiffies.h>
35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55
#include <linux/delay.h>

#define ACPI_SBS_COMPONENT		0x00080000
#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"
#define ACPI_SBC_SMBUS_ADDR		0x9
#define ACPI_SBSM_SMBUS_ADDR		0xa
#define ACPI_SB_SMBUS_ADDR		0xb
#define ACPI_SBS_AC_NOTIFY_STATUS	0x80
#define ACPI_SBS_BATTERY_NOTIFY_STATUS	0x80
#define ACPI_SBS_BATTERY_NOTIFY_INFO	0x81

#define _COMPONENT			ACPI_SBS_COMPONENT

56
ACPI_MODULE_NAME("sbs");
57 58 59 60 61

MODULE_AUTHOR("Rich Townsend");
MODULE_DESCRIPTION("Smart Battery System ACPI interface driver");
MODULE_LICENSE("GPL");

62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111
#define	xmsleep(t)	msleep(t)

#define ACPI_EC_SMB_PRTCL	0x00	/* protocol, PEC */

#define ACPI_EC_SMB_STS		0x01	/* status */
#define ACPI_EC_SMB_ADDR	0x02	/* address */
#define ACPI_EC_SMB_CMD		0x03	/* command */
#define ACPI_EC_SMB_DATA	0x04	/* 32 data registers */
#define ACPI_EC_SMB_BCNT	0x24	/* number of data bytes */

#define ACPI_EC_SMB_STS_DONE	0x80
#define ACPI_EC_SMB_STS_STATUS	0x1f

#define ACPI_EC_SMB_PRTCL_WRITE		0x00
#define ACPI_EC_SMB_PRTCL_READ		0x01
#define ACPI_EC_SMB_PRTCL_WORD_DATA	0x08
#define ACPI_EC_SMB_PRTCL_BLOCK_DATA	0x0a

#define ACPI_EC_SMB_TRANSACTION_SLEEP	1
#define ACPI_EC_SMB_ACCESS_SLEEP1	1
#define ACPI_EC_SMB_ACCESS_SLEEP2	10

#define	DEF_CAPACITY_UNIT	3
#define	MAH_CAPACITY_UNIT	1
#define	MWH_CAPACITY_UNIT	2
#define	CAPACITY_UNIT		DEF_CAPACITY_UNIT

#define	REQUEST_UPDATE_MODE	1
#define	QUEUE_UPDATE_MODE	2

#define	DATA_TYPE_COMMON	0
#define	DATA_TYPE_INFO		1
#define	DATA_TYPE_STATE		2
#define	DATA_TYPE_ALARM		3
#define	DATA_TYPE_AC_STATE	4

extern struct proc_dir_entry *acpi_lock_ac_dir(void);
extern struct proc_dir_entry *acpi_lock_battery_dir(void);
extern void acpi_unlock_ac_dir(struct proc_dir_entry *acpi_ac_dir);
extern void acpi_unlock_battery_dir(struct proc_dir_entry *acpi_battery_dir);

#define	MAX_SBS_BAT			4
#define ACPI_SBS_BLOCK_MAX		32

#define ACPI_SBS_SMBUS_READ		1
#define ACPI_SBS_SMBUS_WRITE		2

#define ACPI_SBS_WORD_DATA		1
#define ACPI_SBS_BLOCK_DATA		2

112
#define	UPDATE_DELAY	10
113

114 115
/* 0 - every time, > 0 - by update_time */
static unsigned int update_time = 120;
116

117
static unsigned int capacity_mode = CAPACITY_UNIT;
118

119 120
module_param(update_time, uint, 0644);
module_param(capacity_mode, uint, 0444);
121 122 123

static int acpi_sbs_add(struct acpi_device *device);
static int acpi_sbs_remove(struct acpi_device *device, int type);
124
static int acpi_sbs_resume(struct acpi_device *device);
125

126 127 128 129 130 131 132
static const struct acpi_device_id sbs_device_ids[] = {
	{"ACPI0001", 0},
	{"ACPI0005", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, sbs_device_ids);

133
static struct acpi_driver acpi_sbs_driver = {
L
Len Brown 已提交
134
	.name = "sbs",
135
	.class = ACPI_SBS_CLASS,
136
	.ids = sbs_device_ids,
137 138 139
	.ops = {
		.add = acpi_sbs_add,
		.remove = acpi_sbs_remove,
140
		.resume = acpi_sbs_resume,
141 142 143
		},
};

144 145 146 147
struct acpi_ac {
	int ac_present;
};

148 149 150 151 152 153 154 155
struct acpi_battery_info {
	int capacity_mode;
	s16 full_charge_capacity;
	s16 design_capacity;
	s16 design_voltage;
	int vscale;
	int ipscale;
	s16 serial_number;
156 157 158
	char manufacturer_name[ACPI_SBS_BLOCK_MAX + 3];
	char device_name[ACPI_SBS_BLOCK_MAX + 3];
	char device_chemistry[ACPI_SBS_BLOCK_MAX + 3];
159 160 161 162 163 164
};

struct acpi_battery_state {
	s16 voltage;
	s16 amperage;
	s16 remaining_capacity;
165
	s16 battery_state;
166 167 168 169 170 171 172 173 174 175
};

struct acpi_battery_alarm {
	s16 remaining_capacity;
};

struct acpi_battery {
	int alive;
	int id;
	int init_state;
176
	int battery_present;
177 178 179 180 181 182 183 184
	struct acpi_sbs *sbs;
	struct acpi_battery_info info;
	struct acpi_battery_state state;
	struct acpi_battery_alarm alarm;
	struct proc_dir_entry *battery_entry;
};

struct acpi_sbs {
185
	int base;
186
	struct acpi_device *device;
187
	struct mutex mutex;
188 189 190
	int sbsm_present;
	int sbsm_batteries_supported;
	struct proc_dir_entry *ac_entry;
191
	struct acpi_ac ac;
192 193 194
	struct acpi_battery battery[MAX_SBS_BAT];
	int zombie;
	struct timer_list update_timer;
195 196
	int run_cnt;
	int update_proc_flg;
197 198
};

199 200 201
static int acpi_sbs_update_run(struct acpi_sbs *sbs, int id, int data_type);
static void acpi_sbs_update_time(void *data);

202 203 204 205 206 207 208 209
union sbs_rw_data {
	u16 word;
	u8 block[ACPI_SBS_BLOCK_MAX + 2];
};

static int acpi_ec_sbs_access(struct acpi_sbs *sbs, u16 addr,
			      char read_write, u8 command, int size,
			      union sbs_rw_data *data);
210 211 212 213 214

/* --------------------------------------------------------------------------
                               SMBus Communication
   -------------------------------------------------------------------------- */

215
static int acpi_ec_sbs_read(struct acpi_sbs *sbs, u8 address, u8 * data)
216
{
217 218
	u8 val;
	int err;
219

220 221 222 223 224 225 226
	err = ec_read(sbs->base + address, &val);
	if (!err) {
		*data = val;
	}
	xmsleep(ACPI_EC_SMB_TRANSACTION_SLEEP);
	return (err);
}
227

228 229 230
static int acpi_ec_sbs_write(struct acpi_sbs *sbs, u8 address, u8 data)
{
	int err;
231

232 233 234
	err = ec_write(sbs->base + address, data);
	return (err);
}
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
static int
acpi_ec_sbs_access(struct acpi_sbs *sbs, u16 addr,
		   char read_write, u8 command, int size,
		   union sbs_rw_data *data)
{
	unsigned char protocol, len = 0, temp[2] = { 0, 0 };
	int i;

	if (read_write == ACPI_SBS_SMBUS_READ) {
		protocol = ACPI_EC_SMB_PRTCL_READ;
	} else {
		protocol = ACPI_EC_SMB_PRTCL_WRITE;
	}

	switch (size) {

	case ACPI_SBS_WORD_DATA:
		acpi_ec_sbs_write(sbs, ACPI_EC_SMB_CMD, command);
		if (read_write == ACPI_SBS_SMBUS_WRITE) {
			acpi_ec_sbs_write(sbs, ACPI_EC_SMB_DATA, data->word);
			acpi_ec_sbs_write(sbs, ACPI_EC_SMB_DATA + 1,
					  data->word >> 8);
		}
		protocol |= ACPI_EC_SMB_PRTCL_WORD_DATA;
260
		break;
261 262 263 264 265 266 267 268 269 270
	case ACPI_SBS_BLOCK_DATA:
		acpi_ec_sbs_write(sbs, ACPI_EC_SMB_CMD, command);
		if (read_write == ACPI_SBS_SMBUS_WRITE) {
			len = min_t(u8, data->block[0], 32);
			acpi_ec_sbs_write(sbs, ACPI_EC_SMB_BCNT, len);
			for (i = 0; i < len; i++)
				acpi_ec_sbs_write(sbs, ACPI_EC_SMB_DATA + i,
						  data->block[i + 1]);
		}
		protocol |= ACPI_EC_SMB_PRTCL_BLOCK_DATA;
271
		break;
272 273
	default:
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
274
				"unsupported transaction %d", size));
275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293
		return (-1);
	}

	acpi_ec_sbs_write(sbs, ACPI_EC_SMB_ADDR, addr << 1);
	acpi_ec_sbs_write(sbs, ACPI_EC_SMB_PRTCL, protocol);

	acpi_ec_sbs_read(sbs, ACPI_EC_SMB_STS, temp);

	if (~temp[0] & ACPI_EC_SMB_STS_DONE) {
		xmsleep(ACPI_EC_SMB_ACCESS_SLEEP1);
		acpi_ec_sbs_read(sbs, ACPI_EC_SMB_STS, temp);
	}
	if (~temp[0] & ACPI_EC_SMB_STS_DONE) {
		xmsleep(ACPI_EC_SMB_ACCESS_SLEEP2);
		acpi_ec_sbs_read(sbs, ACPI_EC_SMB_STS, temp);
	}
	if ((~temp[0] & ACPI_EC_SMB_STS_DONE)
	    || (temp[0] & ACPI_EC_SMB_STS_STATUS)) {
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
294
				"transaction %d error", size));
295 296 297 298 299 300 301 302 303 304 305 306 307
		return (-1);
	}

	if (read_write == ACPI_SBS_SMBUS_WRITE) {
		return (0);
	}

	switch (size) {

	case ACPI_SBS_WORD_DATA:
		acpi_ec_sbs_read(sbs, ACPI_EC_SMB_DATA, temp);
		acpi_ec_sbs_read(sbs, ACPI_EC_SMB_DATA + 1, temp + 1);
		data->word = (temp[1] << 8) | temp[0];
308
		break;
309 310 311 312 313 314 315 316 317

	case ACPI_SBS_BLOCK_DATA:
		len = 0;
		acpi_ec_sbs_read(sbs, ACPI_EC_SMB_BCNT, &len);
		len = min_t(u8, len, 32);
		for (i = 0; i < len; i++)
			acpi_ec_sbs_read(sbs, ACPI_EC_SMB_DATA + i,
					 data->block + i + 1);
		data->block[0] = len;
318 319
		break;
	default:
320
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
321
				"unsupported transaction %d", size));
322
		return (-1);
323
	}
324 325

	return (0);
326 327 328
}

static int
329
acpi_sbs_read_word(struct acpi_sbs *sbs, int addr, int func, u16 * word)
330
{
331
	union sbs_rw_data data;
332 333
	int result = 0;

334 335 336 337
	result = acpi_ec_sbs_access(sbs, addr,
				    ACPI_SBS_SMBUS_READ, func,
				    ACPI_SBS_WORD_DATA, &data);
	if (result) {
338 339
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_ec_sbs_access() failed"));
340 341
	} else {
		*word = data.word;
342 343
	}

344
	return result;
345 346 347
}

static int
348
acpi_sbs_read_str(struct acpi_sbs *sbs, int addr, int func, char *str)
349
{
350
	union sbs_rw_data data;
351 352
	int result = 0;

353 354 355 356
	result = acpi_ec_sbs_access(sbs, addr,
				    ACPI_SBS_SMBUS_READ, func,
				    ACPI_SBS_BLOCK_DATA, &data);
	if (result) {
357 358
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_ec_sbs_access() failed"));
359 360 361
	} else {
		strncpy(str, (const char *)data.block + 1, data.block[0]);
		str[data.block[0]] = 0;
362 363
	}

364
	return result;
365 366 367
}

static int
368
acpi_sbs_write_word(struct acpi_sbs *sbs, int addr, int func, int word)
369
{
370
	union sbs_rw_data data;
371 372 373 374
	int result = 0;

	data.word = word;

375 376 377 378
	result = acpi_ec_sbs_access(sbs, addr,
				    ACPI_SBS_SMBUS_WRITE, func,
				    ACPI_SBS_WORD_DATA, &data);
	if (result) {
379 380
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_ec_sbs_access() failed"));
381 382
	}

383
	return result;
384 385
}

386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404
static int sbs_zombie(struct acpi_sbs *sbs)
{
	return (sbs->zombie);
}

static int sbs_mutex_lock(struct acpi_sbs *sbs)
{
	if (sbs_zombie(sbs)) {
		return -ENODEV;
	}
	mutex_lock(&sbs->mutex);
	return 0;
}

static void sbs_mutex_unlock(struct acpi_sbs *sbs)
{
	mutex_unlock(&sbs->mutex);
}

405 406 407 408
/* --------------------------------------------------------------------------
                            Smart Battery System Management
   -------------------------------------------------------------------------- */

409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428
static int acpi_check_update_proc(struct acpi_sbs *sbs)
{
	acpi_status status = AE_OK;

	if (update_time == 0) {
		sbs->update_proc_flg = 0;
		return 0;
	}
	if (sbs->update_proc_flg == 0) {
		status = acpi_os_execute(OSL_GPE_HANDLER,
					 acpi_sbs_update_time, sbs);
		if (status != AE_OK) {
			ACPI_EXCEPTION((AE_INFO, status,
					"acpi_os_execute() failed"));
			return 1;
		}
		sbs->update_proc_flg = 1;
	}
	return 0;
}
429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447

static int acpi_sbs_generate_event(struct acpi_device *device,
				   int event, int state, char *bid, char *class)
{
	char bid_saved[5];
	char class_saved[20];
	int result = 0;

	strcpy(bid_saved, acpi_device_bid(device));
	strcpy(class_saved, acpi_device_class(device));

	strcpy(acpi_device_bid(device), bid);
	strcpy(acpi_device_class(device), class);

	result = acpi_bus_generate_event(device, event, state);

	strcpy(acpi_device_bid(device), bid_saved);
	strcpy(acpi_device_class(device), class_saved);

448
	return result;
449 450 451 452 453 454 455 456
}

static int acpi_battery_get_present(struct acpi_battery *battery)
{
	s16 state;
	int result = 0;
	int is_present = 0;

457 458
	result = acpi_sbs_read_word(battery->sbs,
				    ACPI_SBSM_SMBUS_ADDR, 0x01, &state);
459
	if (result) {
460 461
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
462 463 464 465 466 467
	}
	if (!result) {
		is_present = (state & 0x000f) & (1 << battery->id);
	}
	battery->battery_present = is_present;

468
	return result;
469 470 471 472
}

static int acpi_battery_select(struct acpi_battery *battery)
{
473
	struct acpi_sbs *sbs = battery->sbs;
474 475 476 477
	int result = 0;
	s16 state;
	int foo;

478
	if (sbs->sbsm_present) {
479 480 481 482 483 484

		/* Take special care not to knobble other nibbles of
		 * state (aka selector_state), since
		 * it causes charging to halt on SBSELs */

		result =
485
		    acpi_sbs_read_word(sbs, ACPI_SBSM_SMBUS_ADDR, 0x01, &state);
486
		if (result) {
487 488
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_read_word() failed"));
489 490 491 492 493
			goto end;
		}

		foo = (state & 0x0fff) | (1 << (battery->id + 12));
		result =
494
		    acpi_sbs_write_word(sbs, ACPI_SBSM_SMBUS_ADDR, 0x01, foo);
495
		if (result) {
496 497
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_write_word() failed"));
498 499 500 501 502
			goto end;
		}
	}

      end:
503
	return result;
504 505 506 507 508 509 510
}

static int acpi_sbsm_get_info(struct acpi_sbs *sbs)
{
	int result = 0;
	s16 battery_system_info;

511 512
	result = acpi_sbs_read_word(sbs, ACPI_SBSM_SMBUS_ADDR, 0x04,
				    &battery_system_info);
513
	if (result) {
514 515
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
516 517
		goto end;
	}
518
	sbs->sbsm_present = 1;
519 520 521 522
	sbs->sbsm_batteries_supported = battery_system_info & 0x000f;

      end:

523
	return result;
524 525 526 527
}

static int acpi_battery_get_info(struct acpi_battery *battery)
{
528
	struct acpi_sbs *sbs = battery->sbs;
529 530 531 532
	int result = 0;
	s16 battery_mode;
	s16 specification_info;

533 534
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x03,
				    &battery_mode);
535
	if (result) {
536 537
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
538 539 540 541
		goto end;
	}
	battery->info.capacity_mode = (battery_mode & 0x8000) >> 15;

542 543
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x10,
				    &battery->info.full_charge_capacity);
544
	if (result) {
545 546
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
547 548 549
		goto end;
	}

550 551
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x18,
				    &battery->info.design_capacity);
552 553

	if (result) {
554 555
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
556 557 558
		goto end;
	}

559 560
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x19,
				    &battery->info.design_voltage);
561
	if (result) {
562 563
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
564 565 566
		goto end;
	}

567 568
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x1a,
				    &specification_info);
569
	if (result) {
570 571
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602
		goto end;
	}

	switch ((specification_info & 0x0f00) >> 8) {
	case 1:
		battery->info.vscale = 10;
		break;
	case 2:
		battery->info.vscale = 100;
		break;
	case 3:
		battery->info.vscale = 1000;
		break;
	default:
		battery->info.vscale = 1;
	}

	switch ((specification_info & 0xf000) >> 12) {
	case 1:
		battery->info.ipscale = 10;
		break;
	case 2:
		battery->info.ipscale = 100;
		break;
	case 3:
		battery->info.ipscale = 1000;
		break;
	default:
		battery->info.ipscale = 1;
	}

603 604
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x1c,
				    &battery->info.serial_number);
605
	if (result) {
606 607
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
608 609 610
		goto end;
	}

611 612
	result = acpi_sbs_read_str(sbs, ACPI_SB_SMBUS_ADDR, 0x20,
				   battery->info.manufacturer_name);
613
	if (result) {
614 615
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_str() failed"));
616 617 618
		goto end;
	}

619 620
	result = acpi_sbs_read_str(sbs, ACPI_SB_SMBUS_ADDR, 0x21,
				   battery->info.device_name);
621
	if (result) {
622 623
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_str() failed"));
624 625 626
		goto end;
	}

627 628
	result = acpi_sbs_read_str(sbs, ACPI_SB_SMBUS_ADDR, 0x22,
				   battery->info.device_chemistry);
629
	if (result) {
630 631
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_str() failed"));
632 633 634 635
		goto end;
	}

      end:
636
	return result;
637 638 639 640
}

static int acpi_battery_get_state(struct acpi_battery *battery)
{
641
	struct acpi_sbs *sbs = battery->sbs;
642 643
	int result = 0;

644 645
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x09,
				    &battery->state.voltage);
646
	if (result) {
647 648
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
649 650 651
		goto end;
	}

652 653
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x0a,
				    &battery->state.amperage);
654
	if (result) {
655 656
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
657 658 659
		goto end;
	}

660 661
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x0f,
				    &battery->state.remaining_capacity);
662
	if (result) {
663 664
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
665 666 667
		goto end;
	}

668
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x16,
669
				    &battery->state.battery_state);
670
	if (result) {
671 672
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
673 674 675 676
		goto end;
	}

      end:
677
	return result;
678 679 680 681
}

static int acpi_battery_get_alarm(struct acpi_battery *battery)
{
682
	struct acpi_sbs *sbs = battery->sbs;
683 684
	int result = 0;

685 686
	result = acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x01,
				    &battery->alarm.remaining_capacity);
687
	if (result) {
688 689
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
690 691 692 693 694
		goto end;
	}

      end:

695
	return result;
696 697 698 699 700
}

static int acpi_battery_set_alarm(struct acpi_battery *battery,
				  unsigned long alarm)
{
701
	struct acpi_sbs *sbs = battery->sbs;
702 703 704 705 706 707
	int result = 0;
	s16 battery_mode;
	int foo;

	result = acpi_battery_select(battery);
	if (result) {
708 709
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_select() failed"));
710 711 712 713 714 715 716
		goto end;
	}

	/* If necessary, enable the alarm */

	if (alarm > 0) {
		result =
717 718
		    acpi_sbs_read_word(sbs, ACPI_SB_SMBUS_ADDR, 0x03,
				       &battery_mode);
719
		if (result) {
720 721
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_read_word() failed"));
722 723 724 725
			goto end;
		}

		result =
726 727
		    acpi_sbs_write_word(sbs, ACPI_SB_SMBUS_ADDR, 0x01,
					battery_mode & 0xbfff);
728
		if (result) {
729 730
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_write_word() failed"));
731 732 733 734 735
			goto end;
		}
	}

	foo = alarm / (battery->info.capacity_mode ? 10 : 1);
736
	result = acpi_sbs_write_word(sbs, ACPI_SB_SMBUS_ADDR, 0x01, foo);
737
	if (result) {
738 739
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_write_word() failed"));
740 741 742 743 744
		goto end;
	}

      end:

745
	return result;
746 747 748 749
}

static int acpi_battery_set_mode(struct acpi_battery *battery)
{
750
	struct acpi_sbs *sbs = battery->sbs;
751 752 753 754 755 756 757
	int result = 0;
	s16 battery_mode;

	if (capacity_mode == DEF_CAPACITY_UNIT) {
		goto end;
	}

758
	result = acpi_sbs_read_word(sbs,
759
				    ACPI_SB_SMBUS_ADDR, 0x03, &battery_mode);
760
	if (result) {
761 762
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
763 764 765 766 767 768 769 770
		goto end;
	}

	if (capacity_mode == MAH_CAPACITY_UNIT) {
		battery_mode &= 0x7fff;
	} else {
		battery_mode |= 0x8000;
	}
771
	result = acpi_sbs_write_word(sbs,
772
				     ACPI_SB_SMBUS_ADDR, 0x03, battery_mode);
773
	if (result) {
774 775
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_write_word() failed"));
776 777 778
		goto end;
	}

779
	result = acpi_sbs_read_word(sbs,
780
				    ACPI_SB_SMBUS_ADDR, 0x03, &battery_mode);
781
	if (result) {
782 783
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
784 785 786 787
		goto end;
	}

      end:
788
	return result;
789 790 791 792 793 794 795 796
}

static int acpi_battery_init(struct acpi_battery *battery)
{
	int result = 0;

	result = acpi_battery_select(battery);
	if (result) {
797
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
798
				"acpi_battery_select() failed"));
799 800 801 802 803
		goto end;
	}

	result = acpi_battery_set_mode(battery);
	if (result) {
804 805
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_set_mode() failed"));
806 807 808 809 810
		goto end;
	}

	result = acpi_battery_get_info(battery);
	if (result) {
811 812
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_get_info() failed"));
813 814 815 816 817
		goto end;
	}

	result = acpi_battery_get_state(battery);
	if (result) {
818 819
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_get_state() failed"));
820 821 822 823 824
		goto end;
	}

	result = acpi_battery_get_alarm(battery);
	if (result) {
825 826
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_get_alarm() failed"));
827 828 829 830
		goto end;
	}

      end:
831
	return result;
832 833 834 835 836 837 838
}

static int acpi_ac_get_present(struct acpi_sbs *sbs)
{
	int result = 0;
	s16 charger_status;

839 840
	result = acpi_sbs_read_word(sbs, ACPI_SBC_SMBUS_ADDR, 0x13,
				    &charger_status);
841 842

	if (result) {
843 844
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_read_word() failed"));
845 846 847
		goto end;
	}

848
	sbs->ac.ac_present = (charger_status & 0x8000) >> 15;
849 850 851

      end:

852
	return result;
853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873
}

/* --------------------------------------------------------------------------
                              FS Interface (/proc/acpi)
   -------------------------------------------------------------------------- */

/* Generic Routines */

static int
acpi_sbs_generic_add_fs(struct proc_dir_entry **dir,
			struct proc_dir_entry *parent_dir,
			char *dir_name,
			struct file_operations *info_fops,
			struct file_operations *state_fops,
			struct file_operations *alarm_fops, void *data)
{
	struct proc_dir_entry *entry = NULL;

	if (!*dir) {
		*dir = proc_mkdir(dir_name, parent_dir);
		if (!*dir) {
874 875
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"proc_mkdir() failed"));
876
			return -ENODEV;
877 878 879 880 881 882 883 884
		}
		(*dir)->owner = THIS_MODULE;
	}

	/* 'info' [R] */
	if (info_fops) {
		entry = create_proc_entry(ACPI_SBS_FILE_INFO, S_IRUGO, *dir);
		if (!entry) {
885 886
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"create_proc_entry() failed"));
887 888 889 890 891 892 893 894 895 896 897
		} else {
			entry->proc_fops = info_fops;
			entry->data = data;
			entry->owner = THIS_MODULE;
		}
	}

	/* 'state' [R] */
	if (state_fops) {
		entry = create_proc_entry(ACPI_SBS_FILE_STATE, S_IRUGO, *dir);
		if (!entry) {
898 899
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"create_proc_entry() failed"));
900 901 902 903 904 905 906 907 908 909 910
		} else {
			entry->proc_fops = state_fops;
			entry->data = data;
			entry->owner = THIS_MODULE;
		}
	}

	/* 'alarm' [R/W] */
	if (alarm_fops) {
		entry = create_proc_entry(ACPI_SBS_FILE_ALARM, S_IRUGO, *dir);
		if (!entry) {
911 912
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"create_proc_entry() failed"));
913 914 915 916 917 918 919
		} else {
			entry->proc_fops = alarm_fops;
			entry->data = data;
			entry->owner = THIS_MODULE;
		}
	}

920
	return 0;
921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943
}

static void
acpi_sbs_generic_remove_fs(struct proc_dir_entry **dir,
			   struct proc_dir_entry *parent_dir)
{

	if (*dir) {
		remove_proc_entry(ACPI_SBS_FILE_INFO, *dir);
		remove_proc_entry(ACPI_SBS_FILE_STATE, *dir);
		remove_proc_entry(ACPI_SBS_FILE_ALARM, *dir);
		remove_proc_entry((*dir)->name, parent_dir);
		*dir = NULL;
	}

}

/* Smart Battery Interface */

static struct proc_dir_entry *acpi_battery_dir = NULL;

static int acpi_battery_read_info(struct seq_file *seq, void *offset)
{
944
	struct acpi_battery *battery = seq->private;
945
	struct acpi_sbs *sbs = battery->sbs;
946 947 948
	int cscale;
	int result = 0;

949
	if (sbs_mutex_lock(sbs)) {
950
		return -ENODEV;
951 952
	}

953 954 955
	result = acpi_check_update_proc(sbs);
	if (result)
		goto end;
956

957 958
	if (update_time == 0) {
		result = acpi_sbs_update_run(sbs, battery->id, DATA_TYPE_INFO);
959
		if (result) {
960 961
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_update_run() failed"));
962 963 964
		}
	}

965
	if (battery->battery_present) {
966 967 968 969 970 971 972 973 974 975 976
		seq_printf(seq, "present:                 yes\n");
	} else {
		seq_printf(seq, "present:                 no\n");
		goto end;
	}

	if (battery->info.capacity_mode) {
		cscale = battery->info.vscale * battery->info.ipscale;
	} else {
		cscale = battery->info.ipscale;
	}
977
	seq_printf(seq, "design capacity:         %i%s\n",
978
		   battery->info.design_capacity * cscale,
979
		   battery->info.capacity_mode ? "0 mWh" : " mAh");
980

981
	seq_printf(seq, "last full capacity:      %i%s\n",
982
		   battery->info.full_charge_capacity * cscale,
983
		   battery->info.capacity_mode ? "0 mWh" : " mAh");
984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008

	seq_printf(seq, "battery technology:      rechargeable\n");

	seq_printf(seq, "design voltage:          %i mV\n",
		   battery->info.design_voltage * battery->info.vscale);

	seq_printf(seq, "design capacity warning: unknown\n");
	seq_printf(seq, "design capacity low:     unknown\n");
	seq_printf(seq, "capacity granularity 1:  unknown\n");
	seq_printf(seq, "capacity granularity 2:  unknown\n");

	seq_printf(seq, "model number:            %s\n",
		   battery->info.device_name);

	seq_printf(seq, "serial number:           %i\n",
		   battery->info.serial_number);

	seq_printf(seq, "battery type:            %s\n",
		   battery->info.device_chemistry);

	seq_printf(seq, "OEM info:                %s\n",
		   battery->info.manufacturer_name);

      end:

1009
	sbs_mutex_unlock(sbs);
1010

1011
	return result;
1012 1013 1014 1015 1016 1017 1018 1019 1020
}

static int acpi_battery_info_open_fs(struct inode *inode, struct file *file)
{
	return single_open(file, acpi_battery_read_info, PDE(inode)->data);
}

static int acpi_battery_read_state(struct seq_file *seq, void *offset)
{
1021 1022
	struct acpi_battery *battery = seq->private;
	struct acpi_sbs *sbs = battery->sbs;
1023 1024 1025 1026
	int result = 0;
	int cscale;
	int foo;

1027
	if (sbs_mutex_lock(sbs)) {
1028
		return -ENODEV;
1029 1030
	}

1031 1032 1033
	result = acpi_check_update_proc(sbs);
	if (result)
		goto end;
1034

1035 1036
	if (update_time == 0) {
		result = acpi_sbs_update_run(sbs, battery->id, DATA_TYPE_STATE);
1037
		if (result) {
1038 1039
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_update_run() failed"));
1040 1041 1042
		}
	}

1043
	if (battery->battery_present) {
1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055
		seq_printf(seq, "present:                 yes\n");
	} else {
		seq_printf(seq, "present:                 no\n");
		goto end;
	}

	if (battery->info.capacity_mode) {
		cscale = battery->info.vscale * battery->info.ipscale;
	} else {
		cscale = battery->info.ipscale;
	}

1056
	if (battery->state.battery_state & 0x0010) {
1057 1058 1059 1060
		seq_printf(seq, "capacity state:          critical\n");
	} else {
		seq_printf(seq, "capacity state:          ok\n");
	}
V
Vladimir Lebedev 已提交
1061 1062 1063 1064 1065

	foo = (s16) battery->state.amperage * battery->info.ipscale;
	if (battery->info.capacity_mode) {
		foo = foo * battery->info.design_voltage / 1000;
	}
1066 1067
	if (battery->state.amperage < 0) {
		seq_printf(seq, "charging state:          discharging\n");
V
Vladimir Lebedev 已提交
1068 1069
		seq_printf(seq, "present rate:            %d %s\n",
			   -foo, battery->info.capacity_mode ? "mW" : "mA");
1070 1071
	} else if (battery->state.amperage > 0) {
		seq_printf(seq, "charging state:          charging\n");
V
Vladimir Lebedev 已提交
1072 1073
		seq_printf(seq, "present rate:            %d %s\n",
			   foo, battery->info.capacity_mode ? "mW" : "mA");
1074 1075 1076 1077 1078 1079
	} else {
		seq_printf(seq, "charging state:          charged\n");
		seq_printf(seq, "present rate:            0 %s\n",
			   battery->info.capacity_mode ? "mW" : "mA");
	}

1080
	seq_printf(seq, "remaining capacity:      %i%s\n",
1081
		   battery->state.remaining_capacity * cscale,
1082
		   battery->info.capacity_mode ? "0 mWh" : " mAh");
1083 1084 1085 1086 1087 1088

	seq_printf(seq, "present voltage:         %i mV\n",
		   battery->state.voltage * battery->info.vscale);

      end:

1089
	sbs_mutex_unlock(sbs);
1090

1091
	return result;
1092 1093 1094 1095 1096 1097 1098 1099 1100
}

static int acpi_battery_state_open_fs(struct inode *inode, struct file *file)
{
	return single_open(file, acpi_battery_read_state, PDE(inode)->data);
}

static int acpi_battery_read_alarm(struct seq_file *seq, void *offset)
{
1101
	struct acpi_battery *battery = seq->private;
1102
	struct acpi_sbs *sbs = battery->sbs;
1103 1104 1105
	int result = 0;
	int cscale;

1106
	if (sbs_mutex_lock(sbs)) {
1107
		return -ENODEV;
1108 1109
	}

1110 1111 1112
	result = acpi_check_update_proc(sbs);
	if (result)
		goto end;
1113

1114 1115
	if (update_time == 0) {
		result = acpi_sbs_update_run(sbs, battery->id, DATA_TYPE_ALARM);
1116
		if (result) {
1117 1118
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_update_run() failed"));
1119 1120 1121
		}
	}

1122
	if (!battery->battery_present) {
1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134
		seq_printf(seq, "present:                 no\n");
		goto end;
	}

	if (battery->info.capacity_mode) {
		cscale = battery->info.vscale * battery->info.ipscale;
	} else {
		cscale = battery->info.ipscale;
	}

	seq_printf(seq, "alarm:                   ");
	if (battery->alarm.remaining_capacity) {
1135
		seq_printf(seq, "%i%s\n",
1136
			   battery->alarm.remaining_capacity * cscale,
1137
			   battery->info.capacity_mode ? "0 mWh" : " mAh");
1138 1139 1140 1141 1142 1143
	} else {
		seq_printf(seq, "disabled\n");
	}

      end:

1144
	sbs_mutex_unlock(sbs);
1145

1146
	return result;
1147 1148 1149 1150 1151 1152
}

static ssize_t
acpi_battery_write_alarm(struct file *file, const char __user * buffer,
			 size_t count, loff_t * ppos)
{
1153 1154
	struct seq_file *seq = file->private_data;
	struct acpi_battery *battery = seq->private;
1155
	struct acpi_sbs *sbs = battery->sbs;
1156 1157 1158
	char alarm_string[12] = { '\0' };
	int result, old_alarm, new_alarm;

1159
	if (sbs_mutex_lock(sbs)) {
1160
		return -ENODEV;
1161 1162
	}

1163 1164 1165
	result = acpi_check_update_proc(sbs);
	if (result)
		goto end;
1166

1167
	if (!battery->battery_present) {
1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188
		result = -ENODEV;
		goto end;
	}

	if (count > sizeof(alarm_string) - 1) {
		result = -EINVAL;
		goto end;
	}

	if (copy_from_user(alarm_string, buffer, count)) {
		result = -EFAULT;
		goto end;
	}

	alarm_string[count] = 0;

	old_alarm = battery->alarm.remaining_capacity;
	new_alarm = simple_strtoul(alarm_string, NULL, 0);

	result = acpi_battery_set_alarm(battery, new_alarm);
	if (result) {
1189 1190
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_set_alarm() failed"));
1191
		acpi_battery_set_alarm(battery, old_alarm);
1192 1193 1194 1195
		goto end;
	}
	result = acpi_battery_get_alarm(battery);
	if (result) {
1196 1197
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_get_alarm() failed"));
1198
		acpi_battery_set_alarm(battery, old_alarm);
1199 1200 1201 1202
		goto end;
	}

      end:
1203
	sbs_mutex_unlock(sbs);
1204 1205

	if (result) {
1206
		return result;
1207
	} else {
1208
		return count;
1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247
	}
}

static int acpi_battery_alarm_open_fs(struct inode *inode, struct file *file)
{
	return single_open(file, acpi_battery_read_alarm, PDE(inode)->data);
}

static struct file_operations acpi_battery_info_fops = {
	.open = acpi_battery_info_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
	.owner = THIS_MODULE,
};

static struct file_operations acpi_battery_state_fops = {
	.open = acpi_battery_state_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
	.owner = THIS_MODULE,
};

static struct file_operations acpi_battery_alarm_fops = {
	.open = acpi_battery_alarm_open_fs,
	.read = seq_read,
	.write = acpi_battery_write_alarm,
	.llseek = seq_lseek,
	.release = single_release,
	.owner = THIS_MODULE,
};

/* Legacy AC Adapter Interface */

static struct proc_dir_entry *acpi_ac_dir = NULL;

static int acpi_ac_read_state(struct seq_file *seq, void *offset)
{
1248
	struct acpi_sbs *sbs = seq->private;
1249 1250
	int result;

1251
	if (sbs_mutex_lock(sbs)) {
1252
		return -ENODEV;
1253 1254
	}

1255 1256
	if (update_time == 0) {
		result = acpi_sbs_update_run(sbs, -1, DATA_TYPE_AC_STATE);
1257
		if (result) {
1258 1259
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_update_run() failed"));
1260 1261 1262 1263
		}
	}

	seq_printf(seq, "state:                   %s\n",
1264
		   sbs->ac.ac_present ? "on-line" : "off-line");
1265

1266
	sbs_mutex_unlock(sbs);
1267

1268
	return 0;
1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306
}

static int acpi_ac_state_open_fs(struct inode *inode, struct file *file)
{
	return single_open(file, acpi_ac_read_state, PDE(inode)->data);
}

static struct file_operations acpi_ac_state_fops = {
	.open = acpi_ac_state_open_fs,
	.read = seq_read,
	.llseek = seq_lseek,
	.release = single_release,
	.owner = THIS_MODULE,
};

/* --------------------------------------------------------------------------
                                 Driver Interface
   -------------------------------------------------------------------------- */

/* Smart Battery */

static int acpi_battery_add(struct acpi_sbs *sbs, int id)
{
	int is_present;
	int result;
	char dir_name[32];
	struct acpi_battery *battery;

	battery = &sbs->battery[id];

	battery->alive = 0;

	battery->init_state = 0;
	battery->id = id;
	battery->sbs = sbs;

	result = acpi_battery_select(battery);
	if (result) {
1307 1308
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_select() failed"));
1309 1310 1311 1312 1313
		goto end;
	}

	result = acpi_battery_get_present(battery);
	if (result) {
1314 1315
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_battery_get_present() failed"));
1316 1317 1318
		goto end;
	}

1319
	is_present = battery->battery_present;
1320 1321 1322 1323

	if (is_present) {
		result = acpi_battery_init(battery);
		if (result) {
1324 1325
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_battery_init() failed"));
1326 1327 1328 1329 1330
			goto end;
		}
		battery->init_state = 1;
	}

1331
	sprintf(dir_name, ACPI_BATTERY_DIR_NAME, id);
1332 1333 1334 1335 1336 1337 1338 1339

	result = acpi_sbs_generic_add_fs(&battery->battery_entry,
					 acpi_battery_dir,
					 dir_name,
					 &acpi_battery_info_fops,
					 &acpi_battery_state_fops,
					 &acpi_battery_alarm_fops, battery);
	if (result) {
1340 1341
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_generic_add_fs() failed"));
1342 1343 1344 1345
		goto end;
	}
	battery->alive = 1;

1346 1347 1348 1349
	printk(KERN_INFO PREFIX "%s [%s]: Battery Slot [%s] (battery %s)\n",
	       ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device), dir_name,
	       sbs->battery->battery_present ? "present" : "absent");

1350
      end:
1351
	return result;
1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368
}

static void acpi_battery_remove(struct acpi_sbs *sbs, int id)
{

	if (sbs->battery[id].battery_entry) {
		acpi_sbs_generic_remove_fs(&(sbs->battery[id].battery_entry),
					   acpi_battery_dir);
	}
}

static int acpi_ac_add(struct acpi_sbs *sbs)
{
	int result;

	result = acpi_ac_get_present(sbs);
	if (result) {
1369 1370
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_ac_get_present() failed"));
1371 1372 1373 1374 1375 1376 1377 1378
		goto end;
	}

	result = acpi_sbs_generic_add_fs(&sbs->ac_entry,
					 acpi_ac_dir,
					 ACPI_AC_DIR_NAME,
					 NULL, &acpi_ac_state_fops, NULL, sbs);
	if (result) {
1379 1380
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_generic_add_fs() failed"));
1381 1382 1383
		goto end;
	}

1384 1385 1386 1387
	printk(KERN_INFO PREFIX "%s [%s]: AC Adapter [%s] (%s)\n",
	       ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device),
	       ACPI_AC_DIR_NAME, sbs->ac.ac_present ? "on-line" : "off-line");

1388 1389
      end:

1390
	return result;
1391 1392 1393 1394 1395 1396 1397 1398 1399 1400
}

static void acpi_ac_remove(struct acpi_sbs *sbs)
{

	if (sbs->ac_entry) {
		acpi_sbs_generic_remove_fs(&sbs->ac_entry, acpi_ac_dir);
	}
}

1401
static void acpi_sbs_update_time_run(unsigned long data)
1402
{
1403
	acpi_os_execute(OSL_GPE_HANDLER, acpi_sbs_update_time, (void *)data);
1404 1405
}

1406
static int acpi_sbs_update_run(struct acpi_sbs *sbs, int id, int data_type)
1407 1408
{
	struct acpi_battery *battery;
1409 1410 1411 1412 1413 1414
	int result = 0, cnt;
	int old_ac_present = -1;
	int old_battery_present = -1;
	int new_ac_present = -1;
	int new_battery_present = -1;
	int id_min = 0, id_max = MAX_SBS_BAT - 1;
1415
	char dir_name[32];
1416 1417
	int do_battery_init = 0, do_ac_init = 0;
	int old_remaining_capacity = 0;
A
Adrian Bunk 已提交
1418
	int update_battery = 1;
1419 1420 1421 1422 1423
	int up_tm = update_time;

	if (sbs_zombie(sbs)) {
		goto end;
	}
1424

1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438
	if (id >= 0) {
		id_min = id_max = id;
	}

	if (data_type == DATA_TYPE_COMMON && up_tm > 0) {
		cnt = up_tm / (up_tm > UPDATE_DELAY ? UPDATE_DELAY : up_tm);
		if (sbs->run_cnt % cnt != 0) {
			update_battery = 0;
		}
	}

	sbs->run_cnt++;

	old_ac_present = sbs->ac.ac_present;
1439 1440 1441

	result = acpi_ac_get_present(sbs);
	if (result) {
1442 1443
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_ac_get_present() failed"));
1444 1445
	}

1446
	new_ac_present = sbs->ac.ac_present;
1447 1448

	do_ac_init = (old_ac_present != new_ac_present);
1449 1450 1451
	if (sbs->run_cnt == 1 && data_type == DATA_TYPE_COMMON) {
		do_ac_init = 1;
	}
1452

1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471
	if (do_ac_init) {
		result = acpi_sbs_generate_event(sbs->device,
						 ACPI_SBS_AC_NOTIFY_STATUS,
						 new_ac_present,
						 ACPI_AC_DIR_NAME,
						 ACPI_AC_CLASS);
		if (result) {
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_generate_event() failed"));
		}
	}

	if (data_type == DATA_TYPE_COMMON) {
		if (!do_ac_init && !update_battery) {
			goto end;
		}
	}

	if (data_type == DATA_TYPE_AC_STATE && !do_ac_init) {
1472 1473 1474
		goto end;
	}

1475
	for (id = id_min; id <= id_max; id++) {
1476 1477 1478 1479 1480 1481 1482
		battery = &sbs->battery[id];
		if (battery->alive == 0) {
			continue;
		}

		old_remaining_capacity = battery->state.remaining_capacity;

1483
		old_battery_present = battery->battery_present;
1484 1485 1486

		result = acpi_battery_select(battery);
		if (result) {
1487 1488
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_battery_select() failed"));
1489 1490 1491 1492
		}

		result = acpi_battery_get_present(battery);
		if (result) {
1493 1494
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_battery_get_present() failed"));
1495 1496
		}

1497
		new_battery_present = battery->battery_present;
1498 1499 1500

		do_battery_init = ((old_battery_present != new_battery_present)
				   && new_battery_present);
1501 1502 1503
		if (!new_battery_present)
			goto event;
		if (do_ac_init || do_battery_init) {
1504 1505
			result = acpi_battery_init(battery);
			if (result) {
1506 1507 1508
				ACPI_EXCEPTION((AE_INFO, AE_ERROR,
						"acpi_battery_init() "
						"failed"));
1509 1510
			}
		}
1511
		if (sbs_zombie(sbs)) {
1512 1513
			goto end;
		}
1514 1515 1516 1517 1518

		if ((data_type == DATA_TYPE_COMMON
		     || data_type == DATA_TYPE_INFO)
		    && new_battery_present) {
			result = acpi_battery_get_info(battery);
1519
			if (result) {
1520
				ACPI_EXCEPTION((AE_INFO, AE_ERROR,
1521
						"acpi_battery_get_info() failed"));
1522
			}
1523 1524 1525 1526 1527 1528 1529
		}
		if (data_type == DATA_TYPE_INFO) {
			continue;
		}
		if (sbs_zombie(sbs)) {
			goto end;
		}
1530

1531 1532 1533
		if ((data_type == DATA_TYPE_COMMON
		     || data_type == DATA_TYPE_STATE)
		    && new_battery_present) {
1534 1535
			result = acpi_battery_get_state(battery);
			if (result) {
1536
				ACPI_EXCEPTION((AE_INFO, AE_ERROR,
1537
						"acpi_battery_get_state() failed"));
1538 1539
			}
		}
1540 1541
		if (data_type == DATA_TYPE_STATE) {
			goto event;
1542
		}
1543 1544
		if (sbs_zombie(sbs)) {
			goto end;
1545 1546
		}

1547 1548 1549 1550
		if ((data_type == DATA_TYPE_COMMON
		     || data_type == DATA_TYPE_ALARM)
		    && new_battery_present) {
			result = acpi_battery_get_alarm(battery);
1551
			if (result) {
1552
				ACPI_EXCEPTION((AE_INFO, AE_ERROR,
1553
						"acpi_battery_get_alarm() "
1554
						"failed"));
1555 1556
			}
		}
1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568
		if (data_type == DATA_TYPE_ALARM) {
			continue;
		}
		if (sbs_zombie(sbs)) {
			goto end;
		}

	      event:

		if (old_battery_present != new_battery_present || do_ac_init ||
		    old_remaining_capacity !=
		    battery->state.remaining_capacity) {
1569
			sprintf(dir_name, ACPI_BATTERY_DIR_NAME, id);
1570 1571 1572 1573 1574 1575
			result = acpi_sbs_generate_event(sbs->device,
							 ACPI_SBS_BATTERY_NOTIFY_STATUS,
							 new_battery_present,
							 dir_name,
							 ACPI_BATTERY_CLASS);
			if (result) {
1576
				ACPI_EXCEPTION((AE_INFO, AE_ERROR,
1577 1578
						"acpi_sbs_generate_event() "
						"failed"));
1579 1580 1581 1582 1583
			}
		}
	}

      end:
1584

1585
	return result;
1586 1587
}

1588
static void acpi_sbs_update_time(void *data)
1589 1590 1591 1592
{
	struct acpi_sbs *sbs = data;
	unsigned long delay = -1;
	int result;
1593
	unsigned int up_tm = update_time;
1594

1595 1596
	if (sbs_mutex_lock(sbs))
		return;
1597

1598
	result = acpi_sbs_update_run(sbs, -1, DATA_TYPE_COMMON);
1599
	if (result) {
1600 1601
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_sbs_update_run() failed"));
1602 1603
	}

1604
	if (sbs_zombie(sbs)) {
1605 1606 1607
		goto end;
	}

1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621
	if (!up_tm) {
		if (timer_pending(&sbs->update_timer))
			del_timer(&sbs->update_timer);
	} else {
		delay = (up_tm > UPDATE_DELAY ? UPDATE_DELAY : up_tm);
		delay = jiffies + HZ * delay;
		if (timer_pending(&sbs->update_timer)) {
			mod_timer(&sbs->update_timer, delay);
		} else {
			sbs->update_timer.data = (unsigned long)data;
			sbs->update_timer.function = acpi_sbs_update_time_run;
			sbs->update_timer.expires = delay;
			add_timer(&sbs->update_timer);
		}
1622 1623 1624
	}

      end:
1625 1626

	sbs_mutex_unlock(sbs);
1627 1628 1629 1630 1631
}

static int acpi_sbs_add(struct acpi_device *device)
{
	struct acpi_sbs *sbs = NULL;
1632
	int result = 0, remove_result = 0;
1633
	int id;
1634
	acpi_status status = AE_OK;
1635 1636 1637
	unsigned long val;

	status =
1638
	    acpi_evaluate_integer(device->handle, "_EC", NULL, &val);
1639
	if (ACPI_FAILURE(status)) {
1640
		ACPI_EXCEPTION((AE_INFO, AE_ERROR, "Error obtaining _EC"));
1641 1642
		return -EIO;
	}
1643

1644
	sbs = kzalloc(sizeof(struct acpi_sbs), GFP_KERNEL);
1645
	if (!sbs) {
1646 1647 1648
		ACPI_EXCEPTION((AE_INFO, AE_ERROR, "kzalloc() failed"));
		result = -ENOMEM;
		goto end;
1649 1650
	}

1651 1652 1653 1654
	mutex_init(&sbs->mutex);

	sbs_mutex_lock(sbs);

1655
	sbs->base = 0xff & (val >> 8);
1656 1657 1658 1659 1660 1661 1662 1663
	sbs->device = device;

	strcpy(acpi_device_name(device), ACPI_SBS_DEVICE_NAME);
	strcpy(acpi_device_class(device), ACPI_SBS_CLASS);
	acpi_driver_data(device) = sbs;

	result = acpi_ac_add(sbs);
	if (result) {
1664
		ACPI_EXCEPTION((AE_INFO, AE_ERROR, "acpi_ac_add() failed"));
1665 1666
		goto end;
	}
1667

1668 1669 1670
	acpi_sbsm_get_info(sbs);

	if (!sbs->sbsm_present) {
1671 1672
		result = acpi_battery_add(sbs, 0);
		if (result) {
1673 1674
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_battery_add() failed"));
1675 1676 1677 1678 1679 1680 1681
			goto end;
		}
	} else {
		for (id = 0; id < MAX_SBS_BAT; id++) {
			if ((sbs->sbsm_batteries_supported & (1 << id))) {
				result = acpi_battery_add(sbs, id);
				if (result) {
1682
					ACPI_EXCEPTION((AE_INFO, AE_ERROR,
1683
							"acpi_battery_add() failed"));
1684 1685 1686 1687 1688 1689 1690
					goto end;
				}
			}
		}
	}

	init_timer(&sbs->update_timer);
1691 1692 1693
	result = acpi_check_update_proc(sbs);
	if (result)
		goto end;
1694 1695

      end:
1696 1697 1698

	sbs_mutex_unlock(sbs);

1699
	if (result) {
1700 1701 1702 1703 1704
		remove_result = acpi_sbs_remove(device, 0);
		if (remove_result) {
			ACPI_EXCEPTION((AE_INFO, AE_ERROR,
					"acpi_sbs_remove() failed"));
		}
1705 1706
	}

1707
	return result;
1708 1709
}

1710
static int acpi_sbs_remove(struct acpi_device *device, int type)
1711
{
L
Len Brown 已提交
1712
	struct acpi_sbs *sbs;
1713 1714
	int id;

1715 1716 1717 1718
	if (!device) {
		return -EINVAL;
	}

1719
	sbs = acpi_driver_data(device);
1720
	if (!sbs) {
1721
		return -EINVAL;
1722 1723
	}

1724 1725
	sbs_mutex_lock(sbs);

1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736
	sbs->zombie = 1;
	del_timer_sync(&sbs->update_timer);
	acpi_os_wait_events_complete(NULL);
	del_timer_sync(&sbs->update_timer);

	for (id = 0; id < MAX_SBS_BAT; id++) {
		acpi_battery_remove(sbs, id);
	}

	acpi_ac_remove(sbs);

1737 1738 1739
	sbs_mutex_unlock(sbs);

	mutex_destroy(&sbs->mutex);
1740

1741 1742
	kfree(sbs);

1743
	return 0;
1744 1745
}

1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771
static void acpi_sbs_rmdirs(void)
{
	if (acpi_ac_dir) {
		acpi_unlock_ac_dir(acpi_ac_dir);
		acpi_ac_dir = NULL;
	}
	if (acpi_battery_dir) {
		acpi_unlock_battery_dir(acpi_battery_dir);
		acpi_battery_dir = NULL;
	}
}

static int acpi_sbs_resume(struct acpi_device *device)
{
	struct acpi_sbs *sbs;

	if (!device)
		return -EINVAL;

	sbs = device->driver_data;

	sbs->run_cnt = 0;

	return 0;
}

1772 1773 1774 1775
static int __init acpi_sbs_init(void)
{
	int result = 0;

1776 1777 1778
	if (acpi_disabled)
		return -ENODEV;

1779 1780 1781
	if (capacity_mode != DEF_CAPACITY_UNIT
	    && capacity_mode != MAH_CAPACITY_UNIT
	    && capacity_mode != MWH_CAPACITY_UNIT) {
1782
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
1783
				"invalid capacity_mode = %d", capacity_mode));
1784
		return -EINVAL;
1785 1786 1787 1788
	}

	acpi_ac_dir = acpi_lock_ac_dir();
	if (!acpi_ac_dir) {
1789 1790
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_lock_ac_dir() failed"));
1791
		return -ENODEV;
1792 1793 1794 1795
	}

	acpi_battery_dir = acpi_lock_battery_dir();
	if (!acpi_battery_dir) {
1796 1797
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_lock_battery_dir() failed"));
1798
		acpi_sbs_rmdirs();
1799
		return -ENODEV;
1800 1801 1802 1803
	}

	result = acpi_bus_register_driver(&acpi_sbs_driver);
	if (result < 0) {
1804 1805
		ACPI_EXCEPTION((AE_INFO, AE_ERROR,
				"acpi_bus_register_driver() failed"));
1806
		acpi_sbs_rmdirs();
1807
		return -ENODEV;
1808 1809
	}

1810
	return 0;
1811 1812 1813 1814 1815 1816
}

static void __exit acpi_sbs_exit(void)
{
	acpi_bus_unregister_driver(&acpi_sbs_driver);

1817
	acpi_sbs_rmdirs();
1818

1819
	return;
1820 1821 1822 1823
}

module_init(acpi_sbs_init);
module_exit(acpi_sbs_exit);