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