Commit | Line | Data |
---|---|---|
3f86b832 | 1 | /* |
db1c291a | 2 | * sbs.c - ACPI Smart Battery System Driver ($Revision: 2.0 $) |
3f86b832 | 3 | * |
db1c291a AS |
4 | * Copyright (c) 2007 Alexey Starikovskiy <astarikovskiy@suse.de> |
5 | * Copyright (c) 2005-2007 Vladimir Lebedev <vladimir.p.lebedev@intel.com> | |
3f86b832 RT |
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/module.h> | |
29 | #include <linux/moduleparam.h> | |
30 | #include <linux/kernel.h> | |
94f6c086 | 31 | |
66e4b72b | 32 | #ifdef CONFIG_ACPI_PROCFS |
3f86b832 RT |
33 | #include <linux/proc_fs.h> |
34 | #include <linux/seq_file.h> | |
35 | #include <asm/uaccess.h> | |
66e4b72b | 36 | #endif |
94f6c086 | 37 | |
3f86b832 | 38 | #include <linux/acpi.h> |
6d15702c | 39 | #include <linux/timer.h> |
72206233 | 40 | #include <linux/jiffies.h> |
3f86b832 RT |
41 | #include <linux/delay.h> |
42 | ||
94f6c086 AS |
43 | #include <linux/power_supply.h> |
44 | ||
91087dfa AS |
45 | #include "sbshc.h" |
46 | ||
3f86b832 RT |
47 | #define ACPI_SBS_CLASS "sbs" |
48 | #define ACPI_AC_CLASS "ac_adapter" | |
49 | #define ACPI_BATTERY_CLASS "battery" | |
3f86b832 RT |
50 | #define ACPI_SBS_DEVICE_NAME "Smart Battery System" |
51 | #define ACPI_SBS_FILE_INFO "info" | |
52 | #define ACPI_SBS_FILE_STATE "state" | |
53 | #define ACPI_SBS_FILE_ALARM "alarm" | |
54 | #define ACPI_BATTERY_DIR_NAME "BAT%i" | |
55 | #define ACPI_AC_DIR_NAME "AC0" | |
3f86b832 | 56 | |
db1c291a AS |
57 | enum acpi_sbs_device_addr { |
58 | ACPI_SBS_CHARGER = 0x9, | |
59 | ACPI_SBS_MANAGER = 0xa, | |
60 | ACPI_SBS_BATTERY = 0xb, | |
61 | }; | |
62 | ||
63 | #define ACPI_SBS_NOTIFY_STATUS 0x80 | |
64 | #define ACPI_SBS_NOTIFY_INFO 0x81 | |
3f86b832 | 65 | |
db1c291a | 66 | MODULE_AUTHOR("Alexey Starikovskiy <astarikovskiy@suse.de>"); |
3f86b832 RT |
67 | MODULE_DESCRIPTION("Smart Battery System ACPI interface driver"); |
68 | MODULE_LICENSE("GPL"); | |
69 | ||
db1c291a AS |
70 | static unsigned int cache_time = 1000; |
71 | module_param(cache_time, uint, 0644); | |
72 | MODULE_PARM_DESC(cache_time, "cache time in milliseconds"); | |
6d15702c VL |
73 | |
74 | extern struct proc_dir_entry *acpi_lock_ac_dir(void); | |
75 | extern struct proc_dir_entry *acpi_lock_battery_dir(void); | |
76 | extern void acpi_unlock_ac_dir(struct proc_dir_entry *acpi_ac_dir); | |
77 | extern void acpi_unlock_battery_dir(struct proc_dir_entry *acpi_battery_dir); | |
78 | ||
db1c291a | 79 | #define MAX_SBS_BAT 4 |
6d15702c VL |
80 | #define ACPI_SBS_BLOCK_MAX 32 |
81 | ||
1ba90e3a | 82 | static const struct acpi_device_id sbs_device_ids[] = { |
91087dfa | 83 | {"ACPI0002", 0}, |
1ba90e3a TR |
84 | {"", 0}, |
85 | }; | |
86 | MODULE_DEVICE_TABLE(acpi, sbs_device_ids); | |
87 | ||
3f86b832 | 88 | struct acpi_battery { |
94f6c086 | 89 | struct power_supply bat; |
3f86b832 | 90 | struct acpi_sbs *sbs; |
66e4b72b | 91 | #ifdef CONFIG_ACPI_PROCFS |
89862e3b | 92 | struct proc_dir_entry *proc_entry; |
66e4b72b | 93 | #endif |
db1c291a AS |
94 | unsigned long update_time; |
95 | char name[8]; | |
89862e3b AS |
96 | char manufacturer_name[ACPI_SBS_BLOCK_MAX]; |
97 | char device_name[ACPI_SBS_BLOCK_MAX]; | |
98 | char device_chemistry[ACPI_SBS_BLOCK_MAX]; | |
94f6c086 | 99 | u16 alarm_capacity; |
89862e3b AS |
100 | u16 full_charge_capacity; |
101 | u16 design_capacity; | |
102 | u16 design_voltage; | |
103 | u16 serial_number; | |
db1c291a AS |
104 | u16 cycle_count; |
105 | u16 temp_now; | |
89862e3b AS |
106 | u16 voltage_now; |
107 | s16 current_now; | |
db1c291a | 108 | s16 current_avg; |
89862e3b | 109 | u16 capacity_now; |
db1c291a | 110 | u16 state_of_charge; |
89862e3b | 111 | u16 state; |
89862e3b | 112 | u16 mode; |
db1c291a | 113 | u16 spec; |
89862e3b | 114 | u8 id; |
89862e3b | 115 | u8 present:1; |
3f86b832 RT |
116 | }; |
117 | ||
94f6c086 AS |
118 | #define to_acpi_battery(x) container_of(x, struct acpi_battery, bat); |
119 | ||
3f86b832 | 120 | struct acpi_sbs { |
94f6c086 | 121 | struct power_supply charger; |
3f86b832 | 122 | struct acpi_device *device; |
91087dfa | 123 | struct acpi_smb_hc *hc; |
db1c291a | 124 | struct mutex lock; |
66e4b72b | 125 | #ifdef CONFIG_ACPI_PROCFS |
db1c291a | 126 | struct proc_dir_entry *charger_entry; |
66e4b72b | 127 | #endif |
3f86b832 | 128 | struct acpi_battery battery[MAX_SBS_BAT]; |
db1c291a | 129 | u8 batteries_supported:4; |
89862e3b AS |
130 | u8 manager_present:1; |
131 | u8 charger_present:1; | |
3f86b832 RT |
132 | }; |
133 | ||
94f6c086 AS |
134 | #define to_acpi_sbs(x) container_of(x, struct acpi_sbs, charger) |
135 | ||
db1c291a | 136 | static inline int battery_scale(int log) |
72206233 | 137 | { |
db1c291a AS |
138 | int scale = 1; |
139 | while (log--) | |
140 | scale *= 10; | |
141 | return scale; | |
72206233 VL |
142 | } |
143 | ||
db1c291a | 144 | static inline int acpi_battery_vscale(struct acpi_battery *battery) |
72206233 | 145 | { |
db1c291a | 146 | return battery_scale((battery->spec & 0x0f00) >> 8); |
72206233 VL |
147 | } |
148 | ||
db1c291a | 149 | static inline int acpi_battery_ipscale(struct acpi_battery *battery) |
72206233 | 150 | { |
db1c291a | 151 | return battery_scale((battery->spec & 0xf000) >> 12); |
72206233 VL |
152 | } |
153 | ||
db1c291a | 154 | static inline int acpi_battery_mode(struct acpi_battery *battery) |
72206233 | 155 | { |
db1c291a | 156 | return (battery->mode & 0x8000); |
72206233 | 157 | } |
3f86b832 | 158 | |
db1c291a | 159 | static inline int acpi_battery_scale(struct acpi_battery *battery) |
3f86b832 | 160 | { |
db1c291a AS |
161 | return (acpi_battery_mode(battery) ? 10 : 1) * |
162 | acpi_battery_ipscale(battery); | |
3f86b832 RT |
163 | } |
164 | ||
94f6c086 AS |
165 | static int sbs_get_ac_property(struct power_supply *psy, |
166 | enum power_supply_property psp, | |
167 | union power_supply_propval *val) | |
168 | { | |
169 | struct acpi_sbs *sbs = to_acpi_sbs(psy); | |
170 | switch (psp) { | |
171 | case POWER_SUPPLY_PROP_ONLINE: | |
172 | val->intval = sbs->charger_present; | |
173 | break; | |
174 | default: | |
175 | return -EINVAL; | |
176 | } | |
177 | return 0; | |
178 | } | |
179 | ||
180 | static int acpi_battery_technology(struct acpi_battery *battery) | |
181 | { | |
182 | if (!strcasecmp("NiCd", battery->device_chemistry)) | |
183 | return POWER_SUPPLY_TECHNOLOGY_NiCd; | |
184 | if (!strcasecmp("NiMH", battery->device_chemistry)) | |
185 | return POWER_SUPPLY_TECHNOLOGY_NiMH; | |
186 | if (!strcasecmp("LION", battery->device_chemistry)) | |
187 | return POWER_SUPPLY_TECHNOLOGY_LION; | |
188 | if (!strcasecmp("LiP", battery->device_chemistry)) | |
189 | return POWER_SUPPLY_TECHNOLOGY_LIPO; | |
190 | return POWER_SUPPLY_TECHNOLOGY_UNKNOWN; | |
191 | } | |
192 | ||
193 | static int acpi_sbs_battery_get_property(struct power_supply *psy, | |
194 | enum power_supply_property psp, | |
195 | union power_supply_propval *val) | |
196 | { | |
197 | struct acpi_battery *battery = to_acpi_battery(psy); | |
198 | ||
199 | if ((!battery->present) && psp != POWER_SUPPLY_PROP_PRESENT) | |
200 | return -ENODEV; | |
201 | switch (psp) { | |
202 | case POWER_SUPPLY_PROP_STATUS: | |
203 | if (battery->current_now < 0) | |
204 | val->intval = POWER_SUPPLY_STATUS_DISCHARGING; | |
205 | else if (battery->current_now > 0) | |
206 | val->intval = POWER_SUPPLY_STATUS_CHARGING; | |
207 | else | |
208 | val->intval = POWER_SUPPLY_STATUS_FULL; | |
209 | break; | |
210 | case POWER_SUPPLY_PROP_PRESENT: | |
211 | val->intval = battery->present; | |
212 | break; | |
213 | case POWER_SUPPLY_PROP_TECHNOLOGY: | |
214 | val->intval = acpi_battery_technology(battery); | |
215 | break; | |
216 | case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN: | |
217 | val->intval = battery->design_voltage * | |
218 | acpi_battery_vscale(battery) * 1000; | |
219 | break; | |
220 | case POWER_SUPPLY_PROP_VOLTAGE_NOW: | |
221 | val->intval = battery->voltage_now * | |
222 | acpi_battery_vscale(battery) * 1000; | |
223 | break; | |
224 | case POWER_SUPPLY_PROP_CURRENT_NOW: | |
225 | val->intval = abs(battery->current_now) * | |
226 | acpi_battery_ipscale(battery) * 1000; | |
227 | break; | |
228 | case POWER_SUPPLY_PROP_CURRENT_AVG: | |
229 | val->intval = abs(battery->current_avg) * | |
230 | acpi_battery_ipscale(battery) * 1000; | |
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 | ||
265 | static enum power_supply_property sbs_ac_props[] = { | |
266 | POWER_SUPPLY_PROP_ONLINE, | |
267 | }; | |
268 | ||
269 | static 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_VOLTAGE_MIN_DESIGN, | |
274 | POWER_SUPPLY_PROP_VOLTAGE_NOW, | |
275 | POWER_SUPPLY_PROP_CURRENT_NOW, | |
276 | POWER_SUPPLY_PROP_CURRENT_AVG, | |
277 | POWER_SUPPLY_PROP_CAPACITY, | |
278 | POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN, | |
279 | POWER_SUPPLY_PROP_CHARGE_FULL, | |
280 | POWER_SUPPLY_PROP_CHARGE_NOW, | |
281 | POWER_SUPPLY_PROP_TEMP, | |
282 | POWER_SUPPLY_PROP_MODEL_NAME, | |
283 | POWER_SUPPLY_PROP_MANUFACTURER, | |
284 | }; | |
285 | ||
286 | static enum power_supply_property sbs_energy_battery_props[] = { | |
287 | POWER_SUPPLY_PROP_STATUS, | |
288 | POWER_SUPPLY_PROP_PRESENT, | |
289 | POWER_SUPPLY_PROP_TECHNOLOGY, | |
290 | POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN, | |
291 | POWER_SUPPLY_PROP_VOLTAGE_NOW, | |
292 | POWER_SUPPLY_PROP_CURRENT_NOW, | |
293 | POWER_SUPPLY_PROP_CURRENT_AVG, | |
294 | POWER_SUPPLY_PROP_CAPACITY, | |
295 | POWER_SUPPLY_PROP_ENERGY_FULL_DESIGN, | |
296 | POWER_SUPPLY_PROP_ENERGY_FULL, | |
297 | POWER_SUPPLY_PROP_ENERGY_NOW, | |
298 | POWER_SUPPLY_PROP_TEMP, | |
299 | POWER_SUPPLY_PROP_MODEL_NAME, | |
300 | POWER_SUPPLY_PROP_MANUFACTURER, | |
301 | }; | |
302 | ||
db1c291a AS |
303 | /* -------------------------------------------------------------------------- |
304 | Smart Battery System Management | |
305 | -------------------------------------------------------------------------- */ | |
3f86b832 | 306 | |
db1c291a AS |
307 | struct acpi_battery_reader { |
308 | u8 command; /* command for battery */ | |
309 | u8 mode; /* word or block? */ | |
310 | size_t offset; /* offset inside struct acpi_sbs_battery */ | |
311 | }; | |
3f86b832 | 312 | |
db1c291a AS |
313 | static struct acpi_battery_reader info_readers[] = { |
314 | {0x01, SMBUS_READ_WORD, offsetof(struct acpi_battery, alarm_capacity)}, | |
315 | {0x03, SMBUS_READ_WORD, offsetof(struct acpi_battery, mode)}, | |
316 | {0x10, SMBUS_READ_WORD, offsetof(struct acpi_battery, full_charge_capacity)}, | |
317 | {0x17, SMBUS_READ_WORD, offsetof(struct acpi_battery, cycle_count)}, | |
318 | {0x18, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_capacity)}, | |
319 | {0x19, SMBUS_READ_WORD, offsetof(struct acpi_battery, design_voltage)}, | |
320 | {0x1a, SMBUS_READ_WORD, offsetof(struct acpi_battery, spec)}, | |
321 | {0x1c, SMBUS_READ_WORD, offsetof(struct acpi_battery, serial_number)}, | |
322 | {0x20, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, manufacturer_name)}, | |
323 | {0x21, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_name)}, | |
324 | {0x22, SMBUS_READ_BLOCK, offsetof(struct acpi_battery, device_chemistry)}, | |
325 | }; | |
3f86b832 | 326 | |
db1c291a AS |
327 | static struct acpi_battery_reader state_readers[] = { |
328 | {0x08, SMBUS_READ_WORD, offsetof(struct acpi_battery, temp_now)}, | |
329 | {0x09, SMBUS_READ_WORD, offsetof(struct acpi_battery, voltage_now)}, | |
330 | {0x0a, SMBUS_READ_WORD, offsetof(struct acpi_battery, current_now)}, | |
331 | {0x0b, SMBUS_READ_WORD, offsetof(struct acpi_battery, current_avg)}, | |
332 | {0x0f, SMBUS_READ_WORD, offsetof(struct acpi_battery, capacity_now)}, | |
333 | {0x0e, SMBUS_READ_WORD, offsetof(struct acpi_battery, state_of_charge)}, | |
334 | {0x16, SMBUS_READ_WORD, offsetof(struct acpi_battery, state)}, | |
335 | }; | |
3f86b832 | 336 | |
db1c291a | 337 | static int acpi_manager_get_info(struct acpi_sbs *sbs) |
3f86b832 | 338 | { |
3f86b832 | 339 | int result = 0; |
db1c291a | 340 | u16 battery_system_info; |
3f86b832 | 341 | |
db1c291a | 342 | result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER, |
94f6c086 | 343 | 0x04, (u8 *)&battery_system_info); |
db1c291a AS |
344 | if (!result) |
345 | sbs->batteries_supported = battery_system_info & 0x000f; | |
635227ee | 346 | return result; |
3f86b832 RT |
347 | } |
348 | ||
349 | static int acpi_battery_get_info(struct acpi_battery *battery) | |
350 | { | |
db1c291a | 351 | int i, result = 0; |
3f86b832 | 352 | |
db1c291a | 353 | for (i = 0; i < ARRAY_SIZE(info_readers); ++i) { |
94f6c086 AS |
354 | result = acpi_smbus_read(battery->sbs->hc, |
355 | info_readers[i].mode, | |
356 | ACPI_SBS_BATTERY, | |
357 | info_readers[i].command, | |
358 | (u8 *) battery + | |
359 | info_readers[i].offset); | |
db1c291a AS |
360 | if (result) |
361 | break; | |
3f86b832 | 362 | } |
635227ee | 363 | return result; |
3f86b832 RT |
364 | } |
365 | ||
3f86b832 RT |
366 | static int acpi_battery_get_state(struct acpi_battery *battery) |
367 | { | |
db1c291a | 368 | int i, result = 0; |
3f86b832 | 369 | |
94f6c086 AS |
370 | if (battery->update_time && |
371 | time_before(jiffies, battery->update_time + | |
db1c291a AS |
372 | msecs_to_jiffies(cache_time))) |
373 | return 0; | |
374 | for (i = 0; i < ARRAY_SIZE(state_readers); ++i) { | |
375 | result = acpi_smbus_read(battery->sbs->hc, | |
376 | state_readers[i].mode, | |
377 | ACPI_SBS_BATTERY, | |
378 | state_readers[i].command, | |
379 | (u8 *)battery + | |
380 | state_readers[i].offset); | |
381 | if (result) | |
3f86b832 | 382 | goto end; |
3f86b832 | 383 | } |
3f86b832 | 384 | end: |
db1c291a | 385 | battery->update_time = jiffies; |
635227ee | 386 | return result; |
3f86b832 RT |
387 | } |
388 | ||
66e4b72b AS |
389 | #ifdef CONFIG_ACPI_PROCFS |
390 | ||
db1c291a | 391 | static int acpi_battery_get_alarm(struct acpi_battery *battery) |
3f86b832 | 392 | { |
db1c291a AS |
393 | return acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, |
394 | ACPI_SBS_BATTERY, 0x01, | |
94f6c086 | 395 | (u8 *)&battery->alarm_capacity); |
3f86b832 RT |
396 | } |
397 | ||
db1c291a | 398 | static int acpi_battery_set_alarm(struct acpi_battery *battery) |
3f86b832 | 399 | { |
db1c291a | 400 | struct acpi_sbs *sbs = battery->sbs; |
94f6c086 AS |
401 | u16 value, sel = 1 << (battery->id + 12); |
402 | ||
403 | int ret; | |
404 | ||
3f86b832 | 405 | |
db1c291a | 406 | if (sbs->manager_present) { |
94f6c086 | 407 | ret = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_MANAGER, |
db1c291a | 408 | 0x01, (u8 *)&value); |
94f6c086 AS |
409 | if (ret) |
410 | goto end; | |
411 | if ((value & 0xf000) != sel) { | |
412 | value &= 0x0fff; | |
413 | value |= sel; | |
414 | ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD, | |
415 | ACPI_SBS_MANAGER, | |
416 | 0x01, (u8 *)&value, 2); | |
417 | if (ret) | |
418 | goto end; | |
419 | } | |
3f86b832 | 420 | } |
94f6c086 AS |
421 | ret = acpi_smbus_write(sbs->hc, SMBUS_WRITE_WORD, ACPI_SBS_BATTERY, |
422 | 0x01, (u8 *)&battery->alarm_capacity, 2); | |
423 | end: | |
424 | return ret; | |
3f86b832 RT |
425 | } |
426 | ||
66e4b72b AS |
427 | #endif |
428 | ||
3f86b832 RT |
429 | static int acpi_ac_get_present(struct acpi_sbs *sbs) |
430 | { | |
db1c291a AS |
431 | int result; |
432 | u16 status; | |
3f86b832 | 433 | |
db1c291a AS |
434 | result = acpi_smbus_read(sbs->hc, SMBUS_READ_WORD, ACPI_SBS_CHARGER, |
435 | 0x13, (u8 *) & status); | |
436 | if (!result) | |
437 | sbs->charger_present = (status >> 15) & 0x1; | |
635227ee | 438 | return result; |
3f86b832 RT |
439 | } |
440 | ||
441 | /* -------------------------------------------------------------------------- | |
442 | FS Interface (/proc/acpi) | |
443 | -------------------------------------------------------------------------- */ | |
444 | ||
66e4b72b | 445 | #ifdef CONFIG_ACPI_PROCFS |
3f86b832 | 446 | /* Generic Routines */ |
3f86b832 | 447 | static int |
db1c291a | 448 | acpi_sbs_add_fs(struct proc_dir_entry **dir, |
94f6c086 AS |
449 | struct proc_dir_entry *parent_dir, |
450 | char *dir_name, | |
451 | struct file_operations *info_fops, | |
452 | struct file_operations *state_fops, | |
453 | struct file_operations *alarm_fops, void *data) | |
3f86b832 RT |
454 | { |
455 | struct proc_dir_entry *entry = NULL; | |
456 | ||
3f86b832 RT |
457 | if (!*dir) { |
458 | *dir = proc_mkdir(dir_name, parent_dir); | |
459 | if (!*dir) { | |
635227ee | 460 | return -ENODEV; |
3f86b832 RT |
461 | } |
462 | (*dir)->owner = THIS_MODULE; | |
463 | } | |
464 | ||
465 | /* 'info' [R] */ | |
466 | if (info_fops) { | |
467 | entry = create_proc_entry(ACPI_SBS_FILE_INFO, S_IRUGO, *dir); | |
94f6c086 | 468 | if (entry) { |
3f86b832 RT |
469 | entry->proc_fops = info_fops; |
470 | entry->data = data; | |
471 | entry->owner = THIS_MODULE; | |
472 | } | |
473 | } | |
474 | ||
475 | /* 'state' [R] */ | |
476 | if (state_fops) { | |
477 | entry = create_proc_entry(ACPI_SBS_FILE_STATE, S_IRUGO, *dir); | |
94f6c086 | 478 | if (entry) { |
3f86b832 RT |
479 | entry->proc_fops = state_fops; |
480 | entry->data = data; | |
481 | entry->owner = THIS_MODULE; | |
482 | } | |
483 | } | |
484 | ||
485 | /* 'alarm' [R/W] */ | |
486 | if (alarm_fops) { | |
487 | entry = create_proc_entry(ACPI_SBS_FILE_ALARM, S_IRUGO, *dir); | |
94f6c086 | 488 | if (entry) { |
3f86b832 RT |
489 | entry->proc_fops = alarm_fops; |
490 | entry->data = data; | |
491 | entry->owner = THIS_MODULE; | |
492 | } | |
493 | } | |
635227ee | 494 | return 0; |
3f86b832 RT |
495 | } |
496 | ||
497 | static void | |
db1c291a | 498 | acpi_sbs_remove_fs(struct proc_dir_entry **dir, |
3f86b832 RT |
499 | struct proc_dir_entry *parent_dir) |
500 | { | |
3f86b832 RT |
501 | if (*dir) { |
502 | remove_proc_entry(ACPI_SBS_FILE_INFO, *dir); | |
503 | remove_proc_entry(ACPI_SBS_FILE_STATE, *dir); | |
504 | remove_proc_entry(ACPI_SBS_FILE_ALARM, *dir); | |
505 | remove_proc_entry((*dir)->name, parent_dir); | |
506 | *dir = NULL; | |
507 | } | |
3f86b832 RT |
508 | } |
509 | ||
510 | /* Smart Battery Interface */ | |
3f86b832 RT |
511 | static struct proc_dir_entry *acpi_battery_dir = NULL; |
512 | ||
db1c291a AS |
513 | static inline char *acpi_battery_units(struct acpi_battery *battery) |
514 | { | |
515 | return acpi_battery_mode(battery) ? " mWh" : " mAh"; | |
516 | } | |
517 | ||
518 | ||
3f86b832 RT |
519 | static int acpi_battery_read_info(struct seq_file *seq, void *offset) |
520 | { | |
50dd0969 | 521 | struct acpi_battery *battery = seq->private; |
72206233 | 522 | struct acpi_sbs *sbs = battery->sbs; |
3f86b832 RT |
523 | int result = 0; |
524 | ||
db1c291a | 525 | mutex_lock(&sbs->lock); |
3f86b832 | 526 | |
db1c291a AS |
527 | seq_printf(seq, "present: %s\n", |
528 | (battery->present) ? "yes" : "no"); | |
529 | if (!battery->present) | |
72206233 | 530 | goto end; |
3f86b832 | 531 | |
72206233 | 532 | seq_printf(seq, "design capacity: %i%s\n", |
db1c291a AS |
533 | battery->design_capacity * acpi_battery_scale(battery), |
534 | acpi_battery_units(battery)); | |
72206233 | 535 | seq_printf(seq, "last full capacity: %i%s\n", |
db1c291a AS |
536 | battery->full_charge_capacity * acpi_battery_scale(battery), |
537 | acpi_battery_units(battery)); | |
3f86b832 | 538 | seq_printf(seq, "battery technology: rechargeable\n"); |
3f86b832 | 539 | seq_printf(seq, "design voltage: %i mV\n", |
db1c291a | 540 | battery->design_voltage * acpi_battery_vscale(battery)); |
3f86b832 RT |
541 | seq_printf(seq, "design capacity warning: unknown\n"); |
542 | seq_printf(seq, "design capacity low: unknown\n"); | |
543 | seq_printf(seq, "capacity granularity 1: unknown\n"); | |
544 | seq_printf(seq, "capacity granularity 2: unknown\n"); | |
db1c291a | 545 | seq_printf(seq, "model number: %s\n", battery->device_name); |
3f86b832 | 546 | seq_printf(seq, "serial number: %i\n", |
89862e3b | 547 | battery->serial_number); |
3f86b832 | 548 | seq_printf(seq, "battery type: %s\n", |
89862e3b | 549 | battery->device_chemistry); |
3f86b832 | 550 | seq_printf(seq, "OEM info: %s\n", |
89862e3b | 551 | battery->manufacturer_name); |
3f86b832 | 552 | end: |
db1c291a | 553 | mutex_unlock(&sbs->lock); |
635227ee | 554 | return result; |
3f86b832 RT |
555 | } |
556 | ||
557 | static int acpi_battery_info_open_fs(struct inode *inode, struct file *file) | |
558 | { | |
559 | return single_open(file, acpi_battery_read_info, PDE(inode)->data); | |
560 | } | |
561 | ||
562 | static int acpi_battery_read_state(struct seq_file *seq, void *offset) | |
563 | { | |
72206233 VL |
564 | struct acpi_battery *battery = seq->private; |
565 | struct acpi_sbs *sbs = battery->sbs; | |
3f86b832 | 566 | int result = 0; |
3f86b832 | 567 | |
db1c291a AS |
568 | mutex_lock(&sbs->lock); |
569 | seq_printf(seq, "present: %s\n", | |
570 | (battery->present) ? "yes" : "no"); | |
571 | if (!battery->present) | |
3f86b832 | 572 | goto end; |
3f86b832 | 573 | |
db1c291a AS |
574 | acpi_battery_get_state(battery); |
575 | seq_printf(seq, "capacity state: %s\n", | |
576 | (battery->state & 0x0010) ? "critical" : "ok"); | |
577 | seq_printf(seq, "charging state: %s\n", | |
578 | (battery->current_now < 0) ? "discharging" : | |
579 | ((battery->current_now > 0) ? "charging" : "charged")); | |
580 | seq_printf(seq, "present rate: %d mA\n", | |
581 | abs(battery->current_now) * acpi_battery_ipscale(battery)); | |
72206233 | 582 | seq_printf(seq, "remaining capacity: %i%s\n", |
db1c291a AS |
583 | battery->capacity_now * acpi_battery_scale(battery), |
584 | acpi_battery_units(battery)); | |
3f86b832 | 585 | seq_printf(seq, "present voltage: %i mV\n", |
db1c291a | 586 | battery->voltage_now * acpi_battery_vscale(battery)); |
3f86b832 RT |
587 | |
588 | end: | |
db1c291a | 589 | mutex_unlock(&sbs->lock); |
635227ee | 590 | return result; |
3f86b832 RT |
591 | } |
592 | ||
593 | static int acpi_battery_state_open_fs(struct inode *inode, struct file *file) | |
594 | { | |
595 | return single_open(file, acpi_battery_read_state, PDE(inode)->data); | |
596 | } | |
597 | ||
598 | static int acpi_battery_read_alarm(struct seq_file *seq, void *offset) | |
599 | { | |
50dd0969 | 600 | struct acpi_battery *battery = seq->private; |
72206233 | 601 | struct acpi_sbs *sbs = battery->sbs; |
3f86b832 | 602 | int result = 0; |
3f86b832 | 603 | |
db1c291a | 604 | mutex_lock(&sbs->lock); |
3f86b832 | 605 | |
89862e3b | 606 | if (!battery->present) { |
3f86b832 RT |
607 | seq_printf(seq, "present: no\n"); |
608 | goto end; | |
609 | } | |
610 | ||
db1c291a | 611 | acpi_battery_get_alarm(battery); |
3f86b832 | 612 | seq_printf(seq, "alarm: "); |
db1c291a | 613 | if (battery->alarm_capacity) |
72206233 | 614 | seq_printf(seq, "%i%s\n", |
db1c291a AS |
615 | battery->alarm_capacity * |
616 | acpi_battery_scale(battery), | |
617 | acpi_battery_units(battery)); | |
618 | else | |
3f86b832 | 619 | seq_printf(seq, "disabled\n"); |
3f86b832 | 620 | end: |
db1c291a | 621 | mutex_unlock(&sbs->lock); |
635227ee | 622 | return result; |
3f86b832 RT |
623 | } |
624 | ||
625 | static ssize_t | |
626 | acpi_battery_write_alarm(struct file *file, const char __user * buffer, | |
627 | size_t count, loff_t * ppos) | |
628 | { | |
50dd0969 JE |
629 | struct seq_file *seq = file->private_data; |
630 | struct acpi_battery *battery = seq->private; | |
72206233 | 631 | struct acpi_sbs *sbs = battery->sbs; |
3f86b832 | 632 | char alarm_string[12] = { '\0' }; |
db1c291a AS |
633 | int result = 0; |
634 | mutex_lock(&sbs->lock); | |
89862e3b | 635 | if (!battery->present) { |
3f86b832 RT |
636 | result = -ENODEV; |
637 | goto end; | |
638 | } | |
3f86b832 RT |
639 | if (count > sizeof(alarm_string) - 1) { |
640 | result = -EINVAL; | |
641 | goto end; | |
642 | } | |
3f86b832 RT |
643 | if (copy_from_user(alarm_string, buffer, count)) { |
644 | result = -EFAULT; | |
645 | goto end; | |
646 | } | |
3f86b832 | 647 | alarm_string[count] = 0; |
94f6c086 AS |
648 | battery->alarm_capacity = simple_strtoul(alarm_string, NULL, 0) / |
649 | acpi_battery_scale(battery); | |
db1c291a | 650 | acpi_battery_set_alarm(battery); |
3f86b832 | 651 | end: |
db1c291a AS |
652 | mutex_unlock(&sbs->lock); |
653 | if (result) | |
635227ee | 654 | return result; |
db1c291a | 655 | return count; |
3f86b832 RT |
656 | } |
657 | ||
658 | static int acpi_battery_alarm_open_fs(struct inode *inode, struct file *file) | |
659 | { | |
660 | return single_open(file, acpi_battery_read_alarm, PDE(inode)->data); | |
661 | } | |
662 | ||
663 | static struct file_operations acpi_battery_info_fops = { | |
664 | .open = acpi_battery_info_open_fs, | |
665 | .read = seq_read, | |
666 | .llseek = seq_lseek, | |
667 | .release = single_release, | |
668 | .owner = THIS_MODULE, | |
669 | }; | |
670 | ||
671 | static struct file_operations acpi_battery_state_fops = { | |
672 | .open = acpi_battery_state_open_fs, | |
673 | .read = seq_read, | |
674 | .llseek = seq_lseek, | |
675 | .release = single_release, | |
676 | .owner = THIS_MODULE, | |
677 | }; | |
678 | ||
679 | static struct file_operations acpi_battery_alarm_fops = { | |
680 | .open = acpi_battery_alarm_open_fs, | |
681 | .read = seq_read, | |
682 | .write = acpi_battery_write_alarm, | |
683 | .llseek = seq_lseek, | |
684 | .release = single_release, | |
685 | .owner = THIS_MODULE, | |
686 | }; | |
687 | ||
688 | /* Legacy AC Adapter Interface */ | |
689 | ||
690 | static struct proc_dir_entry *acpi_ac_dir = NULL; | |
691 | ||
692 | static int acpi_ac_read_state(struct seq_file *seq, void *offset) | |
693 | { | |
3f86b832 | 694 | |
db1c291a | 695 | struct acpi_sbs *sbs = seq->private; |
3f86b832 | 696 | |
db1c291a | 697 | mutex_lock(&sbs->lock); |
3f86b832 RT |
698 | |
699 | seq_printf(seq, "state: %s\n", | |
89862e3b | 700 | sbs->charger_present ? "on-line" : "off-line"); |
3f86b832 | 701 | |
db1c291a | 702 | mutex_unlock(&sbs->lock); |
635227ee | 703 | return 0; |
3f86b832 RT |
704 | } |
705 | ||
706 | static int acpi_ac_state_open_fs(struct inode *inode, struct file *file) | |
707 | { | |
708 | return single_open(file, acpi_ac_read_state, PDE(inode)->data); | |
709 | } | |
710 | ||
711 | static struct file_operations acpi_ac_state_fops = { | |
712 | .open = acpi_ac_state_open_fs, | |
713 | .read = seq_read, | |
714 | .llseek = seq_lseek, | |
715 | .release = single_release, | |
716 | .owner = THIS_MODULE, | |
717 | }; | |
718 | ||
66e4b72b AS |
719 | #endif |
720 | ||
3f86b832 RT |
721 | /* -------------------------------------------------------------------------- |
722 | Driver Interface | |
723 | -------------------------------------------------------------------------- */ | |
db1c291a | 724 | static int acpi_battery_read(struct acpi_battery *battery) |
3f86b832 | 725 | { |
db1c291a AS |
726 | int result = 0, saved_present = battery->present; |
727 | u16 state; | |
3f86b832 | 728 | |
db1c291a AS |
729 | if (battery->sbs->manager_present) { |
730 | result = acpi_smbus_read(battery->sbs->hc, SMBUS_READ_WORD, | |
731 | ACPI_SBS_MANAGER, 0x01, (u8 *)&state); | |
732 | if (!result) | |
733 | battery->present = state & (1 << battery->id); | |
734 | state &= 0x0fff; | |
735 | state |= 1 << (battery->id + 12); | |
736 | acpi_smbus_write(battery->sbs->hc, SMBUS_WRITE_WORD, | |
737 | ACPI_SBS_MANAGER, 0x01, (u8 *)&state, 2); | |
738 | } else if (battery->id == 0) | |
739 | battery->present = 1; | |
740 | if (result || !battery->present) | |
741 | return result; | |
3f86b832 | 742 | |
db1c291a AS |
743 | if (saved_present != battery->present) { |
744 | battery->update_time = 0; | |
745 | result = acpi_battery_get_info(battery); | |
746 | if (result) | |
747 | return result; | |
748 | } | |
749 | result = acpi_battery_get_state(battery); | |
750 | return result; | |
751 | } | |
3f86b832 | 752 | |
94f6c086 | 753 | /* Smart Battery */ |
db1c291a AS |
754 | static int acpi_battery_add(struct acpi_sbs *sbs, int id) |
755 | { | |
db1c291a | 756 | struct acpi_battery *battery = &sbs->battery[id]; |
94f6c086 AS |
757 | int result; |
758 | ||
3f86b832 RT |
759 | battery->id = id; |
760 | battery->sbs = sbs; | |
db1c291a AS |
761 | result = acpi_battery_read(battery); |
762 | if (result) | |
763 | return result; | |
3f86b832 | 764 | |
db1c291a | 765 | sprintf(battery->name, ACPI_BATTERY_DIR_NAME, id); |
66e4b72b | 766 | #ifdef CONFIG_ACPI_PROCFS |
db1c291a AS |
767 | acpi_sbs_add_fs(&battery->proc_entry, acpi_battery_dir, |
768 | battery->name, &acpi_battery_info_fops, | |
769 | &acpi_battery_state_fops, &acpi_battery_alarm_fops, | |
770 | battery); | |
66e4b72b | 771 | #endif |
94f6c086 AS |
772 | battery->bat.name = battery->name; |
773 | battery->bat.type = POWER_SUPPLY_TYPE_BATTERY; | |
774 | if (!acpi_battery_mode(battery)) { | |
775 | battery->bat.properties = sbs_charge_battery_props; | |
776 | battery->bat.num_properties = | |
777 | ARRAY_SIZE(sbs_charge_battery_props); | |
778 | } else { | |
779 | battery->bat.properties = sbs_energy_battery_props; | |
780 | battery->bat.num_properties = | |
781 | ARRAY_SIZE(sbs_energy_battery_props); | |
782 | } | |
783 | battery->bat.get_property = acpi_sbs_battery_get_property; | |
784 | result = power_supply_register(&sbs->device->dev, &battery->bat); | |
72206233 | 785 | printk(KERN_INFO PREFIX "%s [%s]: Battery Slot [%s] (battery %s)\n", |
db1c291a AS |
786 | ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device), |
787 | battery->name, sbs->battery->present ? "present" : "absent"); | |
635227ee | 788 | return result; |
3f86b832 RT |
789 | } |
790 | ||
791 | static void acpi_battery_remove(struct acpi_sbs *sbs, int id) | |
792 | { | |
94f6c086 AS |
793 | if (sbs->battery[id].bat.dev) |
794 | power_supply_unregister(&sbs->battery[id].bat); | |
66e4b72b | 795 | #ifdef CONFIG_ACPI_PROCFS |
89862e3b | 796 | if (sbs->battery[id].proc_entry) { |
db1c291a AS |
797 | acpi_sbs_remove_fs(&(sbs->battery[id].proc_entry), |
798 | acpi_battery_dir); | |
3f86b832 | 799 | } |
66e4b72b | 800 | #endif |
3f86b832 RT |
801 | } |
802 | ||
db1c291a | 803 | static int acpi_charger_add(struct acpi_sbs *sbs) |
3f86b832 RT |
804 | { |
805 | int result; | |
806 | ||
3f86b832 | 807 | result = acpi_ac_get_present(sbs); |
db1c291a | 808 | if (result) |
3f86b832 | 809 | goto end; |
66e4b72b | 810 | #ifdef CONFIG_ACPI_PROCFS |
db1c291a AS |
811 | result = acpi_sbs_add_fs(&sbs->charger_entry, acpi_ac_dir, |
812 | ACPI_AC_DIR_NAME, NULL, | |
813 | &acpi_ac_state_fops, NULL, sbs); | |
814 | if (result) | |
3f86b832 | 815 | goto end; |
66e4b72b | 816 | #endif |
94f6c086 AS |
817 | sbs->charger.name = "sbs-charger"; |
818 | sbs->charger.type = POWER_SUPPLY_TYPE_MAINS; | |
819 | sbs->charger.properties = sbs_ac_props; | |
820 | sbs->charger.num_properties = ARRAY_SIZE(sbs_ac_props); | |
821 | sbs->charger.get_property = sbs_get_ac_property; | |
822 | power_supply_register(&sbs->device->dev, &sbs->charger); | |
72206233 VL |
823 | printk(KERN_INFO PREFIX "%s [%s]: AC Adapter [%s] (%s)\n", |
824 | ACPI_SBS_DEVICE_NAME, acpi_device_bid(sbs->device), | |
89862e3b | 825 | ACPI_AC_DIR_NAME, sbs->charger_present ? "on-line" : "off-line"); |
3f86b832 | 826 | end: |
635227ee | 827 | return result; |
3f86b832 RT |
828 | } |
829 | ||
db1c291a | 830 | static void acpi_charger_remove(struct acpi_sbs *sbs) |
3f86b832 | 831 | { |
94f6c086 AS |
832 | if (sbs->charger.dev) |
833 | power_supply_unregister(&sbs->charger); | |
66e4b72b | 834 | #ifdef CONFIG_ACPI_PROCFS |
db1c291a AS |
835 | if (sbs->charger_entry) |
836 | acpi_sbs_remove_fs(&sbs->charger_entry, acpi_ac_dir); | |
66e4b72b | 837 | #endif |
3f86b832 RT |
838 | } |
839 | ||
db1c291a | 840 | void acpi_sbs_callback(void *context) |
3f86b832 | 841 | { |
db1c291a AS |
842 | int id; |
843 | struct acpi_sbs *sbs = context; | |
844 | struct acpi_battery *bat; | |
845 | u8 saved_charger_state = sbs->charger_present; | |
846 | u8 saved_battery_state; | |
847 | acpi_ac_get_present(sbs); | |
848 | if (sbs->charger_present != saved_charger_state) { | |
94f6c086 | 849 | #ifdef CONFIG_ACPI_PROC_EVENT |
db1c291a AS |
850 | acpi_bus_generate_proc_event4(ACPI_AC_CLASS, ACPI_AC_DIR_NAME, |
851 | ACPI_SBS_NOTIFY_STATUS, | |
852 | sbs->charger_present); | |
94f6c086 AS |
853 | #endif |
854 | kobject_uevent(&sbs->charger.dev->kobj, KOBJ_CHANGE); | |
3f86b832 | 855 | } |
db1c291a AS |
856 | if (sbs->manager_present) { |
857 | for (id = 0; id < MAX_SBS_BAT; ++id) { | |
858 | if (!(sbs->batteries_supported & (1 << id))) | |
859 | continue; | |
860 | bat = &sbs->battery[id]; | |
861 | saved_battery_state = bat->present; | |
862 | acpi_battery_read(bat); | |
863 | if (saved_battery_state == bat->present) | |
864 | continue; | |
94f6c086 | 865 | #ifdef CONFIG_ACPI_PROC_EVENT |
db1c291a AS |
866 | acpi_bus_generate_proc_event4(ACPI_BATTERY_CLASS, |
867 | bat->name, | |
868 | ACPI_SBS_NOTIFY_STATUS, | |
869 | bat->present); | |
94f6c086 AS |
870 | #endif |
871 | kobject_uevent(&bat->bat.dev->kobj, KOBJ_CHANGE); | |
3f86b832 | 872 | } |
3f86b832 | 873 | } |
3f86b832 RT |
874 | } |
875 | ||
db1c291a | 876 | static int acpi_sbs_remove(struct acpi_device *device, int type); |
3f86b832 RT |
877 | |
878 | static int acpi_sbs_add(struct acpi_device *device) | |
879 | { | |
db1c291a AS |
880 | struct acpi_sbs *sbs; |
881 | int result = 0; | |
6d15702c | 882 | int id; |
3f86b832 | 883 | |
36bcbec7 | 884 | sbs = kzalloc(sizeof(struct acpi_sbs), GFP_KERNEL); |
3f86b832 | 885 | if (!sbs) { |
72206233 VL |
886 | result = -ENOMEM; |
887 | goto end; | |
3f86b832 | 888 | } |
3f86b832 | 889 | |
db1c291a | 890 | mutex_init(&sbs->lock); |
72206233 | 891 | |
91087dfa | 892 | sbs->hc = acpi_driver_data(device->parent); |
db1c291a | 893 | sbs->device = device; |
3f86b832 RT |
894 | strcpy(acpi_device_name(device), ACPI_SBS_DEVICE_NAME); |
895 | strcpy(acpi_device_class(device), ACPI_SBS_CLASS); | |
896 | acpi_driver_data(device) = sbs; | |
897 | ||
db1c291a | 898 | result = acpi_charger_add(sbs); |
72206233 VL |
899 | if (result) |
900 | goto end; | |
3f86b832 | 901 | |
db1c291a AS |
902 | result = acpi_manager_get_info(sbs); |
903 | if (!result) { | |
904 | sbs->manager_present = 1; | |
905 | for (id = 0; id < MAX_SBS_BAT; ++id) | |
906 | if ((sbs->batteries_supported & (1 << id))) | |
907 | acpi_battery_add(sbs, id); | |
908 | } else | |
909 | acpi_battery_add(sbs, 0); | |
910 | acpi_smbus_register_callback(sbs->hc, acpi_sbs_callback, sbs); | |
3f86b832 | 911 | end: |
db1c291a AS |
912 | if (result) |
913 | acpi_sbs_remove(device, 0); | |
635227ee | 914 | return result; |
3f86b832 RT |
915 | } |
916 | ||
72206233 | 917 | static int acpi_sbs_remove(struct acpi_device *device, int type) |
3f86b832 | 918 | { |
cece9014 | 919 | struct acpi_sbs *sbs; |
3f86b832 RT |
920 | int id; |
921 | ||
db1c291a | 922 | if (!device) |
963497c1 | 923 | return -EINVAL; |
72206233 | 924 | sbs = acpi_driver_data(device); |
db1c291a | 925 | if (!sbs) |
635227ee | 926 | return -EINVAL; |
db1c291a AS |
927 | mutex_lock(&sbs->lock); |
928 | acpi_smbus_unregister_callback(sbs->hc); | |
929 | for (id = 0; id < MAX_SBS_BAT; ++id) | |
3f86b832 | 930 | acpi_battery_remove(sbs, id); |
db1c291a AS |
931 | acpi_charger_remove(sbs); |
932 | mutex_unlock(&sbs->lock); | |
933 | mutex_destroy(&sbs->lock); | |
3f86b832 | 934 | kfree(sbs); |
635227ee | 935 | return 0; |
3f86b832 RT |
936 | } |
937 | ||
72206233 VL |
938 | static void acpi_sbs_rmdirs(void) |
939 | { | |
66e4b72b | 940 | #ifdef CONFIG_ACPI_PROCFS |
72206233 VL |
941 | if (acpi_ac_dir) { |
942 | acpi_unlock_ac_dir(acpi_ac_dir); | |
943 | acpi_ac_dir = NULL; | |
944 | } | |
945 | if (acpi_battery_dir) { | |
946 | acpi_unlock_battery_dir(acpi_battery_dir); | |
947 | acpi_battery_dir = NULL; | |
948 | } | |
66e4b72b | 949 | #endif |
72206233 VL |
950 | } |
951 | ||
952 | static int acpi_sbs_resume(struct acpi_device *device) | |
953 | { | |
954 | struct acpi_sbs *sbs; | |
72206233 VL |
955 | if (!device) |
956 | return -EINVAL; | |
72206233 | 957 | sbs = device->driver_data; |
db1c291a | 958 | acpi_sbs_callback(sbs); |
72206233 VL |
959 | return 0; |
960 | } | |
961 | ||
94f6c086 AS |
962 | static struct acpi_driver acpi_sbs_driver = { |
963 | .name = "sbs", | |
964 | .class = ACPI_SBS_CLASS, | |
965 | .ids = sbs_device_ids, | |
966 | .ops = { | |
967 | .add = acpi_sbs_add, | |
968 | .remove = acpi_sbs_remove, | |
969 | .resume = acpi_sbs_resume, | |
970 | }, | |
971 | }; | |
972 | ||
3f86b832 RT |
973 | static int __init acpi_sbs_init(void) |
974 | { | |
975 | int result = 0; | |
976 | ||
b20d2aeb LB |
977 | if (acpi_disabled) |
978 | return -ENODEV; | |
66e4b72b | 979 | #ifdef CONFIG_ACPI_PROCFS |
3f86b832 | 980 | acpi_ac_dir = acpi_lock_ac_dir(); |
94f6c086 | 981 | if (!acpi_ac_dir) |
635227ee | 982 | return -ENODEV; |
3f86b832 RT |
983 | acpi_battery_dir = acpi_lock_battery_dir(); |
984 | if (!acpi_battery_dir) { | |
72206233 | 985 | acpi_sbs_rmdirs(); |
635227ee | 986 | return -ENODEV; |
3f86b832 | 987 | } |
66e4b72b | 988 | #endif |
3f86b832 RT |
989 | result = acpi_bus_register_driver(&acpi_sbs_driver); |
990 | if (result < 0) { | |
72206233 | 991 | acpi_sbs_rmdirs(); |
635227ee | 992 | return -ENODEV; |
3f86b832 | 993 | } |
635227ee | 994 | return 0; |
3f86b832 RT |
995 | } |
996 | ||
997 | static void __exit acpi_sbs_exit(void) | |
998 | { | |
3f86b832 | 999 | acpi_bus_unregister_driver(&acpi_sbs_driver); |
72206233 | 1000 | acpi_sbs_rmdirs(); |
635227ee | 1001 | return; |
3f86b832 RT |
1002 | } |
1003 | ||
1004 | module_init(acpi_sbs_init); | |
1005 | module_exit(acpi_sbs_exit); |