diff options
Diffstat (limited to 'drivers/platform/x86/asus-wmi.c')
-rw-r--r-- | drivers/platform/x86/asus-wmi.c | 1657 |
1 files changed, 1657 insertions, 0 deletions
diff --git a/drivers/platform/x86/asus-wmi.c b/drivers/platform/x86/asus-wmi.c new file mode 100644 index 000000000000..3c7857c71a23 --- /dev/null +++ b/drivers/platform/x86/asus-wmi.c | |||
@@ -0,0 +1,1657 @@ | |||
1 | /* | ||
2 | * Asus PC WMI hotkey driver | ||
3 | * | ||
4 | * Copyright(C) 2010 Intel Corporation. | ||
5 | * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com> | ||
6 | * | ||
7 | * Portions based on wistron_btns.c: | ||
8 | * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz> | ||
9 | * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org> | ||
10 | * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru> | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or modify | ||
13 | * it under the terms of the GNU General Public License as published by | ||
14 | * the Free Software Foundation; either version 2 of the License, or | ||
15 | * (at your option) any later version. | ||
16 | * | ||
17 | * This program is distributed in the hope that it will be useful, | ||
18 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
20 | * GNU General Public License for more details. | ||
21 | * | ||
22 | * You should have received a copy of the GNU General Public License | ||
23 | * along with this program; if not, write to the Free Software | ||
24 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
25 | */ | ||
26 | |||
27 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | ||
28 | |||
29 | #include <linux/kernel.h> | ||
30 | #include <linux/module.h> | ||
31 | #include <linux/init.h> | ||
32 | #include <linux/types.h> | ||
33 | #include <linux/slab.h> | ||
34 | #include <linux/input.h> | ||
35 | #include <linux/input/sparse-keymap.h> | ||
36 | #include <linux/fb.h> | ||
37 | #include <linux/backlight.h> | ||
38 | #include <linux/leds.h> | ||
39 | #include <linux/rfkill.h> | ||
40 | #include <linux/pci.h> | ||
41 | #include <linux/pci_hotplug.h> | ||
42 | #include <linux/hwmon.h> | ||
43 | #include <linux/hwmon-sysfs.h> | ||
44 | #include <linux/debugfs.h> | ||
45 | #include <linux/seq_file.h> | ||
46 | #include <linux/platform_device.h> | ||
47 | #include <acpi/acpi_bus.h> | ||
48 | #include <acpi/acpi_drivers.h> | ||
49 | |||
50 | #include "asus-wmi.h" | ||
51 | |||
52 | MODULE_AUTHOR("Corentin Chary <corentincj@iksaif.net>, " | ||
53 | "Yong Wang <yong.y.wang@intel.com>"); | ||
54 | MODULE_DESCRIPTION("Asus Generic WMI Driver"); | ||
55 | MODULE_LICENSE("GPL"); | ||
56 | |||
57 | #define to_platform_driver(drv) \ | ||
58 | (container_of((drv), struct platform_driver, driver)) | ||
59 | |||
60 | #define to_asus_wmi_driver(pdrv) \ | ||
61 | (container_of((pdrv), struct asus_wmi_driver, platform_driver)) | ||
62 | |||
63 | #define ASUS_WMI_MGMT_GUID "97845ED0-4E6D-11DE-8A39-0800200C9A66" | ||
64 | |||
65 | #define NOTIFY_BRNUP_MIN 0x11 | ||
66 | #define NOTIFY_BRNUP_MAX 0x1f | ||
67 | #define NOTIFY_BRNDOWN_MIN 0x20 | ||
68 | #define NOTIFY_BRNDOWN_MAX 0x2e | ||
69 | |||
70 | /* WMI Methods */ | ||
71 | #define ASUS_WMI_METHODID_SPEC 0x43455053 /* BIOS SPECification */ | ||
72 | #define ASUS_WMI_METHODID_SFBD 0x44424653 /* Set First Boot Device */ | ||
73 | #define ASUS_WMI_METHODID_GLCD 0x44434C47 /* Get LCD status */ | ||
74 | #define ASUS_WMI_METHODID_GPID 0x44495047 /* Get Panel ID?? (Resol) */ | ||
75 | #define ASUS_WMI_METHODID_QMOD 0x444F4D51 /* Quiet MODe */ | ||
76 | #define ASUS_WMI_METHODID_SPLV 0x4C425053 /* Set Panel Light Value */ | ||
77 | #define ASUS_WMI_METHODID_SFUN 0x4E554653 /* FUNCtionalities */ | ||
78 | #define ASUS_WMI_METHODID_SDSP 0x50534453 /* Set DiSPlay output */ | ||
79 | #define ASUS_WMI_METHODID_GDSP 0x50534447 /* Get DiSPlay output */ | ||
80 | #define ASUS_WMI_METHODID_DEVP 0x50564544 /* DEVice Policy */ | ||
81 | #define ASUS_WMI_METHODID_OSVR 0x5256534F /* OS VeRsion */ | ||
82 | #define ASUS_WMI_METHODID_DSTS 0x53544344 /* Device STatuS */ | ||
83 | #define ASUS_WMI_METHODID_DSTS2 0x53545344 /* Device STatuS #2*/ | ||
84 | #define ASUS_WMI_METHODID_BSTS 0x53545342 /* Bios STatuS ? */ | ||
85 | #define ASUS_WMI_METHODID_DEVS 0x53564544 /* DEVice Set */ | ||
86 | #define ASUS_WMI_METHODID_CFVS 0x53564643 /* CPU Frequency Volt Set */ | ||
87 | #define ASUS_WMI_METHODID_KBFT 0x5446424B /* KeyBoard FilTer */ | ||
88 | #define ASUS_WMI_METHODID_INIT 0x54494E49 /* INITialize */ | ||
89 | #define ASUS_WMI_METHODID_HKEY 0x59454B48 /* Hot KEY ?? */ | ||
90 | |||
91 | #define ASUS_WMI_UNSUPPORTED_METHOD 0xFFFFFFFE | ||
92 | |||
93 | /* Wireless */ | ||
94 | #define ASUS_WMI_DEVID_HW_SWITCH 0x00010001 | ||
95 | #define ASUS_WMI_DEVID_WIRELESS_LED 0x00010002 | ||
96 | #define ASUS_WMI_DEVID_WLAN 0x00010011 | ||
97 | #define ASUS_WMI_DEVID_BLUETOOTH 0x00010013 | ||
98 | #define ASUS_WMI_DEVID_GPS 0x00010015 | ||
99 | #define ASUS_WMI_DEVID_WIMAX 0x00010017 | ||
100 | #define ASUS_WMI_DEVID_WWAN3G 0x00010019 | ||
101 | #define ASUS_WMI_DEVID_UWB 0x00010021 | ||
102 | |||
103 | /* Leds */ | ||
104 | /* 0x000200XX and 0x000400XX */ | ||
105 | |||
106 | /* Backlight and Brightness */ | ||
107 | #define ASUS_WMI_DEVID_BACKLIGHT 0x00050011 | ||
108 | #define ASUS_WMI_DEVID_BRIGHTNESS 0x00050012 | ||
109 | #define ASUS_WMI_DEVID_KBD_BACKLIGHT 0x00050021 | ||
110 | #define ASUS_WMI_DEVID_LIGHT_SENSOR 0x00050022 /* ?? */ | ||
111 | |||
112 | /* Misc */ | ||
113 | #define ASUS_WMI_DEVID_CAMERA 0x00060013 | ||
114 | |||
115 | /* Storage */ | ||
116 | #define ASUS_WMI_DEVID_CARDREADER 0x00080013 | ||
117 | |||
118 | /* Input */ | ||
119 | #define ASUS_WMI_DEVID_TOUCHPAD 0x00100011 | ||
120 | #define ASUS_WMI_DEVID_TOUCHPAD_LED 0x00100012 | ||
121 | |||
122 | /* Fan, Thermal */ | ||
123 | #define ASUS_WMI_DEVID_THERMAL_CTRL 0x00110011 | ||
124 | #define ASUS_WMI_DEVID_FAN_CTRL 0x00110012 | ||
125 | |||
126 | /* Power */ | ||
127 | #define ASUS_WMI_DEVID_PROCESSOR_STATE 0x00120012 | ||
128 | |||
129 | /* DSTS masks */ | ||
130 | #define ASUS_WMI_DSTS_STATUS_BIT 0x00000001 | ||
131 | #define ASUS_WMI_DSTS_UNKNOWN_BIT 0x00000002 | ||
132 | #define ASUS_WMI_DSTS_PRESENCE_BIT 0x00010000 | ||
133 | #define ASUS_WMI_DSTS_USER_BIT 0x00020000 | ||
134 | #define ASUS_WMI_DSTS_BIOS_BIT 0x00040000 | ||
135 | #define ASUS_WMI_DSTS_BRIGHTNESS_MASK 0x000000FF | ||
136 | #define ASUS_WMI_DSTS_MAX_BRIGTH_MASK 0x0000FF00 | ||
137 | |||
138 | struct bios_args { | ||
139 | u32 arg0; | ||
140 | u32 arg1; | ||
141 | } __packed; | ||
142 | |||
143 | /* | ||
144 | * <platform>/ - debugfs root directory | ||
145 | * dev_id - current dev_id | ||
146 | * ctrl_param - current ctrl_param | ||
147 | * method_id - current method_id | ||
148 | * devs - call DEVS(dev_id, ctrl_param) and print result | ||
149 | * dsts - call DSTS(dev_id) and print result | ||
150 | * call - call method_id(dev_id, ctrl_param) and print result | ||
151 | */ | ||
152 | struct asus_wmi_debug { | ||
153 | struct dentry *root; | ||
154 | u32 method_id; | ||
155 | u32 dev_id; | ||
156 | u32 ctrl_param; | ||
157 | }; | ||
158 | |||
159 | struct asus_rfkill { | ||
160 | struct asus_wmi *asus; | ||
161 | struct rfkill *rfkill; | ||
162 | u32 dev_id; | ||
163 | }; | ||
164 | |||
165 | struct asus_wmi { | ||
166 | int dsts_id; | ||
167 | int spec; | ||
168 | int sfun; | ||
169 | |||
170 | struct input_dev *inputdev; | ||
171 | struct backlight_device *backlight_device; | ||
172 | struct device *hwmon_device; | ||
173 | struct platform_device *platform_device; | ||
174 | |||
175 | struct led_classdev tpd_led; | ||
176 | int tpd_led_wk; | ||
177 | struct workqueue_struct *led_workqueue; | ||
178 | struct work_struct tpd_led_work; | ||
179 | |||
180 | struct asus_rfkill wlan; | ||
181 | struct asus_rfkill bluetooth; | ||
182 | struct asus_rfkill wimax; | ||
183 | struct asus_rfkill wwan3g; | ||
184 | |||
185 | struct hotplug_slot *hotplug_slot; | ||
186 | struct mutex hotplug_lock; | ||
187 | struct mutex wmi_lock; | ||
188 | struct workqueue_struct *hotplug_workqueue; | ||
189 | struct work_struct hotplug_work; | ||
190 | |||
191 | struct asus_wmi_debug debug; | ||
192 | |||
193 | struct asus_wmi_driver *driver; | ||
194 | }; | ||
195 | |||
196 | static int asus_wmi_input_init(struct asus_wmi *asus) | ||
197 | { | ||
198 | int err; | ||
199 | |||
200 | asus->inputdev = input_allocate_device(); | ||
201 | if (!asus->inputdev) | ||
202 | return -ENOMEM; | ||
203 | |||
204 | asus->inputdev->name = asus->driver->input_name; | ||
205 | asus->inputdev->phys = asus->driver->input_phys; | ||
206 | asus->inputdev->id.bustype = BUS_HOST; | ||
207 | asus->inputdev->dev.parent = &asus->platform_device->dev; | ||
208 | |||
209 | err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL); | ||
210 | if (err) | ||
211 | goto err_free_dev; | ||
212 | |||
213 | err = input_register_device(asus->inputdev); | ||
214 | if (err) | ||
215 | goto err_free_keymap; | ||
216 | |||
217 | return 0; | ||
218 | |||
219 | err_free_keymap: | ||
220 | sparse_keymap_free(asus->inputdev); | ||
221 | err_free_dev: | ||
222 | input_free_device(asus->inputdev); | ||
223 | return err; | ||
224 | } | ||
225 | |||
226 | static void asus_wmi_input_exit(struct asus_wmi *asus) | ||
227 | { | ||
228 | if (asus->inputdev) { | ||
229 | sparse_keymap_free(asus->inputdev); | ||
230 | input_unregister_device(asus->inputdev); | ||
231 | } | ||
232 | |||
233 | asus->inputdev = NULL; | ||
234 | } | ||
235 | |||
236 | static int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1, | ||
237 | u32 *retval) | ||
238 | { | ||
239 | struct bios_args args = { | ||
240 | .arg0 = arg0, | ||
241 | .arg1 = arg1, | ||
242 | }; | ||
243 | struct acpi_buffer input = { (acpi_size) sizeof(args), &args }; | ||
244 | struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
245 | acpi_status status; | ||
246 | union acpi_object *obj; | ||
247 | u32 tmp; | ||
248 | |||
249 | status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 1, method_id, | ||
250 | &input, &output); | ||
251 | |||
252 | if (ACPI_FAILURE(status)) | ||
253 | goto exit; | ||
254 | |||
255 | obj = (union acpi_object *)output.pointer; | ||
256 | if (obj && obj->type == ACPI_TYPE_INTEGER) | ||
257 | tmp = (u32) obj->integer.value; | ||
258 | else | ||
259 | tmp = 0; | ||
260 | |||
261 | if (retval) | ||
262 | *retval = tmp; | ||
263 | |||
264 | kfree(obj); | ||
265 | |||
266 | exit: | ||
267 | if (ACPI_FAILURE(status)) | ||
268 | return -EIO; | ||
269 | |||
270 | if (tmp == ASUS_WMI_UNSUPPORTED_METHOD) | ||
271 | return -ENODEV; | ||
272 | |||
273 | return 0; | ||
274 | } | ||
275 | |||
276 | static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval) | ||
277 | { | ||
278 | return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval); | ||
279 | } | ||
280 | |||
281 | static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param, | ||
282 | u32 *retval) | ||
283 | { | ||
284 | return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id, | ||
285 | ctrl_param, retval); | ||
286 | } | ||
287 | |||
288 | /* Helper for special devices with magic return codes */ | ||
289 | static int asus_wmi_get_devstate_bits(struct asus_wmi *asus, | ||
290 | u32 dev_id, u32 mask) | ||
291 | { | ||
292 | u32 retval = 0; | ||
293 | int err; | ||
294 | |||
295 | err = asus_wmi_get_devstate(asus, dev_id, &retval); | ||
296 | |||
297 | if (err < 0) | ||
298 | return err; | ||
299 | |||
300 | if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT)) | ||
301 | return -ENODEV; | ||
302 | |||
303 | if (mask == ASUS_WMI_DSTS_STATUS_BIT) { | ||
304 | if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT) | ||
305 | return -ENODEV; | ||
306 | } | ||
307 | |||
308 | return retval & mask; | ||
309 | } | ||
310 | |||
311 | static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id) | ||
312 | { | ||
313 | return asus_wmi_get_devstate_bits(asus, dev_id, | ||
314 | ASUS_WMI_DSTS_STATUS_BIT); | ||
315 | } | ||
316 | |||
317 | /* | ||
318 | * LEDs | ||
319 | */ | ||
320 | /* | ||
321 | * These functions actually update the LED's, and are called from a | ||
322 | * workqueue. By doing this as separate work rather than when the LED | ||
323 | * subsystem asks, we avoid messing with the Asus ACPI stuff during a | ||
324 | * potentially bad time, such as a timer interrupt. | ||
325 | */ | ||
326 | static void tpd_led_update(struct work_struct *work) | ||
327 | { | ||
328 | int ctrl_param; | ||
329 | struct asus_wmi *asus; | ||
330 | |||
331 | asus = container_of(work, struct asus_wmi, tpd_led_work); | ||
332 | |||
333 | ctrl_param = asus->tpd_led_wk; | ||
334 | asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL); | ||
335 | } | ||
336 | |||
337 | static void tpd_led_set(struct led_classdev *led_cdev, | ||
338 | enum led_brightness value) | ||
339 | { | ||
340 | struct asus_wmi *asus; | ||
341 | |||
342 | asus = container_of(led_cdev, struct asus_wmi, tpd_led); | ||
343 | |||
344 | asus->tpd_led_wk = !!value; | ||
345 | queue_work(asus->led_workqueue, &asus->tpd_led_work); | ||
346 | } | ||
347 | |||
348 | static int read_tpd_led_state(struct asus_wmi *asus) | ||
349 | { | ||
350 | return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED); | ||
351 | } | ||
352 | |||
353 | static enum led_brightness tpd_led_get(struct led_classdev *led_cdev) | ||
354 | { | ||
355 | struct asus_wmi *asus; | ||
356 | |||
357 | asus = container_of(led_cdev, struct asus_wmi, tpd_led); | ||
358 | |||
359 | return read_tpd_led_state(asus); | ||
360 | } | ||
361 | |||
362 | static int asus_wmi_led_init(struct asus_wmi *asus) | ||
363 | { | ||
364 | int rv; | ||
365 | |||
366 | if (read_tpd_led_state(asus) < 0) | ||
367 | return 0; | ||
368 | |||
369 | asus->led_workqueue = create_singlethread_workqueue("led_workqueue"); | ||
370 | if (!asus->led_workqueue) | ||
371 | return -ENOMEM; | ||
372 | INIT_WORK(&asus->tpd_led_work, tpd_led_update); | ||
373 | |||
374 | asus->tpd_led.name = "asus::touchpad"; | ||
375 | asus->tpd_led.brightness_set = tpd_led_set; | ||
376 | asus->tpd_led.brightness_get = tpd_led_get; | ||
377 | asus->tpd_led.max_brightness = 1; | ||
378 | |||
379 | rv = led_classdev_register(&asus->platform_device->dev, &asus->tpd_led); | ||
380 | if (rv) { | ||
381 | destroy_workqueue(asus->led_workqueue); | ||
382 | return rv; | ||
383 | } | ||
384 | |||
385 | return 0; | ||
386 | } | ||
387 | |||
388 | static void asus_wmi_led_exit(struct asus_wmi *asus) | ||
389 | { | ||
390 | if (asus->tpd_led.dev) | ||
391 | led_classdev_unregister(&asus->tpd_led); | ||
392 | if (asus->led_workqueue) | ||
393 | destroy_workqueue(asus->led_workqueue); | ||
394 | } | ||
395 | |||
396 | /* | ||
397 | * PCI hotplug (for wlan rfkill) | ||
398 | */ | ||
399 | static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus) | ||
400 | { | ||
401 | int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN); | ||
402 | |||
403 | if (result < 0) | ||
404 | return false; | ||
405 | return !result; | ||
406 | } | ||
407 | |||
408 | static void asus_rfkill_hotplug(struct asus_wmi *asus) | ||
409 | { | ||
410 | struct pci_dev *dev; | ||
411 | struct pci_bus *bus; | ||
412 | bool blocked; | ||
413 | bool absent; | ||
414 | u32 l; | ||
415 | |||
416 | mutex_lock(&asus->wmi_lock); | ||
417 | blocked = asus_wlan_rfkill_blocked(asus); | ||
418 | mutex_unlock(&asus->wmi_lock); | ||
419 | |||
420 | mutex_lock(&asus->hotplug_lock); | ||
421 | |||
422 | if (asus->wlan.rfkill) | ||
423 | rfkill_set_sw_state(asus->wlan.rfkill, blocked); | ||
424 | |||
425 | if (asus->hotplug_slot) { | ||
426 | bus = pci_find_bus(0, 1); | ||
427 | if (!bus) { | ||
428 | pr_warn("Unable to find PCI bus 1?\n"); | ||
429 | goto out_unlock; | ||
430 | } | ||
431 | |||
432 | if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) { | ||
433 | pr_err("Unable to read PCI config space?\n"); | ||
434 | goto out_unlock; | ||
435 | } | ||
436 | absent = (l == 0xffffffff); | ||
437 | |||
438 | if (blocked != absent) { | ||
439 | pr_warn("BIOS says wireless lan is %s, " | ||
440 | "but the pci device is %s\n", | ||
441 | blocked ? "blocked" : "unblocked", | ||
442 | absent ? "absent" : "present"); | ||
443 | pr_warn("skipped wireless hotplug as probably " | ||
444 | "inappropriate for this model\n"); | ||
445 | goto out_unlock; | ||
446 | } | ||
447 | |||
448 | if (!blocked) { | ||
449 | dev = pci_get_slot(bus, 0); | ||
450 | if (dev) { | ||
451 | /* Device already present */ | ||
452 | pci_dev_put(dev); | ||
453 | goto out_unlock; | ||
454 | } | ||
455 | dev = pci_scan_single_device(bus, 0); | ||
456 | if (dev) { | ||
457 | pci_bus_assign_resources(bus); | ||
458 | if (pci_bus_add_device(dev)) | ||
459 | pr_err("Unable to hotplug wifi\n"); | ||
460 | } | ||
461 | } else { | ||
462 | dev = pci_get_slot(bus, 0); | ||
463 | if (dev) { | ||
464 | pci_remove_bus_device(dev); | ||
465 | pci_dev_put(dev); | ||
466 | } | ||
467 | } | ||
468 | } | ||
469 | |||
470 | out_unlock: | ||
471 | mutex_unlock(&asus->hotplug_lock); | ||
472 | } | ||
473 | |||
474 | static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data) | ||
475 | { | ||
476 | struct asus_wmi *asus = data; | ||
477 | |||
478 | if (event != ACPI_NOTIFY_BUS_CHECK) | ||
479 | return; | ||
480 | |||
481 | /* | ||
482 | * We can't call directly asus_rfkill_hotplug because most | ||
483 | * of the time WMBC is still being executed and not reetrant. | ||
484 | * There is currently no way to tell ACPICA that we want this | ||
485 | * method to be serialized, we schedule a asus_rfkill_hotplug | ||
486 | * call later, in a safer context. | ||
487 | */ | ||
488 | queue_work(asus->hotplug_workqueue, &asus->hotplug_work); | ||
489 | } | ||
490 | |||
491 | static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node) | ||
492 | { | ||
493 | acpi_status status; | ||
494 | acpi_handle handle; | ||
495 | |||
496 | status = acpi_get_handle(NULL, node, &handle); | ||
497 | |||
498 | if (ACPI_SUCCESS(status)) { | ||
499 | status = acpi_install_notify_handler(handle, | ||
500 | ACPI_SYSTEM_NOTIFY, | ||
501 | asus_rfkill_notify, asus); | ||
502 | if (ACPI_FAILURE(status)) | ||
503 | pr_warn("Failed to register notify on %s\n", node); | ||
504 | } else | ||
505 | return -ENODEV; | ||
506 | |||
507 | return 0; | ||
508 | } | ||
509 | |||
510 | static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node) | ||
511 | { | ||
512 | acpi_status status = AE_OK; | ||
513 | acpi_handle handle; | ||
514 | |||
515 | status = acpi_get_handle(NULL, node, &handle); | ||
516 | |||
517 | if (ACPI_SUCCESS(status)) { | ||
518 | status = acpi_remove_notify_handler(handle, | ||
519 | ACPI_SYSTEM_NOTIFY, | ||
520 | asus_rfkill_notify); | ||
521 | if (ACPI_FAILURE(status)) | ||
522 | pr_err("Error removing rfkill notify handler %s\n", | ||
523 | node); | ||
524 | } | ||
525 | } | ||
526 | |||
527 | static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot, | ||
528 | u8 *value) | ||
529 | { | ||
530 | struct asus_wmi *asus = hotplug_slot->private; | ||
531 | int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN); | ||
532 | |||
533 | if (result < 0) | ||
534 | return result; | ||
535 | |||
536 | *value = !!result; | ||
537 | return 0; | ||
538 | } | ||
539 | |||
540 | static void asus_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot) | ||
541 | { | ||
542 | kfree(hotplug_slot->info); | ||
543 | kfree(hotplug_slot); | ||
544 | } | ||
545 | |||
546 | static struct hotplug_slot_ops asus_hotplug_slot_ops = { | ||
547 | .owner = THIS_MODULE, | ||
548 | .get_adapter_status = asus_get_adapter_status, | ||
549 | .get_power_status = asus_get_adapter_status, | ||
550 | }; | ||
551 | |||
552 | static void asus_hotplug_work(struct work_struct *work) | ||
553 | { | ||
554 | struct asus_wmi *asus; | ||
555 | |||
556 | asus = container_of(work, struct asus_wmi, hotplug_work); | ||
557 | asus_rfkill_hotplug(asus); | ||
558 | } | ||
559 | |||
560 | static int asus_setup_pci_hotplug(struct asus_wmi *asus) | ||
561 | { | ||
562 | int ret = -ENOMEM; | ||
563 | struct pci_bus *bus = pci_find_bus(0, 1); | ||
564 | |||
565 | if (!bus) { | ||
566 | pr_err("Unable to find wifi PCI bus\n"); | ||
567 | return -ENODEV; | ||
568 | } | ||
569 | |||
570 | asus->hotplug_workqueue = | ||
571 | create_singlethread_workqueue("hotplug_workqueue"); | ||
572 | if (!asus->hotplug_workqueue) | ||
573 | goto error_workqueue; | ||
574 | |||
575 | INIT_WORK(&asus->hotplug_work, asus_hotplug_work); | ||
576 | |||
577 | asus->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL); | ||
578 | if (!asus->hotplug_slot) | ||
579 | goto error_slot; | ||
580 | |||
581 | asus->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info), | ||
582 | GFP_KERNEL); | ||
583 | if (!asus->hotplug_slot->info) | ||
584 | goto error_info; | ||
585 | |||
586 | asus->hotplug_slot->private = asus; | ||
587 | asus->hotplug_slot->release = &asus_cleanup_pci_hotplug; | ||
588 | asus->hotplug_slot->ops = &asus_hotplug_slot_ops; | ||
589 | asus_get_adapter_status(asus->hotplug_slot, | ||
590 | &asus->hotplug_slot->info->adapter_status); | ||
591 | |||
592 | ret = pci_hp_register(asus->hotplug_slot, bus, 0, "asus-wifi"); | ||
593 | if (ret) { | ||
594 | pr_err("Unable to register hotplug slot - %d\n", ret); | ||
595 | goto error_register; | ||
596 | } | ||
597 | |||
598 | return 0; | ||
599 | |||
600 | error_register: | ||
601 | kfree(asus->hotplug_slot->info); | ||
602 | error_info: | ||
603 | kfree(asus->hotplug_slot); | ||
604 | asus->hotplug_slot = NULL; | ||
605 | error_slot: | ||
606 | destroy_workqueue(asus->hotplug_workqueue); | ||
607 | error_workqueue: | ||
608 | return ret; | ||
609 | } | ||
610 | |||
611 | /* | ||
612 | * Rfkill devices | ||
613 | */ | ||
614 | static int asus_rfkill_set(void *data, bool blocked) | ||
615 | { | ||
616 | struct asus_rfkill *priv = data; | ||
617 | u32 ctrl_param = !blocked; | ||
618 | |||
619 | return asus_wmi_set_devstate(priv->dev_id, ctrl_param, NULL); | ||
620 | } | ||
621 | |||
622 | static void asus_rfkill_query(struct rfkill *rfkill, void *data) | ||
623 | { | ||
624 | struct asus_rfkill *priv = data; | ||
625 | int result; | ||
626 | |||
627 | result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id); | ||
628 | |||
629 | if (result < 0) | ||
630 | return; | ||
631 | |||
632 | rfkill_set_sw_state(priv->rfkill, !result); | ||
633 | } | ||
634 | |||
635 | static int asus_rfkill_wlan_set(void *data, bool blocked) | ||
636 | { | ||
637 | struct asus_rfkill *priv = data; | ||
638 | struct asus_wmi *asus = priv->asus; | ||
639 | int ret; | ||
640 | |||
641 | /* | ||
642 | * This handler is enabled only if hotplug is enabled. | ||
643 | * In this case, the asus_wmi_set_devstate() will | ||
644 | * trigger a wmi notification and we need to wait | ||
645 | * this call to finish before being able to call | ||
646 | * any wmi method | ||
647 | */ | ||
648 | mutex_lock(&asus->wmi_lock); | ||
649 | ret = asus_rfkill_set(data, blocked); | ||
650 | mutex_unlock(&asus->wmi_lock); | ||
651 | return ret; | ||
652 | } | ||
653 | |||
654 | static const struct rfkill_ops asus_rfkill_wlan_ops = { | ||
655 | .set_block = asus_rfkill_wlan_set, | ||
656 | .query = asus_rfkill_query, | ||
657 | }; | ||
658 | |||
659 | static const struct rfkill_ops asus_rfkill_ops = { | ||
660 | .set_block = asus_rfkill_set, | ||
661 | .query = asus_rfkill_query, | ||
662 | }; | ||
663 | |||
664 | static int asus_new_rfkill(struct asus_wmi *asus, | ||
665 | struct asus_rfkill *arfkill, | ||
666 | const char *name, enum rfkill_type type, int dev_id) | ||
667 | { | ||
668 | int result = asus_wmi_get_devstate_simple(asus, dev_id); | ||
669 | struct rfkill **rfkill = &arfkill->rfkill; | ||
670 | |||
671 | if (result < 0) | ||
672 | return result; | ||
673 | |||
674 | arfkill->dev_id = dev_id; | ||
675 | arfkill->asus = asus; | ||
676 | |||
677 | if (dev_id == ASUS_WMI_DEVID_WLAN && asus->driver->hotplug_wireless) | ||
678 | *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type, | ||
679 | &asus_rfkill_wlan_ops, arfkill); | ||
680 | else | ||
681 | *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type, | ||
682 | &asus_rfkill_ops, arfkill); | ||
683 | |||
684 | if (!*rfkill) | ||
685 | return -EINVAL; | ||
686 | |||
687 | rfkill_init_sw_state(*rfkill, !result); | ||
688 | result = rfkill_register(*rfkill); | ||
689 | if (result) { | ||
690 | rfkill_destroy(*rfkill); | ||
691 | *rfkill = NULL; | ||
692 | return result; | ||
693 | } | ||
694 | return 0; | ||
695 | } | ||
696 | |||
697 | static void asus_wmi_rfkill_exit(struct asus_wmi *asus) | ||
698 | { | ||
699 | asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5"); | ||
700 | asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6"); | ||
701 | asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7"); | ||
702 | if (asus->wlan.rfkill) { | ||
703 | rfkill_unregister(asus->wlan.rfkill); | ||
704 | rfkill_destroy(asus->wlan.rfkill); | ||
705 | asus->wlan.rfkill = NULL; | ||
706 | } | ||
707 | /* | ||
708 | * Refresh pci hotplug in case the rfkill state was changed after | ||
709 | * asus_unregister_rfkill_notifier() | ||
710 | */ | ||
711 | asus_rfkill_hotplug(asus); | ||
712 | if (asus->hotplug_slot) | ||
713 | pci_hp_deregister(asus->hotplug_slot); | ||
714 | if (asus->hotplug_workqueue) | ||
715 | destroy_workqueue(asus->hotplug_workqueue); | ||
716 | |||
717 | if (asus->bluetooth.rfkill) { | ||
718 | rfkill_unregister(asus->bluetooth.rfkill); | ||
719 | rfkill_destroy(asus->bluetooth.rfkill); | ||
720 | asus->bluetooth.rfkill = NULL; | ||
721 | } | ||
722 | if (asus->wimax.rfkill) { | ||
723 | rfkill_unregister(asus->wimax.rfkill); | ||
724 | rfkill_destroy(asus->wimax.rfkill); | ||
725 | asus->wimax.rfkill = NULL; | ||
726 | } | ||
727 | if (asus->wwan3g.rfkill) { | ||
728 | rfkill_unregister(asus->wwan3g.rfkill); | ||
729 | rfkill_destroy(asus->wwan3g.rfkill); | ||
730 | asus->wwan3g.rfkill = NULL; | ||
731 | } | ||
732 | } | ||
733 | |||
734 | static int asus_wmi_rfkill_init(struct asus_wmi *asus) | ||
735 | { | ||
736 | int result = 0; | ||
737 | |||
738 | mutex_init(&asus->hotplug_lock); | ||
739 | mutex_init(&asus->wmi_lock); | ||
740 | |||
741 | result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan", | ||
742 | RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN); | ||
743 | |||
744 | if (result && result != -ENODEV) | ||
745 | goto exit; | ||
746 | |||
747 | result = asus_new_rfkill(asus, &asus->bluetooth, | ||
748 | "asus-bluetooth", RFKILL_TYPE_BLUETOOTH, | ||
749 | ASUS_WMI_DEVID_BLUETOOTH); | ||
750 | |||
751 | if (result && result != -ENODEV) | ||
752 | goto exit; | ||
753 | |||
754 | result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax", | ||
755 | RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX); | ||
756 | |||
757 | if (result && result != -ENODEV) | ||
758 | goto exit; | ||
759 | |||
760 | result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g", | ||
761 | RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G); | ||
762 | |||
763 | if (result && result != -ENODEV) | ||
764 | goto exit; | ||
765 | |||
766 | if (!asus->driver->hotplug_wireless) | ||
767 | goto exit; | ||
768 | |||
769 | result = asus_setup_pci_hotplug(asus); | ||
770 | /* | ||
771 | * If we get -EBUSY then something else is handling the PCI hotplug - | ||
772 | * don't fail in this case | ||
773 | */ | ||
774 | if (result == -EBUSY) | ||
775 | result = 0; | ||
776 | |||
777 | asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5"); | ||
778 | asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6"); | ||
779 | asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7"); | ||
780 | /* | ||
781 | * Refresh pci hotplug in case the rfkill state was changed during | ||
782 | * setup. | ||
783 | */ | ||
784 | asus_rfkill_hotplug(asus); | ||
785 | |||
786 | exit: | ||
787 | if (result && result != -ENODEV) | ||
788 | asus_wmi_rfkill_exit(asus); | ||
789 | |||
790 | if (result == -ENODEV) | ||
791 | result = 0; | ||
792 | |||
793 | return result; | ||
794 | } | ||
795 | |||
796 | /* | ||
797 | * Hwmon device | ||
798 | */ | ||
799 | static ssize_t asus_hwmon_pwm1(struct device *dev, | ||
800 | struct device_attribute *attr, | ||
801 | char *buf) | ||
802 | { | ||
803 | struct asus_wmi *asus = dev_get_drvdata(dev); | ||
804 | u32 value; | ||
805 | int err; | ||
806 | |||
807 | err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value); | ||
808 | |||
809 | if (err < 0) | ||
810 | return err; | ||
811 | |||
812 | value |= 0xFF; | ||
813 | |||
814 | if (value == 1) /* Low Speed */ | ||
815 | value = 85; | ||
816 | else if (value == 2) | ||
817 | value = 170; | ||
818 | else if (value == 3) | ||
819 | value = 255; | ||
820 | else if (value != 0) { | ||
821 | pr_err("Unknown fan speed %#x", value); | ||
822 | value = -1; | ||
823 | } | ||
824 | |||
825 | return sprintf(buf, "%d\n", value); | ||
826 | } | ||
827 | |||
828 | static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO, asus_hwmon_pwm1, NULL, 0); | ||
829 | |||
830 | static ssize_t | ||
831 | show_name(struct device *dev, struct device_attribute *attr, char *buf) | ||
832 | { | ||
833 | return sprintf(buf, "asus\n"); | ||
834 | } | ||
835 | static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0); | ||
836 | |||
837 | static struct attribute *hwmon_attributes[] = { | ||
838 | &sensor_dev_attr_pwm1.dev_attr.attr, | ||
839 | &sensor_dev_attr_name.dev_attr.attr, | ||
840 | NULL | ||
841 | }; | ||
842 | |||
843 | static mode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj, | ||
844 | struct attribute *attr, int idx) | ||
845 | { | ||
846 | struct device *dev = container_of(kobj, struct device, kobj); | ||
847 | struct platform_device *pdev = to_platform_device(dev->parent); | ||
848 | struct asus_wmi *asus = platform_get_drvdata(pdev); | ||
849 | bool ok = true; | ||
850 | int dev_id = -1; | ||
851 | u32 value = ASUS_WMI_UNSUPPORTED_METHOD; | ||
852 | |||
853 | if (attr == &sensor_dev_attr_pwm1.dev_attr.attr) | ||
854 | dev_id = ASUS_WMI_DEVID_FAN_CTRL; | ||
855 | |||
856 | if (dev_id != -1) { | ||
857 | int err = asus_wmi_get_devstate(asus, dev_id, &value); | ||
858 | |||
859 | if (err < 0) | ||
860 | return err; | ||
861 | } | ||
862 | |||
863 | if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) { | ||
864 | /* | ||
865 | * We need to find a better way, probably using sfun, | ||
866 | * bits or spec ... | ||
867 | * Currently we disable it if: | ||
868 | * - ASUS_WMI_UNSUPPORTED_METHOD is returned | ||
869 | * - reverved bits are non-zero | ||
870 | * - sfun and presence bit are not set | ||
871 | */ | ||
872 | if (value != ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000 | ||
873 | || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT))) | ||
874 | ok = false; | ||
875 | } | ||
876 | |||
877 | return ok ? attr->mode : 0; | ||
878 | } | ||
879 | |||
880 | static struct attribute_group hwmon_attribute_group = { | ||
881 | .is_visible = asus_hwmon_sysfs_is_visible, | ||
882 | .attrs = hwmon_attributes | ||
883 | }; | ||
884 | |||
885 | static void asus_wmi_hwmon_exit(struct asus_wmi *asus) | ||
886 | { | ||
887 | struct device *hwmon; | ||
888 | |||
889 | hwmon = asus->hwmon_device; | ||
890 | if (!hwmon) | ||
891 | return; | ||
892 | sysfs_remove_group(&hwmon->kobj, &hwmon_attribute_group); | ||
893 | hwmon_device_unregister(hwmon); | ||
894 | asus->hwmon_device = NULL; | ||
895 | } | ||
896 | |||
897 | static int asus_wmi_hwmon_init(struct asus_wmi *asus) | ||
898 | { | ||
899 | struct device *hwmon; | ||
900 | int result; | ||
901 | |||
902 | hwmon = hwmon_device_register(&asus->platform_device->dev); | ||
903 | if (IS_ERR(hwmon)) { | ||
904 | pr_err("Could not register asus hwmon device\n"); | ||
905 | return PTR_ERR(hwmon); | ||
906 | } | ||
907 | asus->hwmon_device = hwmon; | ||
908 | result = sysfs_create_group(&hwmon->kobj, &hwmon_attribute_group); | ||
909 | if (result) | ||
910 | asus_wmi_hwmon_exit(asus); | ||
911 | return result; | ||
912 | } | ||
913 | |||
914 | /* | ||
915 | * Backlight | ||
916 | */ | ||
917 | static int read_backlight_power(struct asus_wmi *asus) | ||
918 | { | ||
919 | int ret = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_BACKLIGHT); | ||
920 | |||
921 | if (ret < 0) | ||
922 | return ret; | ||
923 | |||
924 | return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN; | ||
925 | } | ||
926 | |||
927 | static int read_brightness_max(struct asus_wmi *asus) | ||
928 | { | ||
929 | u32 retval; | ||
930 | int err; | ||
931 | |||
932 | err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval); | ||
933 | |||
934 | if (err < 0) | ||
935 | return err; | ||
936 | |||
937 | retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK; | ||
938 | retval >>= 8; | ||
939 | |||
940 | if (!retval) | ||
941 | return -ENODEV; | ||
942 | |||
943 | return retval; | ||
944 | } | ||
945 | |||
946 | static int read_brightness(struct backlight_device *bd) | ||
947 | { | ||
948 | struct asus_wmi *asus = bl_get_data(bd); | ||
949 | u32 retval; | ||
950 | int err; | ||
951 | |||
952 | err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval); | ||
953 | |||
954 | if (err < 0) | ||
955 | return err; | ||
956 | |||
957 | return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK; | ||
958 | } | ||
959 | |||
960 | static int update_bl_status(struct backlight_device *bd) | ||
961 | { | ||
962 | struct asus_wmi *asus = bl_get_data(bd); | ||
963 | u32 ctrl_param; | ||
964 | int power, err; | ||
965 | |||
966 | ctrl_param = bd->props.brightness; | ||
967 | |||
968 | err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS, | ||
969 | ctrl_param, NULL); | ||
970 | |||
971 | if (err < 0) | ||
972 | return err; | ||
973 | |||
974 | power = read_backlight_power(asus); | ||
975 | if (power != -ENODEV && bd->props.power != power) { | ||
976 | ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK); | ||
977 | err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT, | ||
978 | ctrl_param, NULL); | ||
979 | } | ||
980 | return err; | ||
981 | } | ||
982 | |||
983 | static const struct backlight_ops asus_wmi_bl_ops = { | ||
984 | .get_brightness = read_brightness, | ||
985 | .update_status = update_bl_status, | ||
986 | }; | ||
987 | |||
988 | static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code) | ||
989 | { | ||
990 | struct backlight_device *bd = asus->backlight_device; | ||
991 | int old = bd->props.brightness; | ||
992 | int new = old; | ||
993 | |||
994 | if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX) | ||
995 | new = code - NOTIFY_BRNUP_MIN + 1; | ||
996 | else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX) | ||
997 | new = code - NOTIFY_BRNDOWN_MIN; | ||
998 | |||
999 | bd->props.brightness = new; | ||
1000 | backlight_update_status(bd); | ||
1001 | backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY); | ||
1002 | |||
1003 | return old; | ||
1004 | } | ||
1005 | |||
1006 | static int asus_wmi_backlight_init(struct asus_wmi *asus) | ||
1007 | { | ||
1008 | struct backlight_device *bd; | ||
1009 | struct backlight_properties props; | ||
1010 | int max; | ||
1011 | int power; | ||
1012 | |||
1013 | max = read_brightness_max(asus); | ||
1014 | |||
1015 | if (max == -ENODEV) | ||
1016 | max = 0; | ||
1017 | else if (max < 0) | ||
1018 | return max; | ||
1019 | |||
1020 | power = read_backlight_power(asus); | ||
1021 | |||
1022 | if (power == -ENODEV) | ||
1023 | power = FB_BLANK_UNBLANK; | ||
1024 | else if (power < 0) | ||
1025 | return power; | ||
1026 | |||
1027 | memset(&props, 0, sizeof(struct backlight_properties)); | ||
1028 | props.type = BACKLIGHT_PLATFORM; | ||
1029 | props.max_brightness = max; | ||
1030 | bd = backlight_device_register(asus->driver->name, | ||
1031 | &asus->platform_device->dev, asus, | ||
1032 | &asus_wmi_bl_ops, &props); | ||
1033 | if (IS_ERR(bd)) { | ||
1034 | pr_err("Could not register backlight device\n"); | ||
1035 | return PTR_ERR(bd); | ||
1036 | } | ||
1037 | |||
1038 | asus->backlight_device = bd; | ||
1039 | |||
1040 | bd->props.brightness = read_brightness(bd); | ||
1041 | bd->props.power = power; | ||
1042 | backlight_update_status(bd); | ||
1043 | |||
1044 | return 0; | ||
1045 | } | ||
1046 | |||
1047 | static void asus_wmi_backlight_exit(struct asus_wmi *asus) | ||
1048 | { | ||
1049 | if (asus->backlight_device) | ||
1050 | backlight_device_unregister(asus->backlight_device); | ||
1051 | |||
1052 | asus->backlight_device = NULL; | ||
1053 | } | ||
1054 | |||
1055 | static void asus_wmi_notify(u32 value, void *context) | ||
1056 | { | ||
1057 | struct asus_wmi *asus = context; | ||
1058 | struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
1059 | union acpi_object *obj; | ||
1060 | acpi_status status; | ||
1061 | int code; | ||
1062 | int orig_code; | ||
1063 | |||
1064 | status = wmi_get_event_data(value, &response); | ||
1065 | if (status != AE_OK) { | ||
1066 | pr_err("bad event status 0x%x\n", status); | ||
1067 | return; | ||
1068 | } | ||
1069 | |||
1070 | obj = (union acpi_object *)response.pointer; | ||
1071 | |||
1072 | if (!obj || obj->type != ACPI_TYPE_INTEGER) | ||
1073 | goto exit; | ||
1074 | |||
1075 | code = obj->integer.value; | ||
1076 | orig_code = code; | ||
1077 | |||
1078 | if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX) | ||
1079 | code = NOTIFY_BRNUP_MIN; | ||
1080 | else if (code >= NOTIFY_BRNDOWN_MIN && | ||
1081 | code <= NOTIFY_BRNDOWN_MAX) | ||
1082 | code = NOTIFY_BRNDOWN_MIN; | ||
1083 | |||
1084 | if (code == NOTIFY_BRNUP_MIN || code == NOTIFY_BRNDOWN_MIN) { | ||
1085 | if (!acpi_video_backlight_support()) | ||
1086 | asus_wmi_backlight_notify(asus, orig_code); | ||
1087 | } else if (!sparse_keymap_report_event(asus->inputdev, code, 1, true)) | ||
1088 | pr_info("Unknown key %x pressed\n", code); | ||
1089 | |||
1090 | exit: | ||
1091 | kfree(obj); | ||
1092 | } | ||
1093 | |||
1094 | /* | ||
1095 | * Sys helpers | ||
1096 | */ | ||
1097 | static int parse_arg(const char *buf, unsigned long count, int *val) | ||
1098 | { | ||
1099 | if (!count) | ||
1100 | return 0; | ||
1101 | if (sscanf(buf, "%i", val) != 1) | ||
1102 | return -EINVAL; | ||
1103 | return count; | ||
1104 | } | ||
1105 | |||
1106 | static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid, | ||
1107 | const char *buf, size_t count) | ||
1108 | { | ||
1109 | u32 retval; | ||
1110 | int rv, err, value; | ||
1111 | |||
1112 | value = asus_wmi_get_devstate_simple(asus, devid); | ||
1113 | if (value == -ENODEV) /* Check device presence */ | ||
1114 | return value; | ||
1115 | |||
1116 | rv = parse_arg(buf, count, &value); | ||
1117 | err = asus_wmi_set_devstate(devid, value, &retval); | ||
1118 | |||
1119 | if (err < 0) | ||
1120 | return err; | ||
1121 | |||
1122 | return rv; | ||
1123 | } | ||
1124 | |||
1125 | static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf) | ||
1126 | { | ||
1127 | int value = asus_wmi_get_devstate_simple(asus, devid); | ||
1128 | |||
1129 | if (value < 0) | ||
1130 | return value; | ||
1131 | |||
1132 | return sprintf(buf, "%d\n", value); | ||
1133 | } | ||
1134 | |||
1135 | #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm) \ | ||
1136 | static ssize_t show_##_name(struct device *dev, \ | ||
1137 | struct device_attribute *attr, \ | ||
1138 | char *buf) \ | ||
1139 | { \ | ||
1140 | struct asus_wmi *asus = dev_get_drvdata(dev); \ | ||
1141 | \ | ||
1142 | return show_sys_wmi(asus, _cm, buf); \ | ||
1143 | } \ | ||
1144 | static ssize_t store_##_name(struct device *dev, \ | ||
1145 | struct device_attribute *attr, \ | ||
1146 | const char *buf, size_t count) \ | ||
1147 | { \ | ||
1148 | struct asus_wmi *asus = dev_get_drvdata(dev); \ | ||
1149 | \ | ||
1150 | return store_sys_wmi(asus, _cm, buf, count); \ | ||
1151 | } \ | ||
1152 | static struct device_attribute dev_attr_##_name = { \ | ||
1153 | .attr = { \ | ||
1154 | .name = __stringify(_name), \ | ||
1155 | .mode = _mode }, \ | ||
1156 | .show = show_##_name, \ | ||
1157 | .store = store_##_name, \ | ||
1158 | } | ||
1159 | |||
1160 | ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD); | ||
1161 | ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA); | ||
1162 | ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER); | ||
1163 | |||
1164 | static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr, | ||
1165 | const char *buf, size_t count) | ||
1166 | { | ||
1167 | int value; | ||
1168 | |||
1169 | if (!count || sscanf(buf, "%i", &value) != 1) | ||
1170 | return -EINVAL; | ||
1171 | if (value < 0 || value > 2) | ||
1172 | return -EINVAL; | ||
1173 | |||
1174 | return asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL); | ||
1175 | } | ||
1176 | |||
1177 | static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv); | ||
1178 | |||
1179 | static struct attribute *platform_attributes[] = { | ||
1180 | &dev_attr_cpufv.attr, | ||
1181 | &dev_attr_camera.attr, | ||
1182 | &dev_attr_cardr.attr, | ||
1183 | &dev_attr_touchpad.attr, | ||
1184 | NULL | ||
1185 | }; | ||
1186 | |||
1187 | static mode_t asus_sysfs_is_visible(struct kobject *kobj, | ||
1188 | struct attribute *attr, int idx) | ||
1189 | { | ||
1190 | struct device *dev = container_of(kobj, struct device, kobj); | ||
1191 | struct platform_device *pdev = to_platform_device(dev); | ||
1192 | struct asus_wmi *asus = platform_get_drvdata(pdev); | ||
1193 | bool ok = true; | ||
1194 | int devid = -1; | ||
1195 | |||
1196 | if (attr == &dev_attr_camera.attr) | ||
1197 | devid = ASUS_WMI_DEVID_CAMERA; | ||
1198 | else if (attr == &dev_attr_cardr.attr) | ||
1199 | devid = ASUS_WMI_DEVID_CARDREADER; | ||
1200 | else if (attr == &dev_attr_touchpad.attr) | ||
1201 | devid = ASUS_WMI_DEVID_TOUCHPAD; | ||
1202 | |||
1203 | if (devid != -1) | ||
1204 | ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0); | ||
1205 | |||
1206 | return ok ? attr->mode : 0; | ||
1207 | } | ||
1208 | |||
1209 | static struct attribute_group platform_attribute_group = { | ||
1210 | .is_visible = asus_sysfs_is_visible, | ||
1211 | .attrs = platform_attributes | ||
1212 | }; | ||
1213 | |||
1214 | static void asus_wmi_sysfs_exit(struct platform_device *device) | ||
1215 | { | ||
1216 | sysfs_remove_group(&device->dev.kobj, &platform_attribute_group); | ||
1217 | } | ||
1218 | |||
1219 | static int asus_wmi_sysfs_init(struct platform_device *device) | ||
1220 | { | ||
1221 | return sysfs_create_group(&device->dev.kobj, &platform_attribute_group); | ||
1222 | } | ||
1223 | |||
1224 | /* | ||
1225 | * Platform device | ||
1226 | */ | ||
1227 | static int asus_wmi_platform_init(struct asus_wmi *asus) | ||
1228 | { | ||
1229 | int rv; | ||
1230 | |||
1231 | /* INIT enable hotkeys on some models */ | ||
1232 | if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv)) | ||
1233 | pr_info("Initialization: %#x", rv); | ||
1234 | |||
1235 | /* We don't know yet what to do with this version... */ | ||
1236 | if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) { | ||
1237 | pr_info("BIOS WMI version: %d.%d", rv >> 8, rv & 0xFF); | ||
1238 | asus->spec = rv; | ||
1239 | } | ||
1240 | |||
1241 | /* | ||
1242 | * The SFUN method probably allows the original driver to get the list | ||
1243 | * of features supported by a given model. For now, 0x0100 or 0x0800 | ||
1244 | * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card. | ||
1245 | * The significance of others is yet to be found. | ||
1246 | */ | ||
1247 | if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) { | ||
1248 | pr_info("SFUN value: %#x", rv); | ||
1249 | asus->sfun = rv; | ||
1250 | } | ||
1251 | |||
1252 | /* | ||
1253 | * Eee PC and Notebooks seems to have different method_id for DSTS, | ||
1254 | * but it may also be related to the BIOS's SPEC. | ||
1255 | * Note, on most Eeepc, there is no way to check if a method exist | ||
1256 | * or note, while on notebooks, they returns 0xFFFFFFFE on failure, | ||
1257 | * but once again, SPEC may probably be used for that kind of things. | ||
1258 | */ | ||
1259 | if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL)) | ||
1260 | asus->dsts_id = ASUS_WMI_METHODID_DSTS; | ||
1261 | else if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS2, 0, 0, NULL)) | ||
1262 | asus->dsts_id = ASUS_WMI_METHODID_DSTS2; | ||
1263 | |||
1264 | if (!asus->dsts_id) { | ||
1265 | pr_err("Can't find DSTS"); | ||
1266 | return -ENODEV; | ||
1267 | } | ||
1268 | |||
1269 | return asus_wmi_sysfs_init(asus->platform_device); | ||
1270 | } | ||
1271 | |||
1272 | static void asus_wmi_platform_exit(struct asus_wmi *asus) | ||
1273 | { | ||
1274 | asus_wmi_sysfs_exit(asus->platform_device); | ||
1275 | } | ||
1276 | |||
1277 | /* | ||
1278 | * debugfs | ||
1279 | */ | ||
1280 | struct asus_wmi_debugfs_node { | ||
1281 | struct asus_wmi *asus; | ||
1282 | char *name; | ||
1283 | int (*show) (struct seq_file *m, void *data); | ||
1284 | }; | ||
1285 | |||
1286 | static int show_dsts(struct seq_file *m, void *data) | ||
1287 | { | ||
1288 | struct asus_wmi *asus = m->private; | ||
1289 | int err; | ||
1290 | u32 retval = -1; | ||
1291 | |||
1292 | err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval); | ||
1293 | |||
1294 | if (err < 0) | ||
1295 | return err; | ||
1296 | |||
1297 | seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval); | ||
1298 | |||
1299 | return 0; | ||
1300 | } | ||
1301 | |||
1302 | static int show_devs(struct seq_file *m, void *data) | ||
1303 | { | ||
1304 | struct asus_wmi *asus = m->private; | ||
1305 | int err; | ||
1306 | u32 retval = -1; | ||
1307 | |||
1308 | err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param, | ||
1309 | &retval); | ||
1310 | |||
1311 | if (err < 0) | ||
1312 | return err; | ||
1313 | |||
1314 | seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id, | ||
1315 | asus->debug.ctrl_param, retval); | ||
1316 | |||
1317 | return 0; | ||
1318 | } | ||
1319 | |||
1320 | static int show_call(struct seq_file *m, void *data) | ||
1321 | { | ||
1322 | struct asus_wmi *asus = m->private; | ||
1323 | struct bios_args args = { | ||
1324 | .arg0 = asus->debug.dev_id, | ||
1325 | .arg1 = asus->debug.ctrl_param, | ||
1326 | }; | ||
1327 | struct acpi_buffer input = { (acpi_size) sizeof(args), &args }; | ||
1328 | struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL }; | ||
1329 | union acpi_object *obj; | ||
1330 | acpi_status status; | ||
1331 | |||
1332 | status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, | ||
1333 | 1, asus->debug.method_id, | ||
1334 | &input, &output); | ||
1335 | |||
1336 | if (ACPI_FAILURE(status)) | ||
1337 | return -EIO; | ||
1338 | |||
1339 | obj = (union acpi_object *)output.pointer; | ||
1340 | if (obj && obj->type == ACPI_TYPE_INTEGER) | ||
1341 | seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id, | ||
1342 | asus->debug.dev_id, asus->debug.ctrl_param, | ||
1343 | (u32) obj->integer.value); | ||
1344 | else | ||
1345 | seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id, | ||
1346 | asus->debug.dev_id, asus->debug.ctrl_param, | ||
1347 | obj ? obj->type : -1); | ||
1348 | |||
1349 | kfree(obj); | ||
1350 | |||
1351 | return 0; | ||
1352 | } | ||
1353 | |||
1354 | static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = { | ||
1355 | {NULL, "devs", show_devs}, | ||
1356 | {NULL, "dsts", show_dsts}, | ||
1357 | {NULL, "call", show_call}, | ||
1358 | }; | ||
1359 | |||
1360 | static int asus_wmi_debugfs_open(struct inode *inode, struct file *file) | ||
1361 | { | ||
1362 | struct asus_wmi_debugfs_node *node = inode->i_private; | ||
1363 | |||
1364 | return single_open(file, node->show, node->asus); | ||
1365 | } | ||
1366 | |||
1367 | static const struct file_operations asus_wmi_debugfs_io_ops = { | ||
1368 | .owner = THIS_MODULE, | ||
1369 | .open = asus_wmi_debugfs_open, | ||
1370 | .read = seq_read, | ||
1371 | .llseek = seq_lseek, | ||
1372 | .release = single_release, | ||
1373 | }; | ||
1374 | |||
1375 | static void asus_wmi_debugfs_exit(struct asus_wmi *asus) | ||
1376 | { | ||
1377 | debugfs_remove_recursive(asus->debug.root); | ||
1378 | } | ||
1379 | |||
1380 | static int asus_wmi_debugfs_init(struct asus_wmi *asus) | ||
1381 | { | ||
1382 | struct dentry *dent; | ||
1383 | int i; | ||
1384 | |||
1385 | asus->debug.root = debugfs_create_dir(asus->driver->name, NULL); | ||
1386 | if (!asus->debug.root) { | ||
1387 | pr_err("failed to create debugfs directory"); | ||
1388 | goto error_debugfs; | ||
1389 | } | ||
1390 | |||
1391 | dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR, | ||
1392 | asus->debug.root, &asus->debug.method_id); | ||
1393 | if (!dent) | ||
1394 | goto error_debugfs; | ||
1395 | |||
1396 | dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR, | ||
1397 | asus->debug.root, &asus->debug.dev_id); | ||
1398 | if (!dent) | ||
1399 | goto error_debugfs; | ||
1400 | |||
1401 | dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR, | ||
1402 | asus->debug.root, &asus->debug.ctrl_param); | ||
1403 | if (!dent) | ||
1404 | goto error_debugfs; | ||
1405 | |||
1406 | for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) { | ||
1407 | struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i]; | ||
1408 | |||
1409 | node->asus = asus; | ||
1410 | dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO, | ||
1411 | asus->debug.root, node, | ||
1412 | &asus_wmi_debugfs_io_ops); | ||
1413 | if (!dent) { | ||
1414 | pr_err("failed to create debug file: %s\n", node->name); | ||
1415 | goto error_debugfs; | ||
1416 | } | ||
1417 | } | ||
1418 | |||
1419 | return 0; | ||
1420 | |||
1421 | error_debugfs: | ||
1422 | asus_wmi_debugfs_exit(asus); | ||
1423 | return -ENOMEM; | ||
1424 | } | ||
1425 | |||
1426 | /* | ||
1427 | * WMI Driver | ||
1428 | */ | ||
1429 | static int asus_wmi_add(struct platform_device *pdev) | ||
1430 | { | ||
1431 | struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver); | ||
1432 | struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv); | ||
1433 | struct asus_wmi *asus; | ||
1434 | acpi_status status; | ||
1435 | int err; | ||
1436 | |||
1437 | asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL); | ||
1438 | if (!asus) | ||
1439 | return -ENOMEM; | ||
1440 | |||
1441 | asus->driver = wdrv; | ||
1442 | asus->platform_device = pdev; | ||
1443 | wdrv->platform_device = pdev; | ||
1444 | platform_set_drvdata(asus->platform_device, asus); | ||
1445 | |||
1446 | if (wdrv->quirks) | ||
1447 | wdrv->quirks(asus->driver); | ||
1448 | |||
1449 | err = asus_wmi_platform_init(asus); | ||
1450 | if (err) | ||
1451 | goto fail_platform; | ||
1452 | |||
1453 | err = asus_wmi_input_init(asus); | ||
1454 | if (err) | ||
1455 | goto fail_input; | ||
1456 | |||
1457 | err = asus_wmi_hwmon_init(asus); | ||
1458 | if (err) | ||
1459 | goto fail_hwmon; | ||
1460 | |||
1461 | err = asus_wmi_led_init(asus); | ||
1462 | if (err) | ||
1463 | goto fail_leds; | ||
1464 | |||
1465 | err = asus_wmi_rfkill_init(asus); | ||
1466 | if (err) | ||
1467 | goto fail_rfkill; | ||
1468 | |||
1469 | if (!acpi_video_backlight_support()) { | ||
1470 | err = asus_wmi_backlight_init(asus); | ||
1471 | if (err && err != -ENODEV) | ||
1472 | goto fail_backlight; | ||
1473 | } else | ||
1474 | pr_info("Backlight controlled by ACPI video driver\n"); | ||
1475 | |||
1476 | status = wmi_install_notify_handler(asus->driver->event_guid, | ||
1477 | asus_wmi_notify, asus); | ||
1478 | if (ACPI_FAILURE(status)) { | ||
1479 | pr_err("Unable to register notify handler - %d\n", status); | ||
1480 | err = -ENODEV; | ||
1481 | goto fail_wmi_handler; | ||
1482 | } | ||
1483 | |||
1484 | err = asus_wmi_debugfs_init(asus); | ||
1485 | if (err) | ||
1486 | goto fail_debugfs; | ||
1487 | |||
1488 | return 0; | ||
1489 | |||
1490 | fail_debugfs: | ||
1491 | wmi_remove_notify_handler(asus->driver->event_guid); | ||
1492 | fail_wmi_handler: | ||
1493 | asus_wmi_backlight_exit(asus); | ||
1494 | fail_backlight: | ||
1495 | asus_wmi_rfkill_exit(asus); | ||
1496 | fail_rfkill: | ||
1497 | asus_wmi_led_exit(asus); | ||
1498 | fail_leds: | ||
1499 | asus_wmi_hwmon_exit(asus); | ||
1500 | fail_hwmon: | ||
1501 | asus_wmi_input_exit(asus); | ||
1502 | fail_input: | ||
1503 | asus_wmi_platform_exit(asus); | ||
1504 | fail_platform: | ||
1505 | kfree(asus); | ||
1506 | return err; | ||
1507 | } | ||
1508 | |||
1509 | static int asus_wmi_remove(struct platform_device *device) | ||
1510 | { | ||
1511 | struct asus_wmi *asus; | ||
1512 | |||
1513 | asus = platform_get_drvdata(device); | ||
1514 | wmi_remove_notify_handler(asus->driver->event_guid); | ||
1515 | asus_wmi_backlight_exit(asus); | ||
1516 | asus_wmi_input_exit(asus); | ||
1517 | asus_wmi_hwmon_exit(asus); | ||
1518 | asus_wmi_led_exit(asus); | ||
1519 | asus_wmi_rfkill_exit(asus); | ||
1520 | asus_wmi_debugfs_exit(asus); | ||
1521 | asus_wmi_platform_exit(asus); | ||
1522 | |||
1523 | kfree(asus); | ||
1524 | return 0; | ||
1525 | } | ||
1526 | |||
1527 | /* | ||
1528 | * Platform driver - hibernate/resume callbacks | ||
1529 | */ | ||
1530 | static int asus_hotk_thaw(struct device *device) | ||
1531 | { | ||
1532 | struct asus_wmi *asus = dev_get_drvdata(device); | ||
1533 | |||
1534 | if (asus->wlan.rfkill) { | ||
1535 | bool wlan; | ||
1536 | |||
1537 | /* | ||
1538 | * Work around bios bug - acpi _PTS turns off the wireless led | ||
1539 | * during suspend. Normally it restores it on resume, but | ||
1540 | * we should kick it ourselves in case hibernation is aborted. | ||
1541 | */ | ||
1542 | wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN); | ||
1543 | asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL); | ||
1544 | } | ||
1545 | |||
1546 | return 0; | ||
1547 | } | ||
1548 | |||
1549 | static int asus_hotk_restore(struct device *device) | ||
1550 | { | ||
1551 | struct asus_wmi *asus = dev_get_drvdata(device); | ||
1552 | int bl; | ||
1553 | |||
1554 | /* Refresh both wlan rfkill state and pci hotplug */ | ||
1555 | if (asus->wlan.rfkill) | ||
1556 | asus_rfkill_hotplug(asus); | ||
1557 | |||
1558 | if (asus->bluetooth.rfkill) { | ||
1559 | bl = !asus_wmi_get_devstate_simple(asus, | ||
1560 | ASUS_WMI_DEVID_BLUETOOTH); | ||
1561 | rfkill_set_sw_state(asus->bluetooth.rfkill, bl); | ||
1562 | } | ||
1563 | if (asus->wimax.rfkill) { | ||
1564 | bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX); | ||
1565 | rfkill_set_sw_state(asus->wimax.rfkill, bl); | ||
1566 | } | ||
1567 | if (asus->wwan3g.rfkill) { | ||
1568 | bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G); | ||
1569 | rfkill_set_sw_state(asus->wwan3g.rfkill, bl); | ||
1570 | } | ||
1571 | |||
1572 | return 0; | ||
1573 | } | ||
1574 | |||
1575 | static const struct dev_pm_ops asus_pm_ops = { | ||
1576 | .thaw = asus_hotk_thaw, | ||
1577 | .restore = asus_hotk_restore, | ||
1578 | }; | ||
1579 | |||
1580 | static int asus_wmi_probe(struct platform_device *pdev) | ||
1581 | { | ||
1582 | struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver); | ||
1583 | struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv); | ||
1584 | int ret; | ||
1585 | |||
1586 | if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) { | ||
1587 | pr_warn("Management GUID not found\n"); | ||
1588 | return -ENODEV; | ||
1589 | } | ||
1590 | |||
1591 | if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) { | ||
1592 | pr_warn("Event GUID not found\n"); | ||
1593 | return -ENODEV; | ||
1594 | } | ||
1595 | |||
1596 | if (wdrv->probe) { | ||
1597 | ret = wdrv->probe(pdev); | ||
1598 | if (ret) | ||
1599 | return ret; | ||
1600 | } | ||
1601 | |||
1602 | return asus_wmi_add(pdev); | ||
1603 | } | ||
1604 | |||
1605 | static bool used; | ||
1606 | |||
1607 | int asus_wmi_register_driver(struct asus_wmi_driver *driver) | ||
1608 | { | ||
1609 | struct platform_driver *platform_driver; | ||
1610 | struct platform_device *platform_device; | ||
1611 | |||
1612 | if (used) | ||
1613 | return -EBUSY; | ||
1614 | |||
1615 | platform_driver = &driver->platform_driver; | ||
1616 | platform_driver->remove = asus_wmi_remove; | ||
1617 | platform_driver->driver.owner = driver->owner; | ||
1618 | platform_driver->driver.name = driver->name; | ||
1619 | platform_driver->driver.pm = &asus_pm_ops; | ||
1620 | |||
1621 | platform_device = platform_create_bundle(platform_driver, | ||
1622 | asus_wmi_probe, | ||
1623 | NULL, 0, NULL, 0); | ||
1624 | if (IS_ERR(platform_device)) | ||
1625 | return PTR_ERR(platform_device); | ||
1626 | |||
1627 | used = true; | ||
1628 | return 0; | ||
1629 | } | ||
1630 | EXPORT_SYMBOL_GPL(asus_wmi_register_driver); | ||
1631 | |||
1632 | void asus_wmi_unregister_driver(struct asus_wmi_driver *driver) | ||
1633 | { | ||
1634 | platform_device_unregister(driver->platform_device); | ||
1635 | platform_driver_unregister(&driver->platform_driver); | ||
1636 | used = false; | ||
1637 | } | ||
1638 | EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver); | ||
1639 | |||
1640 | static int __init asus_wmi_init(void) | ||
1641 | { | ||
1642 | if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) { | ||
1643 | pr_info("Asus Management GUID not found"); | ||
1644 | return -ENODEV; | ||
1645 | } | ||
1646 | |||
1647 | pr_info("ASUS WMI generic driver loaded"); | ||
1648 | return 0; | ||
1649 | } | ||
1650 | |||
1651 | static void __exit asus_wmi_exit(void) | ||
1652 | { | ||
1653 | pr_info("ASUS WMI generic driver unloaded"); | ||
1654 | } | ||
1655 | |||
1656 | module_init(asus_wmi_init); | ||
1657 | module_exit(asus_wmi_exit); | ||