1/* 2 * sbs.c - ACPI Smart Battery System Driver ($Revision: 2.0 $) 3 * 4 * Copyright (c) 2007 Alexey Starikovskiy <astarikovskiy@suse.de> 5 * Copyright (c) 2005-2007 Vladimir Lebedev <vladimir.p.lebedev@intel.com> 6 * Copyright (c) 2005 Rich Townsend <rhdt@bartol.udel.edu> 7 * 8 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of the GNU General Public License as published by 12 * the Free Software Foundation; either version 2 of the License, or (at 13 * your option) any later version. 14 * 15 * This program is distributed in the hope that it will be useful, but 16 * WITHOUT ANY WARRANTY; without even the implied warranty of 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 18 * General Public License for more details. 19 * 20 * You should have received a copy of the GNU General Public License along 21 * with this program; if not, write to the Free Software Foundation, Inc., 22 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. 23 * 24 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 25 */ 26 27#include <linux/init.h> 28#include <linux/slab.h> 29#include <linux/module.h> 30#include <linux/moduleparam.h> 31#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#include <linux/power_supply.h> 38#include <linux/dmi.h> 39 40#include "sbshc.h" 41#include "battery.h" 42 43#define PREFIX "ACPI: " 44 45#define ACPI_SBS_CLASS "sbs" 46#define ACPI_AC_CLASS "ac_adapter" 47#define ACPI_SBS_DEVICE_NAME "Smart Battery System" 48#define ACPI_SBS_FILE_INFO "info" 49#define ACPI_SBS_FILE_STATE "state" 50#define ACPI_SBS_FILE_ALARM "alarm" 51#define ACPI_BATTERY_DIR_NAME "BAT%i" 52#define ACPI_AC_DIR_NAME "AC0" 53 54#define ACPI_SBS_NOTIFY_STATUS 0x80 55#define ACPI_SBS_NOTIFY_INFO 0x81 56 57MODULE_AUTHOR("Alexey Starikovskiy <astarikovskiy@suse.de>"); 58MODULE_DESCRIPTION("Smart Battery System ACPI interface driver"); 59MODULE_LICENSE("GPL"); 60 61static unsigned int cache_time = 1000; 62module_param(cache_time, uint, 0644); 63MODULE_PARM_DESC(cache_time, "cache time in milliseconds"); 64 65static bool sbs_manager_broken; 66 67#define MAX_SBS_BAT 4 68#define ACPI_SBS_BLOCK_MAX 32 69 70static const struct acpi_device_id sbs_device_ids[] = { 71 {"ACPI0002", 0}, 72 {"", 0}, 73}; 74MODULE_DEVICE_TABLE(acpi, sbs_device_ids); 75 76struct acpi_battery { 77 struct power_supply bat; 78 struct acpi_sbs *sbs; 79 unsigned long update_time; 80 char name[8]; 81 char manufacturer_name[ACPI_SBS_BLOCK_MAX]; 82 char device_name[ACPI_SBS_BLOCK_MAX]; 83 char device_chemistry[ACPI_SBS_BLOCK_MAX]; 84 u16 alarm_capacity; 85 u16 full_charge_capacity; 86 u16 design_capacity; 87 u16 design_voltage; 88 u16 serial_number; 89 u16 cycle_count; 90 u16 temp_now; 91 u16 voltage_now; 92 s16 rate_now; 93 s16 rate_avg; 94 u16 capacity_now; 95 u16 state_of_charge; 96 u16 state; 97 u16 mode; 98 u16 spec; 99 u8 id; 100 u8 present:1; 101 u8 have_sysfs_alarm:1; 102}; 103 104#define to_acpi_battery(x) container_of(x, struct acpi_battery, bat) 105 106struct acpi_sbs { 107 struct power_supply charger; 108 struct acpi_device *device; 109 struct acpi_smb_hc *hc; 110 struct mutex lock; 111 struct acpi_battery battery[MAX_SBS_BAT]; 112 u8 batteries_supported:4; 113 u8 manager_present:1; 114 u8 charger_present:1; 115 u8 charger_exists:1; 116}; 117 118#define to_acpi_sbs(x) container_of(x, struct acpi_sbs, charger) 119 120static int acpi_sbs_remove(struct acpi_device *device); 121static int acpi_battery_get_state(struct acpi_battery *battery); 122 123static inline int battery_scale(int log) 124{ 125 int scale = 1; 126 while (log--) 127 scale *= 10; 128 return scale; 129} 130 131static inline int acpi_battery_vscale(struct acpi_battery *battery) 132{ 133 return battery_scale((battery->spec & 0x0f00) >> 8); 134} 135 136static inline int acpi_battery_ipscale(struct acpi_battery *battery) 137{ 138 return battery_scale((battery->spec & 0xf000) >> 12); 139} 140 141static inline int acpi_battery_mode(struct acpi_battery *battery) 142{ 143 return (battery->mode & 0x8000); 144} 145 146static inline int acpi_battery_scale(struct acpi_battery *battery) 147{ 148 return (acpi_battery_mode(battery) ? 10 : 1) * 149 acpi_battery_ipscale(battery); 150} 151 152static int sbs_get_ac_property(struct power_supply *psy, 153 enum power_supply_property psp, 154 union power_supply_propval *val) 155{ 156 struct acpi_sbs *sbs = to_acpi_sbs(psy); 157 switch (psp) { 158 case POWER_SUPPLY_PROP_ONLINE: 159 val->intval = sbs->charger_present; 160 break; 161 default: 162 return -EINVAL; 163 } 164 return 0; 165} 166 167static int acpi_battery_technology(struct acpi_battery *battery) 168{ 169 if (!strcasecmp("NiCd", battery->device_chemistry)) 170 return POWER_SUPPLY_TECHNOLOGY_NiCd; 171 if (!strcasecmp("NiMH", battery->device_chemistry)) 172 return POWER_SUPPLY_TECHNOLOGY_NiMH; 173 if (!strcasecmp("LION", battery->device_chemistry)) 174 return POWER_SUPPLY_TECHNOLOGY_LION; 175 if (!strcasecmp("LiP", battery->device_chemistry)) 176 return POWER_SUPPLY_TECHNOLOGY_LIPO; 177 return POWER_SUPPLY_TECHNOLOGY_UNKNOWN; 178} 179 180static int acpi_sbs_battery_get_property(struct power_supply *psy, 181 enum power_supply_property psp, 182 union power_supply_propval *val) 183{ 184 struct acpi_battery *battery = to_acpi_battery(psy); 185 186 if ((!battery->present) && psp != POWER_SUPPLY_PROP_PRESENT) 187 return -ENODEV; 188 189 acpi_battery_get_state(battery); 190 switch (psp) { 191 case POWER_SUPPLY_PROP_STATUS: 192 if (battery->rate_now < 0) 193 val->intval = POWER_SUPPLY_STATUS_DISCHARGING; 194 else if (battery->rate_now > 0) 195 val->intval = POWER_SUPPLY_STATUS_CHARGING; 196 else 197 val->intval = POWER_SUPPLY_STATUS_FULL; 198 break; 199 case POWER_SUPPLY_PROP_PRESENT: 200 val->intval = battery->present; 201 break; 202 case POWER_SUPPLY_PROP_TECHNOLOGY: 203 val->intval = acpi_battery_technology(battery); 204 break; 205 case POWER_SUPPLY_PROP_CYCLE_COUNT: 206 val->intval = battery->cycle_count; 207 break; 208 case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: 209 val->intval = battery->design_voltage * 210 acpi_battery_vscale(battery) * 1000; 211 break; 212 case POWER_SUPPLY_PROP_VOLTAGE_NOW: 213 val->intval = battery->voltage_now * 214 acpi_battery_vscale(battery) * 1000; 215 break; 216 case POWER_SUPPLY_PROP_CURRENT_NOW: 217 case POWER_SUPPLY_PROP_POWER_NOW: 218 val->intval = abs(battery->rate_now) * 219 acpi_battery_ipscale(battery) * 1000; 220 val->intval *= (acpi_battery_mode(battery)) ? 221 (battery->voltage_now * 222 acpi_battery_vscale(battery) / 1000) : 1; 223 break; 224 case POWER_SUPPLY_PROP_CURRENT_AVG: 225 case POWER_SUPPLY_PROP_POWER_AVG: 226 val->intval = abs(battery->rate_avg) * 227 acpi_battery_ipscale(battery) * 1000; 228 val->intval *= (acpi_battery_mode(battery)) ? 229 (battery->voltage_now * 230 acpi_battery_vscale(battery) / 1000) : 1; 231 break; 232 case POWER_SUPPLY_PROP_CAPACITY: 233 val->intval = battery->state_of_charge; 234 break; 235 case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN: 236 case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN: 237 val->intval = battery->design_capacity * 238 acpi_battery_scale(battery) * 1000; 239 break; 240 case POWER_SUPPLY_PROP_CHARGE_FULL: 241 case POWER_SUPPLY_PROP_ENERGY_FULL: 242 val->intval = battery->full_charge_capacity * 243 acpi_battery_scale(battery) * 1000; 244 break; 245 case POWER_SUPPLY_PROP_CHARGE_NOW: 246 case POWER_SUPPLY_PROP_ENERGY_NOW: 247 val->intval = battery->capacity_now * 248 acpi_battery_scale(battery) * 1000; 249 break; 250 case POWER_SUPPLY_PROP_TEMP: 251 val->intval = battery->temp_now - 2730; // dK -> dC 252 break; 253 case POWER_SUPPLY_PROP_MODEL_NAME: 254 val->strval = battery->device_name; 255 break; 256 case POWER_SUPPLY_PROP_MANUFACTURER: 257 val->strval = battery->manufacturer_name; 258 break; 259 default: 260 return -EINVAL; 261 } 262 return 0; 263} 264 265static enum power_supply_property sbs_ac_props[] = { 266 POWER_SUPPLY_PROP_ONLINE, 267}; 268 269static enum power_supply_property sbs_charge_battery_props[] = { 270 POWER_SUPPLY_PROP_STATUS, 271 POWER_SUPPLY_PROP_PRESENT, 272 POWER_SUPPLY_PROP_TECHNOLOGY, 273 POWER_SUPPLY_PROP_CYCLE_COUNT, 274 POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, 275 POWER_SUPPLY_PROP_VOLTAGE_NOW, 276 POWER_SUPPLY_PROP_CURRENT_NOW, 277 POWER_SUPPLY_PROP_CURRENT_AVG, 278 POWER_SUPPLY_PROP_CAPACITY, 279 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, 280 POWER_SUPPLY_PROP_CHARGE_FULL, 281 POWER_SUPPLY_PROP_CHARGE_NOW, 282 POWER_SUPPLY_PROP_TEMP, 283 POWER_SUPPLY_PROP_MODEL_NAME, 284 POWER_SUPPLY_PROP_MANUFACTURER, 285}; 286 287static enum power_supply_property sbs_energy_battery_props[] = { 288 POWER_SUPPLY_PROP_STATUS, 289 POWER_SUPPLY_PROP_PRESENT, 290 POWER_SUPPLY_PROP_TECHNOLOGY, 291 POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, 292 POWER_SUPPLY_PROP_VOLTAGE_NOW, 293 POWER_SUPPLY_PROP_CURRENT_NOW, 294 POWER_SUPPLY_PROP_CURRENT_AVG, 295 POWER_SUPPLY_PROP_POWER_NOW, 296 POWER_SUPPLY_PROP_POWER_AVG, 297 POWER_SUPPLY_PROP_CAPACITY, 298 POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN, 299 POWER_SUPPLY_PROP_ENERGY_FULL, 300 POWER_SUPPLY_PROP_ENERGY_NOW, 301 POWER_SUPPLY_PROP_TEMP, 302 POWER_SUPPLY_PROP_MODEL_NAME, 303 POWER_SUPPLY_PROP_MANUFACTURER, 304}; 305 306 307/* -------------------------------------------------------------------------- 308 Smart Battery System Management 309 -------------------------------------------------------------------------- */ 310 311struct acpi_battery_reader { 312 u8 command; /* command for battery */ 313 u8 mode; /* word or block? */ 314 size_t offset; /* offset inside struct acpi_sbs_battery */ 315}; 316 317static struct acpi_battery_reader info_readers[] = { 318 {0x01, SMBUS_READ_WORD, offsetof(struct acpi_battery, alarm_capacity)}, 319 {0x03, SMBUS_READ_WORD, offsetof(struct acpi_battery, mode)}, 320 {0x10, SMBUS_READ_WORD, offsetof(struct acpi_battery, full_charge_capacity)}, 321 {0x17, SMBUS_READ_WORD, offsetof(struct acpi_battery, cycle_count)}, 322 {0x18, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_capacity)}, 323 {0x19, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_voltage)}, 324 {0x1a, SMBUS_READ_WORD, offsetof(struct acpi_battery, spec)}, 325 {0x1c, SMBUS_READ_WORD, offsetof(struct acpi_battery, serial_number)}, 326 {0x20, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, manufacturer_name)}, 327 {0x21, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_name)}, 328 {0x22, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_chemistry)}, 329}; 330 331static struct acpi_battery_reader state_readers[] = { 332 {0x08, SMBUS_READ_WORD, offsetof(struct acpi_battery, temp_now)}, 333 {0x09, SMBUS_READ_WORD, offsetof(struct acpi_battery, voltage_now)}, 334 {0x0a, SMBUS_READ_WORD, offsetof(struct acpi_battery, rate_now)}, 335 {0x0b, SMBUS_READ_WORD, offsetof(struct acpi_battery, rate_avg)}, 336 {0x0f, SMBUS_READ_WORD, offsetof(struct acpi_battery, capacity_now)}, 337 {0x0e, SMBUS_READ_WORD, offsetof(struct acpi_battery, state_of_charge)}, 338 {0x16, SMBUS_READ_WORD, offsetof(struct acpi_battery, state)}, 339}; 340 341static int acpi_manager_get_info(struct acpi_sbs *sbs) 342{ 343 int result = 0; 344 u16 battery_system_info; 345 346 result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER, 347 0x04, (u8 *)&battery_system_info); 348 if (!result) 349 sbs->batteries_supported = battery_system_info & 0x000f; 350 return result; 351} 352 353static int acpi_battery_get_info(struct acpi_battery *battery) 354{ 355 int i, result = 0; 356 357 for (i = 0; i < ARRAY_SIZE(info_readers); ++i) { 358 result = acpi_smbus_read(battery->sbs->hc, 359 info_readers[i].mode, 360 ACPI_SBS_BATTERY, 361 info_readers[i].command, 362 (u8 *) battery + 363 info_readers[i].offset); 364 if (result) 365 break; 366 } 367 return result; 368} 369 370static int acpi_battery_get_state(struct acpi_battery *battery) 371{ 372 int i, result = 0; 373 374 if (battery->update_time && 375 time_before(jiffies, battery->update_time + 376 msecs_to_jiffies(cache_time))) 377 return 0; 378 for (i = 0; i < ARRAY_SIZE(state_readers); ++i) { 379 result = acpi_smbus_read(battery->sbs->hc, 380 state_readers[i].mode, 381 ACPI_SBS_BATTERY, 382 state_readers[i].command, 383 (u8 *)battery + 384 state_readers[i].offset); 385 if (result) 386 goto end; 387 } 388 end: 389 battery->update_time = jiffies; 390 return result; 391} 392 393static int acpi_battery_get_alarm(struct acpi_battery *battery) 394{ 395 return acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, 396 ACPI_SBS_BATTERY, 0x01, 397 (u8 *)&battery->alarm_capacity); 398} 399 400static int acpi_battery_set_alarm(struct acpi_battery *battery) 401{ 402 struct acpi_sbs *sbs = battery->sbs; 403 u16 value, sel = 1 << (battery->id + 12); 404 405 int ret; 406 407 408 if (sbs->manager_present) { 409 ret = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER, 410 0x01, (u8 *)&value); 411 if (ret) 412 goto end; 413 if ((value & 0xf000) != sel) { 414 value &= 0x0fff; 415 value |= sel; 416 ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD, 417 ACPI_SBS_MANAGER, 418 0x01, (u8 *)&value, 2); 419 if (ret) 420 goto end; 421 } 422 } 423 ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD, ACPI_SBS_BATTERY, 424 0x01, (u8 *)&battery->alarm_capacity, 2); 425 end: 426 return ret; 427} 428 429static int acpi_ac_get_present(struct acpi_sbs *sbs) 430{ 431 int result; 432 u16 status; 433 434 result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_CHARGER, 435 0x13, (u8 *) & status); 436 437 if (result) 438 return result; 439 440 /* 441 * The spec requires that bit 4 always be 1. If it's not set, assume 442 * that the implementation doesn't support an SBS charger 443 */ 444 if (!((status >> 4) & 0x1)) 445 return -ENODEV; 446 447 sbs->charger_present = (status >> 15) & 0x1; 448 return 0; 449} 450 451static ssize_t acpi_battery_alarm_show(struct device *dev, 452 struct device_attribute *attr, 453 char *buf) 454{ 455 struct acpi_battery *battery = to_acpi_battery(dev_get_drvdata(dev)); 456 acpi_battery_get_alarm(battery); 457 return sprintf(buf, "%d\n", battery->alarm_capacity * 458 acpi_battery_scale(battery) * 1000); 459} 460 461static ssize_t acpi_battery_alarm_store(struct device *dev, 462 struct device_attribute *attr, 463 const char *buf, size_t count) 464{ 465 unsigned long x; 466 struct acpi_battery *battery = to_acpi_battery(dev_get_drvdata(dev)); 467 if (sscanf(buf, "%lu\n", &x) == 1) 468 battery->alarm_capacity = x / 469 (1000 * acpi_battery_scale(battery)); 470 if (battery->present) 471 acpi_battery_set_alarm(battery); 472 return count; 473} 474 475static struct device_attribute alarm_attr = { 476 .attr = {.name = "alarm", .mode = 0644}, 477 .show = acpi_battery_alarm_show, 478 .store = acpi_battery_alarm_store, 479}; 480 481/* -------------------------------------------------------------------------- 482 Driver Interface 483 -------------------------------------------------------------------------- */ 484static int acpi_battery_read(struct acpi_battery *battery) 485{ 486 int result = 0, saved_present = battery->present; 487 u16 state; 488 489 if (battery->sbs->manager_present) { 490 result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, 491 ACPI_SBS_MANAGER, 0x01, (u8 *)&state); 492 if (!result) 493 battery->present = state & (1 << battery->id); 494 state &= 0x0fff; 495 state |= 1 << (battery->id + 12); 496 acpi_smbus_write(battery->sbs->hc, SMBUS_WRITE_WORD, 497 ACPI_SBS_MANAGER, 0x01, (u8 *)&state, 2); 498 } else if (battery->id == 0) 499 battery->present = 1; 500 501 if (result || !battery->present) 502 return result; 503 504 if (saved_present != battery->present) { 505 battery->update_time = 0; 506 result = acpi_battery_get_info(battery); 507 if (result) { 508 battery->present = 0; 509 return result; 510 } 511 } 512 result = acpi_battery_get_state(battery); 513 if (result) 514 battery->present = 0; 515 return result; 516} 517 518/* Smart Battery */ 519static int acpi_battery_add(struct acpi_sbs *sbs, int id) 520{ 521 struct acpi_battery *battery = &sbs->battery[id]; 522 int result; 523 524 battery->id = id; 525 battery->sbs = sbs; 526 result = acpi_battery_read(battery); 527 if (result) 528 return result; 529 530 sprintf(battery->name, ACPI_BATTERY_DIR_NAME, id); 531 battery->bat.name = battery->name; 532 battery->bat.type = POWER_SUPPLY_TYPE_BATTERY; 533 if (!acpi_battery_mode(battery)) { 534 battery->bat.properties = sbs_charge_battery_props; 535 battery->bat.num_properties = 536 ARRAY_SIZE(sbs_charge_battery_props); 537 } else { 538 battery->bat.properties = sbs_energy_battery_props; 539 battery->bat.num_properties = 540 ARRAY_SIZE(sbs_energy_battery_props); 541 } 542 battery->bat.get_property = acpi_sbs_battery_get_property; 543 result = power_supply_register(&sbs->device->dev, &battery->bat); 544 if (result) 545 goto end; 546 547 result = device_create_file(battery->bat.dev, &alarm_attr); 548 if (result) 549 goto end; 550 battery->have_sysfs_alarm = 1; 551 end: 552 printk(KERN_INFO PREFIX "%s [%s]: Battery Slot [%s] (battery %s)\n", 553 ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device), 554 battery->name, battery->present ? "present" : "absent"); 555 return result; 556} 557 558static void acpi_battery_remove(struct acpi_sbs *sbs, int id) 559{ 560 struct acpi_battery *battery = &sbs->battery[id]; 561 562 if (battery->bat.dev) { 563 if (battery->have_sysfs_alarm) 564 device_remove_file(battery->bat.dev, &alarm_attr); 565 power_supply_unregister(&battery->bat); 566 } 567} 568 569static int acpi_charger_add(struct acpi_sbs *sbs) 570{ 571 int result; 572 573 result = acpi_ac_get_present(sbs); 574 if (result) 575 goto end; 576 577 sbs->charger_exists = 1; 578 sbs->charger.name = "sbs-charger"; 579 sbs->charger.type = POWER_SUPPLY_TYPE_MAINS; 580 sbs->charger.properties = sbs_ac_props; 581 sbs->charger.num_properties = ARRAY_SIZE(sbs_ac_props); 582 sbs->charger.get_property = sbs_get_ac_property; 583 power_supply_register(&sbs->device->dev, &sbs->charger); 584 printk(KERN_INFO PREFIX "%s [%s]: AC Adapter [%s] (%s)\n", 585 ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device), 586 ACPI_AC_DIR_NAME, sbs->charger_present ? "on-line" : "off-line"); 587 end: 588 return result; 589} 590 591static void acpi_charger_remove(struct acpi_sbs *sbs) 592{ 593 if (sbs->charger.dev) 594 power_supply_unregister(&sbs->charger); 595} 596 597static void acpi_sbs_callback(void *context) 598{ 599 int id; 600 struct acpi_sbs *sbs = context; 601 struct acpi_battery *bat; 602 u8 saved_charger_state = sbs->charger_present; 603 u8 saved_battery_state; 604 605 if (sbs->charger_exists) { 606 acpi_ac_get_present(sbs); 607 if (sbs->charger_present != saved_charger_state) 608 kobject_uevent(&sbs->charger.dev->kobj, KOBJ_CHANGE); 609 } 610 611 if (sbs->manager_present) { 612 for (id = 0; id < MAX_SBS_BAT; ++id) { 613 if (!(sbs->batteries_supported & (1 << id))) 614 continue; 615 bat = &sbs->battery[id]; 616 saved_battery_state = bat->present; 617 acpi_battery_read(bat); 618 if (saved_battery_state == bat->present) 619 continue; 620 kobject_uevent(&bat->bat.dev->kobj, KOBJ_CHANGE); 621 } 622 } 623} 624 625static int disable_sbs_manager(const struct dmi_system_id *d) 626{ 627 sbs_manager_broken = true; 628 return 0; 629} 630 631static struct dmi_system_id acpi_sbs_dmi_table[] = { 632 { 633 .callback = disable_sbs_manager, 634 .ident = "Apple", 635 .matches = { 636 DMI_MATCH(DMI_SYS_VENDOR, "Apple Inc.") 637 }, 638 }, 639 { }, 640}; 641 642static int acpi_sbs_add(struct acpi_device *device) 643{ 644 struct acpi_sbs *sbs; 645 int result = 0; 646 int id; 647 648 dmi_check_system(acpi_sbs_dmi_table); 649 650 sbs = kzalloc(sizeof(struct acpi_sbs), GFP_KERNEL); 651 if (!sbs) { 652 result = -ENOMEM; 653 goto end; 654 } 655 656 mutex_init(&sbs->lock); 657 658 sbs->hc = acpi_driver_data(device->parent); 659 sbs->device = device; 660 strcpy(acpi_device_name(device), ACPI_SBS_DEVICE_NAME); 661 strcpy(acpi_device_class(device), ACPI_SBS_CLASS); 662 device->driver_data = sbs; 663 664 result = acpi_charger_add(sbs); 665 if (result && result != -ENODEV) 666 goto end; 667 668 result = 0; 669 670 if (!sbs_manager_broken) { 671 result = acpi_manager_get_info(sbs); 672 if (!result) { 673 sbs->manager_present = 0; 674 for (id = 0; id < MAX_SBS_BAT; ++id) 675 if ((sbs->batteries_supported & (1 << id))) 676 acpi_battery_add(sbs, id); 677 } 678 } 679 680 if (!sbs->manager_present) 681 acpi_battery_add(sbs, 0); 682 683 acpi_smbus_register_callback(sbs->hc, acpi_sbs_callback, sbs); 684 end: 685 if (result) 686 acpi_sbs_remove(device); 687 return result; 688} 689 690static int acpi_sbs_remove(struct acpi_device *device) 691{ 692 struct acpi_sbs *sbs; 693 int id; 694 695 if (!device) 696 return -EINVAL; 697 sbs = acpi_driver_data(device); 698 if (!sbs) 699 return -EINVAL; 700 mutex_lock(&sbs->lock); 701 acpi_smbus_unregister_callback(sbs->hc); 702 for (id = 0; id < MAX_SBS_BAT; ++id) 703 acpi_battery_remove(sbs, id); 704 acpi_charger_remove(sbs); 705 mutex_unlock(&sbs->lock); 706 mutex_destroy(&sbs->lock); 707 kfree(sbs); 708 return 0; 709} 710 711#ifdef CONFIG_PM_SLEEP 712static int acpi_sbs_resume(struct device *dev) 713{ 714 struct acpi_sbs *sbs; 715 if (!dev) 716 return -EINVAL; 717 sbs = to_acpi_device(dev)->driver_data; 718 acpi_sbs_callback(sbs); 719 return 0; 720} 721#else 722#define acpi_sbs_resume NULL 723#endif 724 725static SIMPLE_DEV_PM_OPS(acpi_sbs_pm, NULL, acpi_sbs_resume); 726 727static struct acpi_driver acpi_sbs_driver = { 728 .name = "sbs", 729 .class = ACPI_SBS_CLASS, 730 .ids = sbs_device_ids, 731 .ops = { 732 .add = acpi_sbs_add, 733 .remove = acpi_sbs_remove, 734 }, 735 .drv.pm = &acpi_sbs_pm, 736}; 737 738static int __init acpi_sbs_init(void) 739{ 740 int result = 0; 741 742 if (acpi_disabled) 743 return -ENODEV; 744 745 result = acpi_bus_register_driver(&acpi_sbs_driver); 746 if (result < 0) 747 return -ENODEV; 748 749 return 0; 750} 751 752static void __exit acpi_sbs_exit(void) 753{ 754 acpi_bus_unregister_driver(&acpi_sbs_driver); 755 return; 756} 757 758module_init(acpi_sbs_init); 759module_exit(acpi_sbs_exit); 760