battery.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787
  1. /*
  2. * acpi_battery.c - ACPI Battery Driver ($Revision: 37 $)
  3. *
  4. * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
  5. * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
  6. *
  7. * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or (at
  12. * your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful, but
  15. * WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  17. * General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License along
  20. * with this program; if not, write to the Free Software Foundation, Inc.,
  21. * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  22. *
  23. * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  24. */
  25. #include <linux/kernel.h>
  26. #include <linux/module.h>
  27. #include <linux/init.h>
  28. #include <linux/types.h>
  29. #include <linux/proc_fs.h>
  30. #include <linux/seq_file.h>
  31. #include <asm/uaccess.h>
  32. #include <acpi/acpi_bus.h>
  33. #include <acpi/acpi_drivers.h>
  34. #define ACPI_BATTERY_VALUE_UNKNOWN 0xFFFFFFFF
  35. #define ACPI_BATTERY_FORMAT_BIF "NNNNNNNNNSSSS"
  36. #define ACPI_BATTERY_FORMAT_BST "NNNN"
  37. #define ACPI_BATTERY_COMPONENT 0x00040000
  38. #define ACPI_BATTERY_CLASS "battery"
  39. #define ACPI_BATTERY_HID "PNP0C0A"
  40. #define ACPI_BATTERY_DRIVER_NAME "ACPI Battery Driver"
  41. #define ACPI_BATTERY_DEVICE_NAME "Battery"
  42. #define ACPI_BATTERY_FILE_INFO "info"
  43. #define ACPI_BATTERY_FILE_STATUS "state"
  44. #define ACPI_BATTERY_FILE_ALARM "alarm"
  45. #define ACPI_BATTERY_NOTIFY_STATUS 0x80
  46. #define ACPI_BATTERY_NOTIFY_INFO 0x81
  47. #define ACPI_BATTERY_UNITS_WATTS "mW"
  48. #define ACPI_BATTERY_UNITS_AMPS "mA"
  49. #define _COMPONENT ACPI_BATTERY_COMPONENT
  50. ACPI_MODULE_NAME("acpi_battery")
  51. MODULE_AUTHOR("Paul Diefenbaugh");
  52. MODULE_DESCRIPTION(ACPI_BATTERY_DRIVER_NAME);
  53. MODULE_LICENSE("GPL");
  54. extern struct proc_dir_entry *acpi_lock_battery_dir(void);
  55. extern void *acpi_unlock_battery_dir(struct proc_dir_entry *acpi_battery_dir);
  56. static int acpi_battery_add(struct acpi_device *device);
  57. static int acpi_battery_remove(struct acpi_device *device, int type);
  58. static struct acpi_driver acpi_battery_driver = {
  59. .name = ACPI_BATTERY_DRIVER_NAME,
  60. .class = ACPI_BATTERY_CLASS,
  61. .ids = ACPI_BATTERY_HID,
  62. .ops = {
  63. .add = acpi_battery_add,
  64. .remove = acpi_battery_remove,
  65. },
  66. };
  67. struct acpi_battery_status {
  68. acpi_integer state;
  69. acpi_integer present_rate;
  70. acpi_integer remaining_capacity;
  71. acpi_integer present_voltage;
  72. };
  73. struct acpi_battery_info {
  74. acpi_integer power_unit;
  75. acpi_integer design_capacity;
  76. acpi_integer last_full_capacity;
  77. acpi_integer battery_technology;
  78. acpi_integer design_voltage;
  79. acpi_integer design_capacity_warning;
  80. acpi_integer design_capacity_low;
  81. acpi_integer battery_capacity_granularity_1;
  82. acpi_integer battery_capacity_granularity_2;
  83. acpi_string model_number;
  84. acpi_string serial_number;
  85. acpi_string battery_type;
  86. acpi_string oem_info;
  87. };
  88. struct acpi_battery_flags {
  89. u8 present:1; /* Bay occupied? */
  90. u8 power_unit:1; /* 0=watts, 1=apms */
  91. u8 alarm:1; /* _BTP present? */
  92. u8 reserved:5;
  93. };
  94. struct acpi_battery_trips {
  95. unsigned long warning;
  96. unsigned long low;
  97. };
  98. struct acpi_battery {
  99. struct acpi_device * device;
  100. struct acpi_battery_flags flags;
  101. struct acpi_battery_trips trips;
  102. unsigned long alarm;
  103. struct acpi_battery_info *info;
  104. };
  105. /* --------------------------------------------------------------------------
  106. Battery Management
  107. -------------------------------------------------------------------------- */
  108. static int
  109. acpi_battery_get_info(struct acpi_battery *battery,
  110. struct acpi_battery_info **bif)
  111. {
  112. int result = 0;
  113. acpi_status status = 0;
  114. struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
  115. struct acpi_buffer format = { sizeof(ACPI_BATTERY_FORMAT_BIF),
  116. ACPI_BATTERY_FORMAT_BIF
  117. };
  118. struct acpi_buffer data = { 0, NULL };
  119. union acpi_object *package = NULL;
  120. if (!battery || !bif)
  121. return -EINVAL;
  122. /* Evalute _BIF */
  123. status = acpi_evaluate_object(battery->device->handle, "_BIF", NULL, &buffer);
  124. if (ACPI_FAILURE(status)) {
  125. ACPI_EXCEPTION((AE_INFO, status, "Evaluating _BIF"));
  126. return -ENODEV;
  127. }
  128. package = (union acpi_object *)buffer.pointer;
  129. /* Extract Package Data */
  130. status = acpi_extract_package(package, &format, &data);
  131. if (status != AE_BUFFER_OVERFLOW) {
  132. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BIF"));
  133. result = -ENODEV;
  134. goto end;
  135. }
  136. data.pointer = kmalloc(data.length, GFP_KERNEL);
  137. if (!data.pointer) {
  138. result = -ENOMEM;
  139. goto end;
  140. }
  141. memset(data.pointer, 0, data.length);
  142. status = acpi_extract_package(package, &format, &data);
  143. if (ACPI_FAILURE(status)) {
  144. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BIF"));
  145. kfree(data.pointer);
  146. result = -ENODEV;
  147. goto end;
  148. }
  149. end:
  150. kfree(buffer.pointer);
  151. if (!result)
  152. (*bif) = (struct acpi_battery_info *)data.pointer;
  153. return result;
  154. }
  155. static int
  156. acpi_battery_get_status(struct acpi_battery *battery,
  157. struct acpi_battery_status **bst)
  158. {
  159. int result = 0;
  160. acpi_status status = 0;
  161. struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
  162. struct acpi_buffer format = { sizeof(ACPI_BATTERY_FORMAT_BST),
  163. ACPI_BATTERY_FORMAT_BST
  164. };
  165. struct acpi_buffer data = { 0, NULL };
  166. union acpi_object *package = NULL;
  167. if (!battery || !bst)
  168. return -EINVAL;
  169. /* Evalute _BST */
  170. status = acpi_evaluate_object(battery->device->handle, "_BST", NULL, &buffer);
  171. if (ACPI_FAILURE(status)) {
  172. ACPI_EXCEPTION((AE_INFO, status, "Evaluating _BST"));
  173. return -ENODEV;
  174. }
  175. package = (union acpi_object *)buffer.pointer;
  176. /* Extract Package Data */
  177. status = acpi_extract_package(package, &format, &data);
  178. if (status != AE_BUFFER_OVERFLOW) {
  179. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BST"));
  180. result = -ENODEV;
  181. goto end;
  182. }
  183. data.pointer = kmalloc(data.length, GFP_KERNEL);
  184. if (!data.pointer) {
  185. result = -ENOMEM;
  186. goto end;
  187. }
  188. memset(data.pointer, 0, data.length);
  189. status = acpi_extract_package(package, &format, &data);
  190. if (ACPI_FAILURE(status)) {
  191. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BST"));
  192. kfree(data.pointer);
  193. result = -ENODEV;
  194. goto end;
  195. }
  196. end:
  197. kfree(buffer.pointer);
  198. if (!result)
  199. (*bst) = (struct acpi_battery_status *)data.pointer;
  200. return result;
  201. }
  202. static int
  203. acpi_battery_set_alarm(struct acpi_battery *battery, unsigned long alarm)
  204. {
  205. acpi_status status = 0;
  206. union acpi_object arg0 = { ACPI_TYPE_INTEGER };
  207. struct acpi_object_list arg_list = { 1, &arg0 };
  208. if (!battery)
  209. return -EINVAL;
  210. if (!battery->flags.alarm)
  211. return -ENODEV;
  212. arg0.integer.value = alarm;
  213. status = acpi_evaluate_object(battery->device->handle, "_BTP", &arg_list, NULL);
  214. if (ACPI_FAILURE(status))
  215. return -ENODEV;
  216. ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Alarm set to %d\n", (u32) alarm));
  217. battery->alarm = alarm;
  218. return 0;
  219. }
  220. static int acpi_battery_check(struct acpi_battery *battery)
  221. {
  222. int result = 0;
  223. acpi_status status = AE_OK;
  224. acpi_handle handle = NULL;
  225. struct acpi_device *device = NULL;
  226. struct acpi_battery_info *bif = NULL;
  227. if (!battery)
  228. return -EINVAL;
  229. device = battery->device;
  230. result = acpi_bus_get_status(device);
  231. if (result)
  232. return result;
  233. /* Insertion? */
  234. if (!battery->flags.present && device->status.battery_present) {
  235. ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Battery inserted\n"));
  236. /* Evalute _BIF to get certain static information */
  237. result = acpi_battery_get_info(battery, &bif);
  238. if (result)
  239. return result;
  240. battery->flags.power_unit = bif->power_unit;
  241. battery->trips.warning = bif->design_capacity_warning;
  242. battery->trips.low = bif->design_capacity_low;
  243. kfree(bif);
  244. /* See if alarms are supported, and if so, set default */
  245. status = acpi_get_handle(battery->device->handle, "_BTP", &handle);
  246. if (ACPI_SUCCESS(status)) {
  247. battery->flags.alarm = 1;
  248. acpi_battery_set_alarm(battery, battery->trips.warning);
  249. }
  250. }
  251. /* Removal? */
  252. else if (battery->flags.present && !device->status.battery_present) {
  253. ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Battery removed\n"));
  254. }
  255. battery->flags.present = device->status.battery_present;
  256. return result;
  257. }
  258. /* --------------------------------------------------------------------------
  259. FS Interface (/proc)
  260. -------------------------------------------------------------------------- */
  261. static struct proc_dir_entry *acpi_battery_dir;
  262. static int acpi_battery_read_info(struct seq_file *seq, void *offset)
  263. {
  264. int result = 0;
  265. struct acpi_battery *battery = (struct acpi_battery *)seq->private;
  266. struct acpi_battery_info *bif = NULL;
  267. char *units = "?";
  268. if (!battery)
  269. goto end;
  270. if (battery->flags.present)
  271. seq_printf(seq, "present: yes\n");
  272. else {
  273. seq_printf(seq, "present: no\n");
  274. goto end;
  275. }
  276. /* Battery Info (_BIF) */
  277. result = acpi_battery_get_info(battery, &bif);
  278. if (result || !bif) {
  279. seq_printf(seq, "ERROR: Unable to read battery information\n");
  280. goto end;
  281. }
  282. units =
  283. bif->
  284. power_unit ? ACPI_BATTERY_UNITS_AMPS : ACPI_BATTERY_UNITS_WATTS;
  285. if (bif->design_capacity == ACPI_BATTERY_VALUE_UNKNOWN)
  286. seq_printf(seq, "design capacity: unknown\n");
  287. else
  288. seq_printf(seq, "design capacity: %d %sh\n",
  289. (u32) bif->design_capacity, units);
  290. if (bif->last_full_capacity == ACPI_BATTERY_VALUE_UNKNOWN)
  291. seq_printf(seq, "last full capacity: unknown\n");
  292. else
  293. seq_printf(seq, "last full capacity: %d %sh\n",
  294. (u32) bif->last_full_capacity, units);
  295. switch ((u32) bif->battery_technology) {
  296. case 0:
  297. seq_printf(seq, "battery technology: non-rechargeable\n");
  298. break;
  299. case 1:
  300. seq_printf(seq, "battery technology: rechargeable\n");
  301. break;
  302. default:
  303. seq_printf(seq, "battery technology: unknown\n");
  304. break;
  305. }
  306. if (bif->design_voltage == ACPI_BATTERY_VALUE_UNKNOWN)
  307. seq_printf(seq, "design voltage: unknown\n");
  308. else
  309. seq_printf(seq, "design voltage: %d mV\n",
  310. (u32) bif->design_voltage);
  311. seq_printf(seq, "design capacity warning: %d %sh\n",
  312. (u32) bif->design_capacity_warning, units);
  313. seq_printf(seq, "design capacity low: %d %sh\n",
  314. (u32) bif->design_capacity_low, units);
  315. seq_printf(seq, "capacity granularity 1: %d %sh\n",
  316. (u32) bif->battery_capacity_granularity_1, units);
  317. seq_printf(seq, "capacity granularity 2: %d %sh\n",
  318. (u32) bif->battery_capacity_granularity_2, units);
  319. seq_printf(seq, "model number: %s\n", bif->model_number);
  320. seq_printf(seq, "serial number: %s\n", bif->serial_number);
  321. seq_printf(seq, "battery type: %s\n", bif->battery_type);
  322. seq_printf(seq, "OEM info: %s\n", bif->oem_info);
  323. end:
  324. kfree(bif);
  325. return 0;
  326. }
  327. static int acpi_battery_info_open_fs(struct inode *inode, struct file *file)
  328. {
  329. return single_open(file, acpi_battery_read_info, PDE(inode)->data);
  330. }
  331. static int acpi_battery_read_state(struct seq_file *seq, void *offset)
  332. {
  333. int result = 0;
  334. struct acpi_battery *battery = (struct acpi_battery *)seq->private;
  335. struct acpi_battery_status *bst = NULL;
  336. char *units = "?";
  337. if (!battery)
  338. goto end;
  339. if (battery->flags.present)
  340. seq_printf(seq, "present: yes\n");
  341. else {
  342. seq_printf(seq, "present: no\n");
  343. goto end;
  344. }
  345. /* Battery Units */
  346. units =
  347. battery->flags.
  348. power_unit ? ACPI_BATTERY_UNITS_AMPS : ACPI_BATTERY_UNITS_WATTS;
  349. /* Battery Status (_BST) */
  350. result = acpi_battery_get_status(battery, &bst);
  351. if (result || !bst) {
  352. seq_printf(seq, "ERROR: Unable to read battery status\n");
  353. goto end;
  354. }
  355. if (!(bst->state & 0x04))
  356. seq_printf(seq, "capacity state: ok\n");
  357. else
  358. seq_printf(seq, "capacity state: critical\n");
  359. if ((bst->state & 0x01) && (bst->state & 0x02)) {
  360. seq_printf(seq,
  361. "charging state: charging/discharging\n");
  362. } else if (bst->state & 0x01)
  363. seq_printf(seq, "charging state: discharging\n");
  364. else if (bst->state & 0x02)
  365. seq_printf(seq, "charging state: charging\n");
  366. else {
  367. seq_printf(seq, "charging state: charged\n");
  368. }
  369. if (bst->present_rate == ACPI_BATTERY_VALUE_UNKNOWN)
  370. seq_printf(seq, "present rate: unknown\n");
  371. else
  372. seq_printf(seq, "present rate: %d %s\n",
  373. (u32) bst->present_rate, units);
  374. if (bst->remaining_capacity == ACPI_BATTERY_VALUE_UNKNOWN)
  375. seq_printf(seq, "remaining capacity: unknown\n");
  376. else
  377. seq_printf(seq, "remaining capacity: %d %sh\n",
  378. (u32) bst->remaining_capacity, units);
  379. if (bst->present_voltage == ACPI_BATTERY_VALUE_UNKNOWN)
  380. seq_printf(seq, "present voltage: unknown\n");
  381. else
  382. seq_printf(seq, "present voltage: %d mV\n",
  383. (u32) bst->present_voltage);
  384. end:
  385. kfree(bst);
  386. return 0;
  387. }
  388. static int acpi_battery_state_open_fs(struct inode *inode, struct file *file)
  389. {
  390. return single_open(file, acpi_battery_read_state, PDE(inode)->data);
  391. }
  392. static int acpi_battery_read_alarm(struct seq_file *seq, void *offset)
  393. {
  394. struct acpi_battery *battery = (struct acpi_battery *)seq->private;
  395. char *units = "?";
  396. if (!battery)
  397. goto end;
  398. if (!battery->flags.present) {
  399. seq_printf(seq, "present: no\n");
  400. goto end;
  401. }
  402. /* Battery Units */
  403. units =
  404. battery->flags.
  405. power_unit ? ACPI_BATTERY_UNITS_AMPS : ACPI_BATTERY_UNITS_WATTS;
  406. /* Battery Alarm */
  407. seq_printf(seq, "alarm: ");
  408. if (!battery->alarm)
  409. seq_printf(seq, "unsupported\n");
  410. else
  411. seq_printf(seq, "%d %sh\n", (u32) battery->alarm, units);
  412. end:
  413. return 0;
  414. }
  415. static ssize_t
  416. acpi_battery_write_alarm(struct file *file,
  417. const char __user * buffer,
  418. size_t count, loff_t * ppos)
  419. {
  420. int result = 0;
  421. char alarm_string[12] = { '\0' };
  422. struct seq_file *m = (struct seq_file *)file->private_data;
  423. struct acpi_battery *battery = (struct acpi_battery *)m->private;
  424. if (!battery || (count > sizeof(alarm_string) - 1))
  425. return -EINVAL;
  426. if (!battery->flags.present)
  427. return -ENODEV;
  428. if (copy_from_user(alarm_string, buffer, count))
  429. return -EFAULT;
  430. alarm_string[count] = '\0';
  431. result = acpi_battery_set_alarm(battery,
  432. simple_strtoul(alarm_string, NULL, 0));
  433. if (result)
  434. return result;
  435. return count;
  436. }
  437. static int acpi_battery_alarm_open_fs(struct inode *inode, struct file *file)
  438. {
  439. return single_open(file, acpi_battery_read_alarm, PDE(inode)->data);
  440. }
  441. static const struct file_operations acpi_battery_info_ops = {
  442. .open = acpi_battery_info_open_fs,
  443. .read = seq_read,
  444. .llseek = seq_lseek,
  445. .release = single_release,
  446. .owner = THIS_MODULE,
  447. };
  448. static const struct file_operations acpi_battery_state_ops = {
  449. .open = acpi_battery_state_open_fs,
  450. .read = seq_read,
  451. .llseek = seq_lseek,
  452. .release = single_release,
  453. .owner = THIS_MODULE,
  454. };
  455. static const struct file_operations acpi_battery_alarm_ops = {
  456. .open = acpi_battery_alarm_open_fs,
  457. .read = seq_read,
  458. .write = acpi_battery_write_alarm,
  459. .llseek = seq_lseek,
  460. .release = single_release,
  461. .owner = THIS_MODULE,
  462. };
  463. static int acpi_battery_add_fs(struct acpi_device *device)
  464. {
  465. struct proc_dir_entry *entry = NULL;
  466. if (!acpi_device_dir(device)) {
  467. acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
  468. acpi_battery_dir);
  469. if (!acpi_device_dir(device))
  470. return -ENODEV;
  471. acpi_device_dir(device)->owner = THIS_MODULE;
  472. }
  473. /* 'info' [R] */
  474. entry = create_proc_entry(ACPI_BATTERY_FILE_INFO,
  475. S_IRUGO, acpi_device_dir(device));
  476. if (!entry)
  477. return -ENODEV;
  478. else {
  479. entry->proc_fops = &acpi_battery_info_ops;
  480. entry->data = acpi_driver_data(device);
  481. entry->owner = THIS_MODULE;
  482. }
  483. /* 'status' [R] */
  484. entry = create_proc_entry(ACPI_BATTERY_FILE_STATUS,
  485. S_IRUGO, acpi_device_dir(device));
  486. if (!entry)
  487. return -ENODEV;
  488. else {
  489. entry->proc_fops = &acpi_battery_state_ops;
  490. entry->data = acpi_driver_data(device);
  491. entry->owner = THIS_MODULE;
  492. }
  493. /* 'alarm' [R/W] */
  494. entry = create_proc_entry(ACPI_BATTERY_FILE_ALARM,
  495. S_IFREG | S_IRUGO | S_IWUSR,
  496. acpi_device_dir(device));
  497. if (!entry)
  498. return -ENODEV;
  499. else {
  500. entry->proc_fops = &acpi_battery_alarm_ops;
  501. entry->data = acpi_driver_data(device);
  502. entry->owner = THIS_MODULE;
  503. }
  504. return 0;
  505. }
  506. static int acpi_battery_remove_fs(struct acpi_device *device)
  507. {
  508. if (acpi_device_dir(device)) {
  509. remove_proc_entry(ACPI_BATTERY_FILE_ALARM,
  510. acpi_device_dir(device));
  511. remove_proc_entry(ACPI_BATTERY_FILE_STATUS,
  512. acpi_device_dir(device));
  513. remove_proc_entry(ACPI_BATTERY_FILE_INFO,
  514. acpi_device_dir(device));
  515. remove_proc_entry(acpi_device_bid(device), acpi_battery_dir);
  516. acpi_device_dir(device) = NULL;
  517. }
  518. return 0;
  519. }
  520. /* --------------------------------------------------------------------------
  521. Driver Interface
  522. -------------------------------------------------------------------------- */
  523. static void acpi_battery_notify(acpi_handle handle, u32 event, void *data)
  524. {
  525. struct acpi_battery *battery = (struct acpi_battery *)data;
  526. struct acpi_device *device = NULL;
  527. if (!battery)
  528. return;
  529. device = battery->device;
  530. switch (event) {
  531. case ACPI_BATTERY_NOTIFY_STATUS:
  532. case ACPI_BATTERY_NOTIFY_INFO:
  533. case ACPI_NOTIFY_BUS_CHECK:
  534. case ACPI_NOTIFY_DEVICE_CHECK:
  535. acpi_battery_check(battery);
  536. acpi_bus_generate_event(device, event, battery->flags.present);
  537. break;
  538. default:
  539. ACPI_DEBUG_PRINT((ACPI_DB_INFO,
  540. "Unsupported event [0x%x]\n", event));
  541. break;
  542. }
  543. return;
  544. }
  545. static int acpi_battery_add(struct acpi_device *device)
  546. {
  547. int result = 0;
  548. acpi_status status = 0;
  549. struct acpi_battery *battery = NULL;
  550. if (!device)
  551. return -EINVAL;
  552. battery = kmalloc(sizeof(struct acpi_battery), GFP_KERNEL);
  553. if (!battery)
  554. return -ENOMEM;
  555. memset(battery, 0, sizeof(struct acpi_battery));
  556. battery->device = device;
  557. strcpy(acpi_device_name(device), ACPI_BATTERY_DEVICE_NAME);
  558. strcpy(acpi_device_class(device), ACPI_BATTERY_CLASS);
  559. acpi_driver_data(device) = battery;
  560. result = acpi_battery_check(battery);
  561. if (result)
  562. goto end;
  563. result = acpi_battery_add_fs(device);
  564. if (result)
  565. goto end;
  566. status = acpi_install_notify_handler(device->handle,
  567. ACPI_ALL_NOTIFY,
  568. acpi_battery_notify, battery);
  569. if (ACPI_FAILURE(status)) {
  570. result = -ENODEV;
  571. goto end;
  572. }
  573. printk(KERN_INFO PREFIX "%s Slot [%s] (battery %s)\n",
  574. ACPI_BATTERY_DEVICE_NAME, acpi_device_bid(device),
  575. device->status.battery_present ? "present" : "absent");
  576. end:
  577. if (result) {
  578. acpi_battery_remove_fs(device);
  579. kfree(battery);
  580. }
  581. return result;
  582. }
  583. static int acpi_battery_remove(struct acpi_device *device, int type)
  584. {
  585. acpi_status status = 0;
  586. struct acpi_battery *battery = NULL;
  587. if (!device || !acpi_driver_data(device))
  588. return -EINVAL;
  589. battery = (struct acpi_battery *)acpi_driver_data(device);
  590. status = acpi_remove_notify_handler(device->handle,
  591. ACPI_ALL_NOTIFY,
  592. acpi_battery_notify);
  593. acpi_battery_remove_fs(device);
  594. kfree(battery);
  595. return 0;
  596. }
  597. static int __init acpi_battery_init(void)
  598. {
  599. int result;
  600. if (acpi_disabled)
  601. return -ENODEV;
  602. acpi_battery_dir = acpi_lock_battery_dir();
  603. if (!acpi_battery_dir)
  604. return -ENODEV;
  605. result = acpi_bus_register_driver(&acpi_battery_driver);
  606. if (result < 0) {
  607. acpi_unlock_battery_dir(acpi_battery_dir);
  608. return -ENODEV;
  609. }
  610. return 0;
  611. }
  612. static void __exit acpi_battery_exit(void)
  613. {
  614. acpi_bus_unregister_driver(&acpi_battery_driver);
  615. acpi_unlock_battery_dir(acpi_battery_dir);
  616. return;
  617. }
  618. module_init(acpi_battery_init);
  619. module_exit(acpi_battery_exit);