battery.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784
  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. static int acpi_battery_add(struct acpi_device *device);
  55. static int acpi_battery_remove(struct acpi_device *device, int type);
  56. static struct acpi_driver acpi_battery_driver = {
  57. .name = ACPI_BATTERY_DRIVER_NAME,
  58. .class = ACPI_BATTERY_CLASS,
  59. .ids = ACPI_BATTERY_HID,
  60. .ops = {
  61. .add = acpi_battery_add,
  62. .remove = acpi_battery_remove,
  63. },
  64. };
  65. struct acpi_battery_status {
  66. acpi_integer state;
  67. acpi_integer present_rate;
  68. acpi_integer remaining_capacity;
  69. acpi_integer present_voltage;
  70. };
  71. struct acpi_battery_info {
  72. acpi_integer power_unit;
  73. acpi_integer design_capacity;
  74. acpi_integer last_full_capacity;
  75. acpi_integer battery_technology;
  76. acpi_integer design_voltage;
  77. acpi_integer design_capacity_warning;
  78. acpi_integer design_capacity_low;
  79. acpi_integer battery_capacity_granularity_1;
  80. acpi_integer battery_capacity_granularity_2;
  81. acpi_string model_number;
  82. acpi_string serial_number;
  83. acpi_string battery_type;
  84. acpi_string oem_info;
  85. };
  86. struct acpi_battery_flags {
  87. u8 present:1; /* Bay occupied? */
  88. u8 power_unit:1; /* 0=watts, 1=apms */
  89. u8 alarm:1; /* _BTP present? */
  90. u8 reserved:5;
  91. };
  92. struct acpi_battery_trips {
  93. unsigned long warning;
  94. unsigned long low;
  95. };
  96. struct acpi_battery {
  97. acpi_handle handle;
  98. struct acpi_battery_flags flags;
  99. struct acpi_battery_trips trips;
  100. unsigned long alarm;
  101. struct acpi_battery_info *info;
  102. };
  103. /* --------------------------------------------------------------------------
  104. Battery Management
  105. -------------------------------------------------------------------------- */
  106. static int
  107. acpi_battery_get_info(struct acpi_battery *battery,
  108. struct acpi_battery_info **bif)
  109. {
  110. int result = 0;
  111. acpi_status status = 0;
  112. struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
  113. struct acpi_buffer format = { sizeof(ACPI_BATTERY_FORMAT_BIF),
  114. ACPI_BATTERY_FORMAT_BIF
  115. };
  116. struct acpi_buffer data = { 0, NULL };
  117. union acpi_object *package = NULL;
  118. if (!battery || !bif)
  119. return -EINVAL;
  120. /* Evalute _BIF */
  121. status = acpi_evaluate_object(battery->handle, "_BIF", NULL, &buffer);
  122. if (ACPI_FAILURE(status)) {
  123. ACPI_EXCEPTION((AE_INFO, status, "Evaluating _BIF"));
  124. return -ENODEV;
  125. }
  126. package = (union acpi_object *)buffer.pointer;
  127. /* Extract Package Data */
  128. status = acpi_extract_package(package, &format, &data);
  129. if (status != AE_BUFFER_OVERFLOW) {
  130. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BIF"));
  131. result = -ENODEV;
  132. goto end;
  133. }
  134. data.pointer = kmalloc(data.length, GFP_KERNEL);
  135. if (!data.pointer) {
  136. result = -ENOMEM;
  137. goto end;
  138. }
  139. memset(data.pointer, 0, data.length);
  140. status = acpi_extract_package(package, &format, &data);
  141. if (ACPI_FAILURE(status)) {
  142. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BIF"));
  143. kfree(data.pointer);
  144. result = -ENODEV;
  145. goto end;
  146. }
  147. end:
  148. kfree(buffer.pointer);
  149. if (!result)
  150. (*bif) = (struct acpi_battery_info *)data.pointer;
  151. return result;
  152. }
  153. static int
  154. acpi_battery_get_status(struct acpi_battery *battery,
  155. struct acpi_battery_status **bst)
  156. {
  157. int result = 0;
  158. acpi_status status = 0;
  159. struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
  160. struct acpi_buffer format = { sizeof(ACPI_BATTERY_FORMAT_BST),
  161. ACPI_BATTERY_FORMAT_BST
  162. };
  163. struct acpi_buffer data = { 0, NULL };
  164. union acpi_object *package = NULL;
  165. if (!battery || !bst)
  166. return -EINVAL;
  167. /* Evalute _BST */
  168. status = acpi_evaluate_object(battery->handle, "_BST", NULL, &buffer);
  169. if (ACPI_FAILURE(status)) {
  170. ACPI_EXCEPTION((AE_INFO, status, "Evaluating _BST"));
  171. return -ENODEV;
  172. }
  173. package = (union acpi_object *)buffer.pointer;
  174. /* Extract Package Data */
  175. status = acpi_extract_package(package, &format, &data);
  176. if (status != AE_BUFFER_OVERFLOW) {
  177. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BST"));
  178. result = -ENODEV;
  179. goto end;
  180. }
  181. data.pointer = kmalloc(data.length, GFP_KERNEL);
  182. if (!data.pointer) {
  183. result = -ENOMEM;
  184. goto end;
  185. }
  186. memset(data.pointer, 0, data.length);
  187. status = acpi_extract_package(package, &format, &data);
  188. if (ACPI_FAILURE(status)) {
  189. ACPI_EXCEPTION((AE_INFO, status, "Extracting _BST"));
  190. kfree(data.pointer);
  191. result = -ENODEV;
  192. goto end;
  193. }
  194. end:
  195. kfree(buffer.pointer);
  196. if (!result)
  197. (*bst) = (struct acpi_battery_status *)data.pointer;
  198. return result;
  199. }
  200. static int
  201. acpi_battery_set_alarm(struct acpi_battery *battery, unsigned long alarm)
  202. {
  203. acpi_status status = 0;
  204. union acpi_object arg0 = { ACPI_TYPE_INTEGER };
  205. struct acpi_object_list arg_list = { 1, &arg0 };
  206. if (!battery)
  207. return -EINVAL;
  208. if (!battery->flags.alarm)
  209. return -ENODEV;
  210. arg0.integer.value = alarm;
  211. status = acpi_evaluate_object(battery->handle, "_BTP", &arg_list, NULL);
  212. if (ACPI_FAILURE(status))
  213. return -ENODEV;
  214. ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Alarm set to %d\n", (u32) alarm));
  215. battery->alarm = alarm;
  216. return 0;
  217. }
  218. static int acpi_battery_check(struct acpi_battery *battery)
  219. {
  220. int result = 0;
  221. acpi_status status = AE_OK;
  222. acpi_handle handle = NULL;
  223. struct acpi_device *device = NULL;
  224. struct acpi_battery_info *bif = NULL;
  225. if (!battery)
  226. return -EINVAL;
  227. result = acpi_bus_get_device(battery->handle, &device);
  228. if (result)
  229. return result;
  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->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 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 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 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. if (acpi_bus_get_device(handle, &device))
  530. return;
  531. switch (event) {
  532. case ACPI_BATTERY_NOTIFY_STATUS:
  533. case ACPI_BATTERY_NOTIFY_INFO:
  534. acpi_battery_check(battery);
  535. acpi_bus_generate_event(device, event, battery->flags.present);
  536. break;
  537. default:
  538. ACPI_DEBUG_PRINT((ACPI_DB_INFO,
  539. "Unsupported event [0x%x]\n", event));
  540. break;
  541. }
  542. return;
  543. }
  544. static int acpi_battery_add(struct acpi_device *device)
  545. {
  546. int result = 0;
  547. acpi_status status = 0;
  548. struct acpi_battery *battery = NULL;
  549. if (!device)
  550. return -EINVAL;
  551. battery = kmalloc(sizeof(struct acpi_battery), GFP_KERNEL);
  552. if (!battery)
  553. return -ENOMEM;
  554. memset(battery, 0, sizeof(struct acpi_battery));
  555. battery->handle = device->handle;
  556. strcpy(acpi_device_name(device), ACPI_BATTERY_DEVICE_NAME);
  557. strcpy(acpi_device_class(device), ACPI_BATTERY_CLASS);
  558. acpi_driver_data(device) = battery;
  559. result = acpi_battery_check(battery);
  560. if (result)
  561. goto end;
  562. result = acpi_battery_add_fs(device);
  563. if (result)
  564. goto end;
  565. status = acpi_install_notify_handler(battery->handle,
  566. ACPI_DEVICE_NOTIFY,
  567. acpi_battery_notify, battery);
  568. if (ACPI_FAILURE(status)) {
  569. result = -ENODEV;
  570. goto end;
  571. }
  572. printk(KERN_INFO PREFIX "%s Slot [%s] (battery %s)\n",
  573. ACPI_BATTERY_DEVICE_NAME, acpi_device_bid(device),
  574. device->status.battery_present ? "present" : "absent");
  575. end:
  576. if (result) {
  577. acpi_battery_remove_fs(device);
  578. kfree(battery);
  579. }
  580. return result;
  581. }
  582. static int acpi_battery_remove(struct acpi_device *device, int type)
  583. {
  584. acpi_status status = 0;
  585. struct acpi_battery *battery = NULL;
  586. if (!device || !acpi_driver_data(device))
  587. return -EINVAL;
  588. battery = (struct acpi_battery *)acpi_driver_data(device);
  589. status = acpi_remove_notify_handler(battery->handle,
  590. ACPI_DEVICE_NOTIFY,
  591. acpi_battery_notify);
  592. acpi_battery_remove_fs(device);
  593. kfree(battery);
  594. return 0;
  595. }
  596. static int __init acpi_battery_init(void)
  597. {
  598. int result = 0;
  599. acpi_battery_dir = proc_mkdir(ACPI_BATTERY_CLASS, acpi_root_dir);
  600. if (!acpi_battery_dir)
  601. return -ENODEV;
  602. acpi_battery_dir->owner = THIS_MODULE;
  603. result = acpi_bus_register_driver(&acpi_battery_driver);
  604. if (result < 0) {
  605. remove_proc_entry(ACPI_BATTERY_CLASS, acpi_root_dir);
  606. return -ENODEV;
  607. }
  608. return 0;
  609. }
  610. static void __exit acpi_battery_exit(void)
  611. {
  612. acpi_bus_unregister_driver(&acpi_battery_driver);
  613. remove_proc_entry(ACPI_BATTERY_CLASS, acpi_root_dir);
  614. return;
  615. }
  616. module_init(acpi_battery_init);
  617. module_exit(acpi_battery_exit);