?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
ARM: 7409/1: Do not call flush_cache_user_range with mmap_sem held
[linux/fpc-iii.git] / drivers / platform / x86 / asus-wmi.c
blobe1678b90083f909f38abcdc3bcb7308948b21fc9
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 dev_set_drvdata(hwmon, asus);
908 asus->hwmon_device = hwmon;
909 result = sysfs_create_group(&hwmon->kobj, &hwmon_attribute_group);
910 if (result)
911 asus_wmi_hwmon_exit(asus);
912 return result;
913 }
914
915 /*
916 * Backlight
917 */
918 static int read_backlight_power(struct asus_wmi *asus)
919 {
920 int ret = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_BACKLIGHT);
921
922 if (ret < 0)
923 return ret;
924
925 return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
926 }
927
928 static int read_brightness_max(struct asus_wmi *asus)
929 {
930 u32 retval;
931 int err;
932
933 err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
934
935 if (err < 0)
936 return err;
937
938 retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
939 retval >>= 8;
940
941 if (!retval)
942 return -ENODEV;
943
944 return retval;
945 }
946
947 static int read_brightness(struct backlight_device *bd)
948 {
949 struct asus_wmi *asus = bl_get_data(bd);
950 u32 retval;
951 int err;
952
953 err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
954
955 if (err < 0)
956 return err;
957
958 return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
959 }
960
961 static int update_bl_status(struct backlight_device *bd)
962 {
963 struct asus_wmi *asus = bl_get_data(bd);
964 u32 ctrl_param;
965 int power, err;
966
967 ctrl_param = bd->props.brightness;
968
969 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
970 ctrl_param, NULL);
971
972 if (err < 0)
973 return err;
974
975 power = read_backlight_power(asus);
976 if (power != -ENODEV && bd->props.power != power) {
977 ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
978 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
979 ctrl_param, NULL);
980 }
981 return err;
982 }
983
984 static const struct backlight_ops asus_wmi_bl_ops = {
985 .get_brightness = read_brightness,
986 .update_status = update_bl_status,
987 };
988
989 static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
990 {
991 struct backlight_device *bd = asus->backlight_device;
992 int old = bd->props.brightness;
993 int new = old;
994
995 if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
996 new = code - NOTIFY_BRNUP_MIN + 1;
997 else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
998 new = code - NOTIFY_BRNDOWN_MIN;
999
1000 bd->props.brightness = new;
1001 backlight_update_status(bd);
1002 backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1003
1004 return old;
1005 }
1006
1007 static int asus_wmi_backlight_init(struct asus_wmi *asus)
1008 {
1009 struct backlight_device *bd;
1010 struct backlight_properties props;
1011 int max;
1012 int power;
1013
1014 max = read_brightness_max(asus);
1015
1016 if (max == -ENODEV)
1017 max = 0;
1018 else if (max < 0)
1019 return max;
1020
1021 power = read_backlight_power(asus);
1022
1023 if (power == -ENODEV)
1024 power = FB_BLANK_UNBLANK;
1025 else if (power < 0)
1026 return power;
1027
1028 memset(&props, 0, sizeof(struct backlight_properties));
1029 props.type = BACKLIGHT_PLATFORM;
1030 props.max_brightness = max;
1031 bd = backlight_device_register(asus->driver->name,
1032 &asus->platform_device->dev, asus,
1033 &asus_wmi_bl_ops, &props);
1034 if (IS_ERR(bd)) {
1035 pr_err("Could not register backlight device\n");
1036 return PTR_ERR(bd);
1037 }
1038
1039 asus->backlight_device = bd;
1040
1041 bd->props.brightness = read_brightness(bd);
1042 bd->props.power = power;
1043 backlight_update_status(bd);
1044
1045 return 0;
1046 }
1047
1048 static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1049 {
1050 if (asus->backlight_device)
1051 backlight_device_unregister(asus->backlight_device);
1052
1053 asus->backlight_device = NULL;
1054 }
1055
1056 static void asus_wmi_notify(u32 value, void *context)
1057 {
1058 struct asus_wmi *asus = context;
1059 struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1060 union acpi_object *obj;
1061 acpi_status status;
1062 int code;
1063 int orig_code;
1064
1065 status = wmi_get_event_data(value, &response);
1066 if (status != AE_OK) {
1067 pr_err("bad event status 0x%x\n", status);
1068 return;
1069 }
1070
1071 obj = (union acpi_object *)response.pointer;
1072
1073 if (!obj || obj->type != ACPI_TYPE_INTEGER)
1074 goto exit;
1075
1076 code = obj->integer.value;
1077 orig_code = code;
1078
1079 if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1080 code = NOTIFY_BRNUP_MIN;
1081 else if (code >= NOTIFY_BRNDOWN_MIN &&
1082 code <= NOTIFY_BRNDOWN_MAX)
1083 code = NOTIFY_BRNDOWN_MIN;
1084
1085 if (code == NOTIFY_BRNUP_MIN || code == NOTIFY_BRNDOWN_MIN) {
1086 if (!acpi_video_backlight_support())
1087 asus_wmi_backlight_notify(asus, orig_code);
1088 } else if (!sparse_keymap_report_event(asus->inputdev, code, 1, true))
1089 pr_info("Unknown key %x pressed\n", code);
1090
1091 exit:
1092 kfree(obj);
1093 }
1094
1095 /*
1096 * Sys helpers
1097 */
1098 static int parse_arg(const char *buf, unsigned long count, int *val)
1099 {
1100 if (!count)
1101 return 0;
1102 if (sscanf(buf, "%i", val) != 1)
1103 return -EINVAL;
1104 return count;
1105 }
1106
1107 static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1108 const char *buf, size_t count)
1109 {
1110 u32 retval;
1111 int rv, err, value;
1112
1113 value = asus_wmi_get_devstate_simple(asus, devid);
1114 if (value == -ENODEV) /* Check device presence */
1115 return value;
1116
1117 rv = parse_arg(buf, count, &value);
1118 err = asus_wmi_set_devstate(devid, value, &retval);
1119
1120 if (err < 0)
1121 return err;
1122
1123 return rv;
1124 }
1125
1126 static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1127 {
1128 int value = asus_wmi_get_devstate_simple(asus, devid);
1129
1130 if (value < 0)
1131 return value;
1132
1133 return sprintf(buf, "%d\n", value);
1134 }
1135
1136 #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm) \
1137 static ssize_t show_##_name(struct device *dev, \
1138 struct device_attribute *attr, \
1139 char *buf) \
1140 { \
1141 struct asus_wmi *asus = dev_get_drvdata(dev); \
1142 \
1143 return show_sys_wmi(asus, _cm, buf); \
1144 } \
1145 static ssize_t store_##_name(struct device *dev, \
1146 struct device_attribute *attr, \
1147 const char *buf, size_t count) \
1148 { \
1149 struct asus_wmi *asus = dev_get_drvdata(dev); \
1150 \
1151 return store_sys_wmi(asus, _cm, buf, count); \
1152 } \
1153 static struct device_attribute dev_attr_##_name = { \
1154 .attr = { \
1155 .name = __stringify(_name), \
1156 .mode = _mode }, \
1157 .show = show_##_name, \
1158 .store = store_##_name, \
1159 }
1160
1161 ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1162 ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1163 ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
1164
1165 static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr,
1166 const char *buf, size_t count)
1167 {
1168 int value, rv;
1169
1170 if (!count || sscanf(buf, "%i", &value) != 1)
1171 return -EINVAL;
1172 if (value < 0 || value > 2)
1173 return -EINVAL;
1174
1175 rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1176 if (rv < 0)
1177 return rv;
1178
1179 return count;
1180 }
1181
1182 static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv);
1183
1184 static struct attribute *platform_attributes[] = {
1185 &dev_attr_cpufv.attr,
1186 &dev_attr_camera.attr,
1187 &dev_attr_cardr.attr,
1188 &dev_attr_touchpad.attr,
1189 NULL
1190 };
1191
1192 static mode_t asus_sysfs_is_visible(struct kobject *kobj,
1193 struct attribute *attr, int idx)
1194 {
1195 struct device *dev = container_of(kobj, struct device, kobj);
1196 struct platform_device *pdev = to_platform_device(dev);
1197 struct asus_wmi *asus = platform_get_drvdata(pdev);
1198 bool ok = true;
1199 int devid = -1;
1200
1201 if (attr == &dev_attr_camera.attr)
1202 devid = ASUS_WMI_DEVID_CAMERA;
1203 else if (attr == &dev_attr_cardr.attr)
1204 devid = ASUS_WMI_DEVID_CARDREADER;
1205 else if (attr == &dev_attr_touchpad.attr)
1206 devid = ASUS_WMI_DEVID_TOUCHPAD;
1207
1208 if (devid != -1)
1209 ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1210
1211 return ok ? attr->mode : 0;
1212 }
1213
1214 static struct attribute_group platform_attribute_group = {
1215 .is_visible = asus_sysfs_is_visible,
1216 .attrs = platform_attributes
1217 };
1218
1219 static void asus_wmi_sysfs_exit(struct platform_device *device)
1220 {
1221 sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1222 }
1223
1224 static int asus_wmi_sysfs_init(struct platform_device *device)
1225 {
1226 return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1227 }
1228
1229 /*
1230 * Platform device
1231 */
1232 static int asus_wmi_platform_init(struct asus_wmi *asus)
1233 {
1234 int rv;
1235
1236 /* INIT enable hotkeys on some models */
1237 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1238 pr_info("Initialization: %#x", rv);
1239
1240 /* We don't know yet what to do with this version... */
1241 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1242 pr_info("BIOS WMI version: %d.%d", rv >> 8, rv & 0xFF);
1243 asus->spec = rv;
1244 }
1245
1246 /*
1247 * The SFUN method probably allows the original driver to get the list
1248 * of features supported by a given model. For now, 0x0100 or 0x0800
1249 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1250 * The significance of others is yet to be found.
1251 */
1252 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1253 pr_info("SFUN value: %#x", rv);
1254 asus->sfun = rv;
1255 }
1256
1257 /*
1258 * Eee PC and Notebooks seems to have different method_id for DSTS,
1259 * but it may also be related to the BIOS's SPEC.
1260 * Note, on most Eeepc, there is no way to check if a method exist
1261 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1262 * but once again, SPEC may probably be used for that kind of things.
1263 */
1264 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
1265 asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1266 else if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS2, 0, 0, NULL))
1267 asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1268
1269 if (!asus->dsts_id) {
1270 pr_err("Can't find DSTS");
1271 return -ENODEV;
1272 }
1273
1274 return asus_wmi_sysfs_init(asus->platform_device);
1275 }
1276
1277 static void asus_wmi_platform_exit(struct asus_wmi *asus)
1278 {
1279 asus_wmi_sysfs_exit(asus->platform_device);
1280 }
1281
1282 /*
1283 * debugfs
1284 */
1285 struct asus_wmi_debugfs_node {
1286 struct asus_wmi *asus;
1287 char *name;
1288 int (*show) (struct seq_file *m, void *data);
1289 };
1290
1291 static int show_dsts(struct seq_file *m, void *data)
1292 {
1293 struct asus_wmi *asus = m->private;
1294 int err;
1295 u32 retval = -1;
1296
1297 err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1298
1299 if (err < 0)
1300 return err;
1301
1302 seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1303
1304 return 0;
1305 }
1306
1307 static int show_devs(struct seq_file *m, void *data)
1308 {
1309 struct asus_wmi *asus = m->private;
1310 int err;
1311 u32 retval = -1;
1312
1313 err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
1314 &retval);
1315
1316 if (err < 0)
1317 return err;
1318
1319 seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1320 asus->debug.ctrl_param, retval);
1321
1322 return 0;
1323 }
1324
1325 static int show_call(struct seq_file *m, void *data)
1326 {
1327 struct asus_wmi *asus = m->private;
1328 struct bios_args args = {
1329 .arg0 = asus->debug.dev_id,
1330 .arg1 = asus->debug.ctrl_param,
1331 };
1332 struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1333 struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
1334 union acpi_object *obj;
1335 acpi_status status;
1336
1337 status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
1338 1, asus->debug.method_id,
1339 &input, &output);
1340
1341 if (ACPI_FAILURE(status))
1342 return -EIO;
1343
1344 obj = (union acpi_object *)output.pointer;
1345 if (obj && obj->type == ACPI_TYPE_INTEGER)
1346 seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
1347 asus->debug.dev_id, asus->debug.ctrl_param,
1348 (u32) obj->integer.value);
1349 else
1350 seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
1351 asus->debug.dev_id, asus->debug.ctrl_param,
1352 obj ? obj->type : -1);
1353
1354 kfree(obj);
1355
1356 return 0;
1357 }
1358
1359 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
1360 {NULL, "devs", show_devs},
1361 {NULL, "dsts", show_dsts},
1362 {NULL, "call", show_call},
1363 };
1364
1365 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
1366 {
1367 struct asus_wmi_debugfs_node *node = inode->i_private;
1368
1369 return single_open(file, node->show, node->asus);
1370 }
1371
1372 static const struct file_operations asus_wmi_debugfs_io_ops = {
1373 .owner = THIS_MODULE,
1374 .open = asus_wmi_debugfs_open,
1375 .read = seq_read,
1376 .llseek = seq_lseek,
1377 .release = single_release,
1378 };
1379
1380 static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
1381 {
1382 debugfs_remove_recursive(asus->debug.root);
1383 }
1384
1385 static int asus_wmi_debugfs_init(struct asus_wmi *asus)
1386 {
1387 struct dentry *dent;
1388 int i;
1389
1390 asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
1391 if (!asus->debug.root) {
1392 pr_err("failed to create debugfs directory");
1393 goto error_debugfs;
1394 }
1395
1396 dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
1397 asus->debug.root, &asus->debug.method_id);
1398 if (!dent)
1399 goto error_debugfs;
1400
1401 dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
1402 asus->debug.root, &asus->debug.dev_id);
1403 if (!dent)
1404 goto error_debugfs;
1405
1406 dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
1407 asus->debug.root, &asus->debug.ctrl_param);
1408 if (!dent)
1409 goto error_debugfs;
1410
1411 for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
1412 struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
1413
1414 node->asus = asus;
1415 dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
1416 asus->debug.root, node,
1417 &asus_wmi_debugfs_io_ops);
1418 if (!dent) {
1419 pr_err("failed to create debug file: %s\n", node->name);
1420 goto error_debugfs;
1421 }
1422 }
1423
1424 return 0;
1425
1426 error_debugfs:
1427 asus_wmi_debugfs_exit(asus);
1428 return -ENOMEM;
1429 }
1430
1431 /*
1432 * WMI Driver
1433 */
1434 static int asus_wmi_add(struct platform_device *pdev)
1435 {
1436 struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1437 struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1438 struct asus_wmi *asus;
1439 acpi_status status;
1440 int err;
1441
1442 asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
1443 if (!asus)
1444 return -ENOMEM;
1445
1446 asus->driver = wdrv;
1447 asus->platform_device = pdev;
1448 wdrv->platform_device = pdev;
1449 platform_set_drvdata(asus->platform_device, asus);
1450
1451 if (wdrv->quirks)
1452 wdrv->quirks(asus->driver);
1453
1454 err = asus_wmi_platform_init(asus);
1455 if (err)
1456 goto fail_platform;
1457
1458 err = asus_wmi_input_init(asus);
1459 if (err)
1460 goto fail_input;
1461
1462 err = asus_wmi_hwmon_init(asus);
1463 if (err)
1464 goto fail_hwmon;
1465
1466 err = asus_wmi_led_init(asus);
1467 if (err)
1468 goto fail_leds;
1469
1470 err = asus_wmi_rfkill_init(asus);
1471 if (err)
1472 goto fail_rfkill;
1473
1474 if (!acpi_video_backlight_support()) {
1475 err = asus_wmi_backlight_init(asus);
1476 if (err && err != -ENODEV)
1477 goto fail_backlight;
1478 } else
1479 pr_info("Backlight controlled by ACPI video driver\n");
1480
1481 status = wmi_install_notify_handler(asus->driver->event_guid,
1482 asus_wmi_notify, asus);
1483 if (ACPI_FAILURE(status)) {
1484 pr_err("Unable to register notify handler - %d\n", status);
1485 err = -ENODEV;
1486 goto fail_wmi_handler;
1487 }
1488
1489 err = asus_wmi_debugfs_init(asus);
1490 if (err)
1491 goto fail_debugfs;
1492
1493 return 0;
1494
1495 fail_debugfs:
1496 wmi_remove_notify_handler(asus->driver->event_guid);
1497 fail_wmi_handler:
1498 asus_wmi_backlight_exit(asus);
1499 fail_backlight:
1500 asus_wmi_rfkill_exit(asus);
1501 fail_rfkill:
1502 asus_wmi_led_exit(asus);
1503 fail_leds:
1504 asus_wmi_hwmon_exit(asus);
1505 fail_hwmon:
1506 asus_wmi_input_exit(asus);
1507 fail_input:
1508 asus_wmi_platform_exit(asus);
1509 fail_platform:
1510 kfree(asus);
1511 return err;
1512 }
1513
1514 static int asus_wmi_remove(struct platform_device *device)
1515 {
1516 struct asus_wmi *asus;
1517
1518 asus = platform_get_drvdata(device);
1519 wmi_remove_notify_handler(asus->driver->event_guid);
1520 asus_wmi_backlight_exit(asus);
1521 asus_wmi_input_exit(asus);
1522 asus_wmi_hwmon_exit(asus);
1523 asus_wmi_led_exit(asus);
1524 asus_wmi_rfkill_exit(asus);
1525 asus_wmi_debugfs_exit(asus);
1526 asus_wmi_platform_exit(asus);
1527
1528 kfree(asus);
1529 return 0;
1530 }
1531
1532 /*
1533 * Platform driver - hibernate/resume callbacks
1534 */
1535 static int asus_hotk_thaw(struct device *device)
1536 {
1537 struct asus_wmi *asus = dev_get_drvdata(device);
1538
1539 if (asus->wlan.rfkill) {
1540 bool wlan;
1541
1542 /*
1543 * Work around bios bug - acpi _PTS turns off the wireless led
1544 * during suspend. Normally it restores it on resume, but
1545 * we should kick it ourselves in case hibernation is aborted.
1546 */
1547 wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
1548 asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
1549 }
1550
1551 return 0;
1552 }
1553
1554 static int asus_hotk_restore(struct device *device)
1555 {
1556 struct asus_wmi *asus = dev_get_drvdata(device);
1557 int bl;
1558
1559 /* Refresh both wlan rfkill state and pci hotplug */
1560 if (asus->wlan.rfkill)
1561 asus_rfkill_hotplug(asus);
1562
1563 if (asus->bluetooth.rfkill) {
1564 bl = !asus_wmi_get_devstate_simple(asus,
1565 ASUS_WMI_DEVID_BLUETOOTH);
1566 rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
1567 }
1568 if (asus->wimax.rfkill) {
1569 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
1570 rfkill_set_sw_state(asus->wimax.rfkill, bl);
1571 }
1572 if (asus->wwan3g.rfkill) {
1573 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
1574 rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
1575 }
1576
1577 return 0;
1578 }
1579
1580 static const struct dev_pm_ops asus_pm_ops = {
1581 .thaw = asus_hotk_thaw,
1582 .restore = asus_hotk_restore,
1583 };
1584
1585 static int asus_wmi_probe(struct platform_device *pdev)
1586 {
1587 struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1588 struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1589 int ret;
1590
1591 if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1592 pr_warn("Management GUID not found\n");
1593 return -ENODEV;
1594 }
1595
1596 if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
1597 pr_warn("Event GUID not found\n");
1598 return -ENODEV;
1599 }
1600
1601 if (wdrv->probe) {
1602 ret = wdrv->probe(pdev);
1603 if (ret)
1604 return ret;
1605 }
1606
1607 return asus_wmi_add(pdev);
1608 }
1609
1610 static bool used;
1611
1612 int asus_wmi_register_driver(struct asus_wmi_driver *driver)
1613 {
1614 struct platform_driver *platform_driver;
1615 struct platform_device *platform_device;
1616
1617 if (used)
1618 return -EBUSY;
1619
1620 platform_driver = &driver->platform_driver;
1621 platform_driver->remove = asus_wmi_remove;
1622 platform_driver->driver.owner = driver->owner;
1623 platform_driver->driver.name = driver->name;
1624 platform_driver->driver.pm = &asus_pm_ops;
1625
1626 platform_device = platform_create_bundle(platform_driver,
1627 asus_wmi_probe,
1628 NULL, 0, NULL, 0);
1629 if (IS_ERR(platform_device))
1630 return PTR_ERR(platform_device);
1631
1632 used = true;
1633 return 0;
1634 }
1635 EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
1636
1637 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
1638 {
1639 platform_device_unregister(driver->platform_device);
1640 platform_driver_unregister(&driver->platform_driver);
1641 used = false;
1642 }
1643 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
1644
1645 static int __init asus_wmi_init(void)
1646 {
1647 if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1648 pr_info("Asus Management GUID not found");
1649 return -ENODEV;
1650 }
1651
1652 pr_info("ASUS WMI generic driver loaded");
1653 return 0;
1654 }
1655
1656 static void __exit asus_wmi_exit(void)
1657 {
1658 pr_info("ASUS WMI generic driver unloaded");
1659 }
1660
1661 module_init(asus_wmi_init);
1662 module_exit(asus_wmi_exit);
Linux with added FPC-III support