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