sbs.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707
  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. #include <linux/init.h>
  27. #include <linux/slab.h>
  28. #include <linux/module.h>
  29. #include <linux/moduleparam.h>
  30. #include <linux/kernel.h>
  31. #include <linux/acpi.h>
  32. #include <linux/timer.h>
  33. #include <linux/jiffies.h>
  34. #include <linux/delay.h>
  35. #include <linux/power_supply.h>
  36. #include "sbshc.h"
  37. #define PREFIX "ACPI: "
  38. #define ACPI_SBS_CLASS "sbs"
  39. #define ACPI_AC_CLASS "ac_adapter"
  40. #define ACPI_BATTERY_CLASS "battery"
  41. #define ACPI_SBS_DEVICE_NAME "Smart Battery System"
  42. #define ACPI_SBS_FILE_INFO "info"
  43. #define ACPI_SBS_FILE_STATE "state"
  44. #define ACPI_SBS_FILE_ALARM "alarm"
  45. #define ACPI_BATTERY_DIR_NAME "BAT%i"
  46. #define ACPI_AC_DIR_NAME "AC0"
  47. #define ACPI_SBS_NOTIFY_STATUS 0x80
  48. #define ACPI_SBS_NOTIFY_INFO 0x81
  49. MODULE_AUTHOR("Alexey Starikovskiy <astarikovskiy@suse.de>");
  50. MODULE_DESCRIPTION("Smart Battery System ACPI interface driver");
  51. MODULE_LICENSE("GPL");
  52. static unsigned int cache_time = 1000;
  53. module_param(cache_time, uint, 0644);
  54. MODULE_PARM_DESC(cache_time, "cache time in milliseconds");
  55. #define MAX_SBS_BAT 4
  56. #define ACPI_SBS_BLOCK_MAX 32
  57. static const struct acpi_device_id sbs_device_ids[] = {
  58. {"ACPI0002", 0},
  59. {"", 0},
  60. };
  61. MODULE_DEVICE_TABLE(acpi, sbs_device_ids);
  62. struct acpi_battery {
  63. struct power_supply bat;
  64. struct acpi_sbs *sbs;
  65. unsigned long update_time;
  66. char name[8];
  67. char manufacturer_name[ACPI_SBS_BLOCK_MAX];
  68. char device_name[ACPI_SBS_BLOCK_MAX];
  69. char device_chemistry[ACPI_SBS_BLOCK_MAX];
  70. u16 alarm_capacity;
  71. u16 full_charge_capacity;
  72. u16 design_capacity;
  73. u16 design_voltage;
  74. u16 serial_number;
  75. u16 cycle_count;
  76. u16 temp_now;
  77. u16 voltage_now;
  78. s16 rate_now;
  79. s16 rate_avg;
  80. u16 capacity_now;
  81. u16 state_of_charge;
  82. u16 state;
  83. u16 mode;
  84. u16 spec;
  85. u8 id;
  86. u8 present:1;
  87. u8 have_sysfs_alarm:1;
  88. };
  89. #define to_acpi_battery(x) container_of(x, struct acpi_battery, bat)
  90. struct acpi_sbs {
  91. struct power_supply charger;
  92. struct acpi_device *device;
  93. struct acpi_smb_hc *hc;
  94. struct mutex lock;
  95. struct acpi_battery battery[MAX_SBS_BAT];
  96. u8 batteries_supported:4;
  97. u8 manager_present:1;
  98. u8 charger_present:1;
  99. };
  100. #define to_acpi_sbs(x) container_of(x, struct acpi_sbs, charger)
  101. static int acpi_sbs_remove(struct acpi_device *device);
  102. static int acpi_battery_get_state(struct acpi_battery *battery);
  103. static inline int battery_scale(int log)
  104. {
  105. int scale = 1;
  106. while (log--)
  107. scale *= 10;
  108. return scale;
  109. }
  110. static inline int acpi_battery_vscale(struct acpi_battery *battery)
  111. {
  112. return battery_scale((battery->spec & 0x0f00) >> 8);
  113. }
  114. static inline int acpi_battery_ipscale(struct acpi_battery *battery)
  115. {
  116. return battery_scale((battery->spec & 0xf000) >> 12);
  117. }
  118. static inline int acpi_battery_mode(struct acpi_battery *battery)
  119. {
  120. return (battery->mode & 0x8000);
  121. }
  122. static inline int acpi_battery_scale(struct acpi_battery *battery)
  123. {
  124. return (acpi_battery_mode(battery) ? 10 : 1) *
  125. acpi_battery_ipscale(battery);
  126. }
  127. static int sbs_get_ac_property(struct power_supply *psy,
  128. enum power_supply_property psp,
  129. union power_supply_propval *val)
  130. {
  131. struct acpi_sbs *sbs = to_acpi_sbs(psy);
  132. switch (psp) {
  133. case POWER_SUPPLY_PROP_ONLINE:
  134. val->intval = sbs->charger_present;
  135. break;
  136. default:
  137. return -EINVAL;
  138. }
  139. return 0;
  140. }
  141. static int acpi_battery_technology(struct acpi_battery *battery)
  142. {
  143. if (!strcasecmp("NiCd", battery->device_chemistry))
  144. return POWER_SUPPLY_TECHNOLOGY_NiCd;
  145. if (!strcasecmp("NiMH", battery->device_chemistry))
  146. return POWER_SUPPLY_TECHNOLOGY_NiMH;
  147. if (!strcasecmp("LION", battery->device_chemistry))
  148. return POWER_SUPPLY_TECHNOLOGY_LION;
  149. if (!strcasecmp("LiP", battery->device_chemistry))
  150. return POWER_SUPPLY_TECHNOLOGY_LIPO;
  151. return POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
  152. }
  153. static int acpi_sbs_battery_get_property(struct power_supply *psy,
  154. enum power_supply_property psp,
  155. union power_supply_propval *val)
  156. {
  157. struct acpi_battery *battery = to_acpi_battery(psy);
  158. if ((!battery->present) && psp != POWER_SUPPLY_PROP_PRESENT)
  159. return -ENODEV;
  160. acpi_battery_get_state(battery);
  161. switch (psp) {
  162. case POWER_SUPPLY_PROP_STATUS:
  163. if (battery->rate_now < 0)
  164. val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  165. else if (battery->rate_now > 0)
  166. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  167. else
  168. val->intval = POWER_SUPPLY_STATUS_FULL;
  169. break;
  170. case POWER_SUPPLY_PROP_PRESENT:
  171. val->intval = battery->present;
  172. break;
  173. case POWER_SUPPLY_PROP_TECHNOLOGY:
  174. val->intval = acpi_battery_technology(battery);
  175. break;
  176. case POWER_SUPPLY_PROP_CYCLE_COUNT:
  177. val->intval = battery->cycle_count;
  178. break;
  179. case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
  180. val->intval = battery->design_voltage *
  181. acpi_battery_vscale(battery) * 1000;
  182. break;
  183. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  184. val->intval = battery->voltage_now *
  185. acpi_battery_vscale(battery) * 1000;
  186. break;
  187. case POWER_SUPPLY_PROP_CURRENT_NOW:
  188. case POWER_SUPPLY_PROP_POWER_NOW:
  189. val->intval = abs(battery->rate_now) *
  190. acpi_battery_ipscale(battery) * 1000;
  191. val->intval *= (acpi_battery_mode(battery)) ?
  192. (battery->voltage_now *
  193. acpi_battery_vscale(battery) / 1000) : 1;
  194. break;
  195. case POWER_SUPPLY_PROP_CURRENT_AVG:
  196. case POWER_SUPPLY_PROP_POWER_AVG:
  197. val->intval = abs(battery->rate_avg) *
  198. acpi_battery_ipscale(battery) * 1000;
  199. val->intval *= (acpi_battery_mode(battery)) ?
  200. (battery->voltage_now *
  201. acpi_battery_vscale(battery) / 1000) : 1;
  202. break;
  203. case POWER_SUPPLY_PROP_CAPACITY:
  204. val->intval = battery->state_of_charge;
  205. break;
  206. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  207. case POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN:
  208. val->intval = battery->design_capacity *
  209. acpi_battery_scale(battery) * 1000;
  210. break;
  211. case POWER_SUPPLY_PROP_CHARGE_FULL:
  212. case POWER_SUPPLY_PROP_ENERGY_FULL:
  213. val->intval = battery->full_charge_capacity *
  214. acpi_battery_scale(battery) * 1000;
  215. break;
  216. case POWER_SUPPLY_PROP_CHARGE_NOW:
  217. case POWER_SUPPLY_PROP_ENERGY_NOW:
  218. val->intval = battery->capacity_now *
  219. acpi_battery_scale(battery) * 1000;
  220. break;
  221. case POWER_SUPPLY_PROP_TEMP:
  222. val->intval = battery->temp_now - 2730; // dK -> dC
  223. break;
  224. case POWER_SUPPLY_PROP_MODEL_NAME:
  225. val->strval = battery->device_name;
  226. break;
  227. case POWER_SUPPLY_PROP_MANUFACTURER:
  228. val->strval = battery->manufacturer_name;
  229. break;
  230. default:
  231. return -EINVAL;
  232. }
  233. return 0;
  234. }
  235. static enum power_supply_property sbs_ac_props[] = {
  236. POWER_SUPPLY_PROP_ONLINE,
  237. };
  238. static enum power_supply_property sbs_charge_battery_props[] = {
  239. POWER_SUPPLY_PROP_STATUS,
  240. POWER_SUPPLY_PROP_PRESENT,
  241. POWER_SUPPLY_PROP_TECHNOLOGY,
  242. POWER_SUPPLY_PROP_CYCLE_COUNT,
  243. POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
  244. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  245. POWER_SUPPLY_PROP_CURRENT_NOW,
  246. POWER_SUPPLY_PROP_CURRENT_AVG,
  247. POWER_SUPPLY_PROP_CAPACITY,
  248. POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
  249. POWER_SUPPLY_PROP_CHARGE_FULL,
  250. POWER_SUPPLY_PROP_CHARGE_NOW,
  251. POWER_SUPPLY_PROP_TEMP,
  252. POWER_SUPPLY_PROP_MODEL_NAME,
  253. POWER_SUPPLY_PROP_MANUFACTURER,
  254. };
  255. static enum power_supply_property sbs_energy_battery_props[] = {
  256. POWER_SUPPLY_PROP_STATUS,
  257. POWER_SUPPLY_PROP_PRESENT,
  258. POWER_SUPPLY_PROP_TECHNOLOGY,
  259. POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
  260. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  261. POWER_SUPPLY_PROP_CURRENT_NOW,
  262. POWER_SUPPLY_PROP_CURRENT_AVG,
  263. POWER_SUPPLY_PROP_POWER_NOW,
  264. POWER_SUPPLY_PROP_POWER_AVG,
  265. POWER_SUPPLY_PROP_CAPACITY,
  266. POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN,
  267. POWER_SUPPLY_PROP_ENERGY_FULL,
  268. POWER_SUPPLY_PROP_ENERGY_NOW,
  269. POWER_SUPPLY_PROP_TEMP,
  270. POWER_SUPPLY_PROP_MODEL_NAME,
  271. POWER_SUPPLY_PROP_MANUFACTURER,
  272. };
  273. /* --------------------------------------------------------------------------
  274. Smart Battery System Management
  275. -------------------------------------------------------------------------- */
  276. struct acpi_battery_reader {
  277. u8 command; /* command for battery */
  278. u8 mode; /* word or block? */
  279. size_t offset; /* offset inside struct acpi_sbs_battery */
  280. };
  281. static struct acpi_battery_reader info_readers[] = {
  282. {0x01, SMBUS_READ_WORD, offsetof(struct acpi_battery, alarm_capacity)},
  283. {0x03, SMBUS_READ_WORD, offsetof(struct acpi_battery, mode)},
  284. {0x10, SMBUS_READ_WORD, offsetof(struct acpi_battery, full_charge_capacity)},
  285. {0x17, SMBUS_READ_WORD, offsetof(struct acpi_battery, cycle_count)},
  286. {0x18, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_capacity)},
  287. {0x19, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_voltage)},
  288. {0x1a, SMBUS_READ_WORD, offsetof(struct acpi_battery, spec)},
  289. {0x1c, SMBUS_READ_WORD, offsetof(struct acpi_battery, serial_number)},
  290. {0x20, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, manufacturer_name)},
  291. {0x21, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_name)},
  292. {0x22, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_chemistry)},
  293. };
  294. static struct acpi_battery_reader state_readers[] = {
  295. {0x08, SMBUS_READ_WORD, offsetof(struct acpi_battery, temp_now)},
  296. {0x09, SMBUS_READ_WORD, offsetof(struct acpi_battery, voltage_now)},
  297. {0x0a, SMBUS_READ_WORD, offsetof(struct acpi_battery, rate_now)},
  298. {0x0b, SMBUS_READ_WORD, offsetof(struct acpi_battery, rate_avg)},
  299. {0x0f, SMBUS_READ_WORD, offsetof(struct acpi_battery, capacity_now)},
  300. {0x0e, SMBUS_READ_WORD, offsetof(struct acpi_battery, state_of_charge)},
  301. {0x16, SMBUS_READ_WORD, offsetof(struct acpi_battery, state)},
  302. };
  303. static int acpi_manager_get_info(struct acpi_sbs *sbs)
  304. {
  305. int result = 0;
  306. u16 battery_system_info;
  307. result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER,
  308. 0x04, (u8 *)&battery_system_info);
  309. if (!result)
  310. sbs->batteries_supported = battery_system_info & 0x000f;
  311. return result;
  312. }
  313. static int acpi_battery_get_info(struct acpi_battery *battery)
  314. {
  315. int i, result = 0;
  316. for (i = 0; i < ARRAY_SIZE(info_readers); ++i) {
  317. result = acpi_smbus_read(battery->sbs->hc,
  318. info_readers[i].mode,
  319. ACPI_SBS_BATTERY,
  320. info_readers[i].command,
  321. (u8 *) battery +
  322. info_readers[i].offset);
  323. if (result)
  324. break;
  325. }
  326. return result;
  327. }
  328. static int acpi_battery_get_state(struct acpi_battery *battery)
  329. {
  330. int i, result = 0;
  331. if (battery->update_time &&
  332. time_before(jiffies, battery->update_time +
  333. msecs_to_jiffies(cache_time)))
  334. return 0;
  335. for (i = 0; i < ARRAY_SIZE(state_readers); ++i) {
  336. result = acpi_smbus_read(battery->sbs->hc,
  337. state_readers[i].mode,
  338. ACPI_SBS_BATTERY,
  339. state_readers[i].command,
  340. (u8 *)battery +
  341. state_readers[i].offset);
  342. if (result)
  343. goto end;
  344. }
  345. end:
  346. battery->update_time = jiffies;
  347. return result;
  348. }
  349. static int acpi_battery_get_alarm(struct acpi_battery *battery)
  350. {
  351. return acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD,
  352. ACPI_SBS_BATTERY, 0x01,
  353. (u8 *)&battery->alarm_capacity);
  354. }
  355. static int acpi_battery_set_alarm(struct acpi_battery *battery)
  356. {
  357. struct acpi_sbs *sbs = battery->sbs;
  358. u16 value, sel = 1 << (battery->id + 12);
  359. int ret;
  360. if (sbs->manager_present) {
  361. ret = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER,
  362. 0x01, (u8 *)&value);
  363. if (ret)
  364. goto end;
  365. if ((value & 0xf000) != sel) {
  366. value &= 0x0fff;
  367. value |= sel;
  368. ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD,
  369. ACPI_SBS_MANAGER,
  370. 0x01, (u8 *)&value, 2);
  371. if (ret)
  372. goto end;
  373. }
  374. }
  375. ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD, ACPI_SBS_BATTERY,
  376. 0x01, (u8 *)&battery->alarm_capacity, 2);
  377. end:
  378. return ret;
  379. }
  380. static int acpi_ac_get_present(struct acpi_sbs *sbs)
  381. {
  382. int result;
  383. u16 status;
  384. result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_CHARGER,
  385. 0x13, (u8 *) & status);
  386. if (!result)
  387. sbs->charger_present = (status >> 15) & 0x1;
  388. return result;
  389. }
  390. static ssize_t acpi_battery_alarm_show(struct device *dev,
  391. struct device_attribute *attr,
  392. char *buf)
  393. {
  394. struct acpi_battery *battery = to_acpi_battery(dev_get_drvdata(dev));
  395. acpi_battery_get_alarm(battery);
  396. return sprintf(buf, "%d\n", battery->alarm_capacity *
  397. acpi_battery_scale(battery) * 1000);
  398. }
  399. static ssize_t acpi_battery_alarm_store(struct device *dev,
  400. struct device_attribute *attr,
  401. const char *buf, size_t count)
  402. {
  403. unsigned long x;
  404. struct acpi_battery *battery = to_acpi_battery(dev_get_drvdata(dev));
  405. if (sscanf(buf, "%ld\n", &x) == 1)
  406. battery->alarm_capacity = x /
  407. (1000 * acpi_battery_scale(battery));
  408. if (battery->present)
  409. acpi_battery_set_alarm(battery);
  410. return count;
  411. }
  412. static struct device_attribute alarm_attr = {
  413. .attr = {.name = "alarm", .mode = 0644},
  414. .show = acpi_battery_alarm_show,
  415. .store = acpi_battery_alarm_store,
  416. };
  417. /* --------------------------------------------------------------------------
  418. Driver Interface
  419. -------------------------------------------------------------------------- */
  420. static int acpi_battery_read(struct acpi_battery *battery)
  421. {
  422. int result = 0, saved_present = battery->present;
  423. u16 state;
  424. if (battery->sbs->manager_present) {
  425. result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD,
  426. ACPI_SBS_MANAGER, 0x01, (u8 *)&state);
  427. if (!result)
  428. battery->present = state & (1 << battery->id);
  429. state &= 0x0fff;
  430. state |= 1 << (battery->id + 12);
  431. acpi_smbus_write(battery->sbs->hc, SMBUS_WRITE_WORD,
  432. ACPI_SBS_MANAGER, 0x01, (u8 *)&state, 2);
  433. } else if (battery->id == 0)
  434. battery->present = 1;
  435. if (result || !battery->present)
  436. return result;
  437. if (saved_present != battery->present) {
  438. battery->update_time = 0;
  439. result = acpi_battery_get_info(battery);
  440. if (result)
  441. return result;
  442. }
  443. result = acpi_battery_get_state(battery);
  444. return result;
  445. }
  446. /* Smart Battery */
  447. static int acpi_battery_add(struct acpi_sbs *sbs, int id)
  448. {
  449. struct acpi_battery *battery = &sbs->battery[id];
  450. int result;
  451. battery->id = id;
  452. battery->sbs = sbs;
  453. result = acpi_battery_read(battery);
  454. if (result)
  455. return result;
  456. sprintf(battery->name, ACPI_BATTERY_DIR_NAME, id);
  457. battery->bat.name = battery->name;
  458. battery->bat.type = POWER_SUPPLY_TYPE_BATTERY;
  459. if (!acpi_battery_mode(battery)) {
  460. battery->bat.properties = sbs_charge_battery_props;
  461. battery->bat.num_properties =
  462. ARRAY_SIZE(sbs_charge_battery_props);
  463. } else {
  464. battery->bat.properties = sbs_energy_battery_props;
  465. battery->bat.num_properties =
  466. ARRAY_SIZE(sbs_energy_battery_props);
  467. }
  468. battery->bat.get_property = acpi_sbs_battery_get_property;
  469. result = power_supply_register(&sbs->device->dev, &battery->bat);
  470. if (result)
  471. goto end;
  472. result = device_create_file(battery->bat.dev, &alarm_attr);
  473. if (result)
  474. goto end;
  475. battery->have_sysfs_alarm = 1;
  476. end:
  477. printk(KERN_INFO PREFIX "%s [%s]: Battery Slot [%s] (battery %s)\n",
  478. ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device),
  479. battery->name, battery->present ? "present" : "absent");
  480. return result;
  481. }
  482. static void acpi_battery_remove(struct acpi_sbs *sbs, int id)
  483. {
  484. struct acpi_battery *battery = &sbs->battery[id];
  485. if (battery->bat.dev) {
  486. if (battery->have_sysfs_alarm)
  487. device_remove_file(battery->bat.dev, &alarm_attr);
  488. power_supply_unregister(&battery->bat);
  489. }
  490. }
  491. static int acpi_charger_add(struct acpi_sbs *sbs)
  492. {
  493. int result;
  494. result = acpi_ac_get_present(sbs);
  495. if (result)
  496. goto end;
  497. sbs->charger.name = "sbs-charger";
  498. sbs->charger.type = POWER_SUPPLY_TYPE_MAINS;
  499. sbs->charger.properties = sbs_ac_props;
  500. sbs->charger.num_properties = ARRAY_SIZE(sbs_ac_props);
  501. sbs->charger.get_property = sbs_get_ac_property;
  502. power_supply_register(&sbs->device->dev, &sbs->charger);
  503. printk(KERN_INFO PREFIX "%s [%s]: AC Adapter [%s] (%s)\n",
  504. ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device),
  505. ACPI_AC_DIR_NAME, sbs->charger_present ? "on-line" : "off-line");
  506. end:
  507. return result;
  508. }
  509. static void acpi_charger_remove(struct acpi_sbs *sbs)
  510. {
  511. if (sbs->charger.dev)
  512. power_supply_unregister(&sbs->charger);
  513. }
  514. static void acpi_sbs_callback(void *context)
  515. {
  516. int id;
  517. struct acpi_sbs *sbs = context;
  518. struct acpi_battery *bat;
  519. u8 saved_charger_state = sbs->charger_present;
  520. u8 saved_battery_state;
  521. acpi_ac_get_present(sbs);
  522. if (sbs->charger_present != saved_charger_state)
  523. kobject_uevent(&sbs->charger.dev->kobj, KOBJ_CHANGE);
  524. if (sbs->manager_present) {
  525. for (id = 0; id < MAX_SBS_BAT; ++id) {
  526. if (!(sbs->batteries_supported & (1 << id)))
  527. continue;
  528. bat = &sbs->battery[id];
  529. saved_battery_state = bat->present;
  530. acpi_battery_read(bat);
  531. if (saved_battery_state == bat->present)
  532. continue;
  533. kobject_uevent(&bat->bat.dev->kobj, KOBJ_CHANGE);
  534. }
  535. }
  536. }
  537. static int acpi_sbs_add(struct acpi_device *device)
  538. {
  539. struct acpi_sbs *sbs;
  540. int result = 0;
  541. int id;
  542. sbs = kzalloc(sizeof(struct acpi_sbs), GFP_KERNEL);
  543. if (!sbs) {
  544. result = -ENOMEM;
  545. goto end;
  546. }
  547. mutex_init(&sbs->lock);
  548. sbs->hc = acpi_driver_data(device->parent);
  549. sbs->device = device;
  550. strcpy(acpi_device_name(device), ACPI_SBS_DEVICE_NAME);
  551. strcpy(acpi_device_class(device), ACPI_SBS_CLASS);
  552. device->driver_data = sbs;
  553. result = acpi_charger_add(sbs);
  554. if (result)
  555. goto end;
  556. result = acpi_manager_get_info(sbs);
  557. if (!result) {
  558. sbs->manager_present = 1;
  559. for (id = 0; id < MAX_SBS_BAT; ++id)
  560. if ((sbs->batteries_supported & (1 << id)))
  561. acpi_battery_add(sbs, id);
  562. } else
  563. acpi_battery_add(sbs, 0);
  564. acpi_smbus_register_callback(sbs->hc, acpi_sbs_callback, sbs);
  565. end:
  566. if (result)
  567. acpi_sbs_remove(device);
  568. return result;
  569. }
  570. static int acpi_sbs_remove(struct acpi_device *device)
  571. {
  572. struct acpi_sbs *sbs;
  573. int id;
  574. if (!device)
  575. return -EINVAL;
  576. sbs = acpi_driver_data(device);
  577. if (!sbs)
  578. return -EINVAL;
  579. mutex_lock(&sbs->lock);
  580. acpi_smbus_unregister_callback(sbs->hc);
  581. for (id = 0; id < MAX_SBS_BAT; ++id)
  582. acpi_battery_remove(sbs, id);
  583. acpi_charger_remove(sbs);
  584. mutex_unlock(&sbs->lock);
  585. mutex_destroy(&sbs->lock);
  586. kfree(sbs);
  587. return 0;
  588. }
  589. #ifdef CONFIG_PM_SLEEP
  590. static int acpi_sbs_resume(struct device *dev)
  591. {
  592. struct acpi_sbs *sbs;
  593. if (!dev)
  594. return -EINVAL;
  595. sbs = to_acpi_device(dev)->driver_data;
  596. acpi_sbs_callback(sbs);
  597. return 0;
  598. }
  599. #endif
  600. static SIMPLE_DEV_PM_OPS(acpi_sbs_pm, NULL, acpi_sbs_resume);
  601. static struct acpi_driver acpi_sbs_driver = {
  602. .name = "sbs",
  603. .class = ACPI_SBS_CLASS,
  604. .ids = sbs_device_ids,
  605. .ops = {
  606. .add = acpi_sbs_add,
  607. .remove = acpi_sbs_remove,
  608. },
  609. .drv.pm = &acpi_sbs_pm,
  610. };
  611. static int __init acpi_sbs_init(void)
  612. {
  613. int result = 0;
  614. if (acpi_disabled)
  615. return -ENODEV;
  616. result = acpi_bus_register_driver(&acpi_sbs_driver);
  617. if (result < 0)
  618. return -ENODEV;
  619. return 0;
  620. }
  621. static void __exit acpi_sbs_exit(void)
  622. {
  623. acpi_bus_unregister_driver(&acpi_sbs_driver);
  624. return;
  625. }
  626. module_init(acpi_sbs_init);
  627. module_exit(acpi_sbs_exit);