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