Merge tag 'reset-for-v5.3' of git://git.pengutronix.de/git/pza/linux into arm/drivers
[sfrench/cifs-2.6.git] / drivers / platform / x86 / asus-wmi.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Asus PC WMI hotkey driver
4  *
5  * Copyright(C) 2010 Intel Corporation.
6  * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com>
7  *
8  * Portions based on wistron_btns.c:
9  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
10  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
11  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
12  */
13
14 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
15
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/init.h>
19 #include <linux/types.h>
20 #include <linux/slab.h>
21 #include <linux/input.h>
22 #include <linux/input/sparse-keymap.h>
23 #include <linux/fb.h>
24 #include <linux/backlight.h>
25 #include <linux/leds.h>
26 #include <linux/rfkill.h>
27 #include <linux/pci.h>
28 #include <linux/pci_hotplug.h>
29 #include <linux/hwmon.h>
30 #include <linux/hwmon-sysfs.h>
31 #include <linux/debugfs.h>
32 #include <linux/seq_file.h>
33 #include <linux/platform_data/x86/asus-wmi.h>
34 #include <linux/platform_device.h>
35 #include <linux/thermal.h>
36 #include <linux/acpi.h>
37 #include <linux/dmi.h>
38 #include <acpi/video.h>
39
40 #include "asus-wmi.h"
41
42 MODULE_AUTHOR("Corentin Chary <corentin.chary@gmail.com>, "
43               "Yong Wang <yong.y.wang@intel.com>");
44 MODULE_DESCRIPTION("Asus Generic WMI Driver");
45 MODULE_LICENSE("GPL");
46
47 #define to_asus_wmi_driver(pdrv)                                        \
48         (container_of((pdrv), struct asus_wmi_driver, platform_driver))
49
50 #define ASUS_WMI_MGMT_GUID      "97845ED0-4E6D-11DE-8A39-0800200C9A66"
51
52 #define NOTIFY_BRNUP_MIN                0x11
53 #define NOTIFY_BRNUP_MAX                0x1f
54 #define NOTIFY_BRNDOWN_MIN              0x20
55 #define NOTIFY_BRNDOWN_MAX              0x2e
56 #define NOTIFY_FNLOCK_TOGGLE            0x4e
57 #define NOTIFY_KBD_BRTUP                0xc4
58 #define NOTIFY_KBD_BRTDWN               0xc5
59 #define NOTIFY_KBD_BRTTOGGLE            0xc7
60
61 #define ASUS_WMI_FNLOCK_BIOS_DISABLED   BIT(0)
62
63 #define ASUS_FAN_DESC                   "cpu_fan"
64 #define ASUS_FAN_MFUN                   0x13
65 #define ASUS_FAN_SFUN_READ              0x06
66 #define ASUS_FAN_SFUN_WRITE             0x07
67 #define ASUS_FAN_CTRL_MANUAL            1
68 #define ASUS_FAN_CTRL_AUTO              2
69
70 #define USB_INTEL_XUSB2PR               0xD0
71 #define PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI   0x9c31
72
73 static const char * const ashs_ids[] = { "ATK4001", "ATK4002", NULL };
74
75 static bool ashs_present(void)
76 {
77         int i = 0;
78         while (ashs_ids[i]) {
79                 if (acpi_dev_found(ashs_ids[i++]))
80                         return true;
81         }
82         return false;
83 }
84
85 struct bios_args {
86         u32 arg0;
87         u32 arg1;
88 } __packed;
89
90 /*
91  * Struct that's used for all methods called via AGFN. Naming is
92  * identically to the AML code.
93  */
94 struct agfn_args {
95         u16 mfun; /* probably "Multi-function" to be called */
96         u16 sfun; /* probably "Sub-function" to be called */
97         u16 len;  /* size of the hole struct, including subfunction fields */
98         u8 stas;  /* not used by now */
99         u8 err;   /* zero on success */
100 } __packed;
101
102 /* struct used for calling fan read and write methods */
103 struct fan_args {
104         struct agfn_args agfn;  /* common fields */
105         u8 fan;                 /* fan number: 0: set auto mode 1: 1st fan */
106         u32 speed;              /* read: RPM/100 - write: 0-255 */
107 } __packed;
108
109 /*
110  * <platform>/    - debugfs root directory
111  *   dev_id      - current dev_id
112  *   ctrl_param  - current ctrl_param
113  *   method_id   - current method_id
114  *   devs        - call DEVS(dev_id, ctrl_param) and print result
115  *   dsts        - call DSTS(dev_id)  and print result
116  *   call        - call method_id(dev_id, ctrl_param) and print result
117  */
118 struct asus_wmi_debug {
119         struct dentry *root;
120         u32 method_id;
121         u32 dev_id;
122         u32 ctrl_param;
123 };
124
125 struct asus_rfkill {
126         struct asus_wmi *asus;
127         struct rfkill *rfkill;
128         u32 dev_id;
129 };
130
131 struct asus_wmi {
132         int dsts_id;
133         int spec;
134         int sfun;
135
136         struct input_dev *inputdev;
137         struct backlight_device *backlight_device;
138         struct platform_device *platform_device;
139
140         struct led_classdev wlan_led;
141         int wlan_led_wk;
142         struct led_classdev tpd_led;
143         int tpd_led_wk;
144         struct led_classdev kbd_led;
145         int kbd_led_wk;
146         struct led_classdev lightbar_led;
147         int lightbar_led_wk;
148         struct workqueue_struct *led_workqueue;
149         struct work_struct tpd_led_work;
150         struct work_struct wlan_led_work;
151         struct work_struct lightbar_led_work;
152
153         struct asus_rfkill wlan;
154         struct asus_rfkill bluetooth;
155         struct asus_rfkill wimax;
156         struct asus_rfkill wwan3g;
157         struct asus_rfkill gps;
158         struct asus_rfkill uwb;
159
160         bool asus_hwmon_fan_manual_mode;
161         int asus_hwmon_num_fans;
162         int asus_hwmon_pwm;
163
164         struct hotplug_slot hotplug_slot;
165         struct mutex hotplug_lock;
166         struct mutex wmi_lock;
167         struct workqueue_struct *hotplug_workqueue;
168         struct work_struct hotplug_work;
169
170         bool fnlock_locked;
171
172         struct asus_wmi_debug debug;
173
174         struct asus_wmi_driver *driver;
175 };
176
177 static int asus_wmi_input_init(struct asus_wmi *asus)
178 {
179         int err;
180
181         asus->inputdev = input_allocate_device();
182         if (!asus->inputdev)
183                 return -ENOMEM;
184
185         asus->inputdev->name = asus->driver->input_name;
186         asus->inputdev->phys = asus->driver->input_phys;
187         asus->inputdev->id.bustype = BUS_HOST;
188         asus->inputdev->dev.parent = &asus->platform_device->dev;
189         set_bit(EV_REP, asus->inputdev->evbit);
190
191         err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
192         if (err)
193                 goto err_free_dev;
194
195         err = input_register_device(asus->inputdev);
196         if (err)
197                 goto err_free_dev;
198
199         return 0;
200
201 err_free_dev:
202         input_free_device(asus->inputdev);
203         return err;
204 }
205
206 static void asus_wmi_input_exit(struct asus_wmi *asus)
207 {
208         if (asus->inputdev)
209                 input_unregister_device(asus->inputdev);
210
211         asus->inputdev = NULL;
212 }
213
214 int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1, u32 *retval)
215 {
216         struct bios_args args = {
217                 .arg0 = arg0,
218                 .arg1 = arg1,
219         };
220         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
221         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
222         acpi_status status;
223         union acpi_object *obj;
224         u32 tmp = 0;
225
226         status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 0, method_id,
227                                      &input, &output);
228
229         if (ACPI_FAILURE(status))
230                 goto exit;
231
232         obj = (union acpi_object *)output.pointer;
233         if (obj && obj->type == ACPI_TYPE_INTEGER)
234                 tmp = (u32) obj->integer.value;
235
236         if (retval)
237                 *retval = tmp;
238
239         kfree(obj);
240
241 exit:
242         if (ACPI_FAILURE(status))
243                 return -EIO;
244
245         if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
246                 return -ENODEV;
247
248         return 0;
249 }
250 EXPORT_SYMBOL_GPL(asus_wmi_evaluate_method);
251
252 static int asus_wmi_evaluate_method_agfn(const struct acpi_buffer args)
253 {
254         struct acpi_buffer input;
255         u64 phys_addr;
256         u32 retval;
257         u32 status = -1;
258
259         /*
260          * Copy to dma capable address otherwise memory corruption occurs as
261          * bios has to be able to access it.
262          */
263         input.pointer = kzalloc(args.length, GFP_DMA | GFP_KERNEL);
264         input.length = args.length;
265         if (!input.pointer)
266                 return -ENOMEM;
267         phys_addr = virt_to_phys(input.pointer);
268         memcpy(input.pointer, args.pointer, args.length);
269
270         status = asus_wmi_evaluate_method(ASUS_WMI_METHODID_AGFN,
271                                         phys_addr, 0, &retval);
272         if (!status)
273                 memcpy(args.pointer, input.pointer, args.length);
274
275         kfree(input.pointer);
276         if (status)
277                 return -ENXIO;
278
279         return retval;
280 }
281
282 static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
283 {
284         return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
285 }
286
287 static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
288                                  u32 *retval)
289 {
290         return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
291                                         ctrl_param, retval);
292 }
293
294 /* Helper for special devices with magic return codes */
295 static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
296                                       u32 dev_id, u32 mask)
297 {
298         u32 retval = 0;
299         int err;
300
301         err = asus_wmi_get_devstate(asus, dev_id, &retval);
302
303         if (err < 0)
304                 return err;
305
306         if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
307                 return -ENODEV;
308
309         if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
310                 if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
311                         return -ENODEV;
312         }
313
314         return retval & mask;
315 }
316
317 static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
318 {
319         return asus_wmi_get_devstate_bits(asus, dev_id,
320                                           ASUS_WMI_DSTS_STATUS_BIT);
321 }
322
323 /*
324  * LEDs
325  */
326 /*
327  * These functions actually update the LED's, and are called from a
328  * workqueue. By doing this as separate work rather than when the LED
329  * subsystem asks, we avoid messing with the Asus ACPI stuff during a
330  * potentially bad time, such as a timer interrupt.
331  */
332 static void tpd_led_update(struct work_struct *work)
333 {
334         int ctrl_param;
335         struct asus_wmi *asus;
336
337         asus = container_of(work, struct asus_wmi, tpd_led_work);
338
339         ctrl_param = asus->tpd_led_wk;
340         asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
341 }
342
343 static void tpd_led_set(struct led_classdev *led_cdev,
344                         enum led_brightness value)
345 {
346         struct asus_wmi *asus;
347
348         asus = container_of(led_cdev, struct asus_wmi, tpd_led);
349
350         asus->tpd_led_wk = !!value;
351         queue_work(asus->led_workqueue, &asus->tpd_led_work);
352 }
353
354 static int read_tpd_led_state(struct asus_wmi *asus)
355 {
356         return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
357 }
358
359 static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
360 {
361         struct asus_wmi *asus;
362
363         asus = container_of(led_cdev, struct asus_wmi, tpd_led);
364
365         return read_tpd_led_state(asus);
366 }
367
368 static void kbd_led_update(struct asus_wmi *asus)
369 {
370         int ctrl_param = 0;
371
372         /*
373          * bits 0-2: level
374          * bit 7: light on/off
375          */
376         if (asus->kbd_led_wk > 0)
377                 ctrl_param = 0x80 | (asus->kbd_led_wk & 0x7F);
378
379         asus_wmi_set_devstate(ASUS_WMI_DEVID_KBD_BACKLIGHT, ctrl_param, NULL);
380 }
381
382 static int kbd_led_read(struct asus_wmi *asus, int *level, int *env)
383 {
384         int retval;
385
386         /*
387          * bits 0-2: level
388          * bit 7: light on/off
389          * bit 8-10: environment (0: dark, 1: normal, 2: light)
390          * bit 17: status unknown
391          */
392         retval = asus_wmi_get_devstate_bits(asus, ASUS_WMI_DEVID_KBD_BACKLIGHT,
393                                             0xFFFF);
394
395         /* Unknown status is considered as off */
396         if (retval == 0x8000)
397                 retval = 0;
398
399         if (retval >= 0) {
400                 if (level)
401                         *level = retval & 0x7F;
402                 if (env)
403                         *env = (retval >> 8) & 0x7F;
404                 retval = 0;
405         }
406
407         return retval;
408 }
409
410 static void do_kbd_led_set(struct led_classdev *led_cdev, int value)
411 {
412         struct asus_wmi *asus;
413         int max_level;
414
415         asus = container_of(led_cdev, struct asus_wmi, kbd_led);
416         max_level = asus->kbd_led.max_brightness;
417
418         if (value > max_level)
419                 value = max_level;
420         else if (value < 0)
421                 value = 0;
422
423         asus->kbd_led_wk = value;
424         kbd_led_update(asus);
425 }
426
427 static void kbd_led_set(struct led_classdev *led_cdev,
428                         enum led_brightness value)
429 {
430         do_kbd_led_set(led_cdev, value);
431 }
432
433 static void kbd_led_set_by_kbd(struct asus_wmi *asus, enum led_brightness value)
434 {
435         struct led_classdev *led_cdev = &asus->kbd_led;
436
437         do_kbd_led_set(led_cdev, value);
438         led_classdev_notify_brightness_hw_changed(led_cdev, asus->kbd_led_wk);
439 }
440
441 static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
442 {
443         struct asus_wmi *asus;
444         int retval, value;
445
446         asus = container_of(led_cdev, struct asus_wmi, kbd_led);
447
448         retval = kbd_led_read(asus, &value, NULL);
449
450         if (retval < 0)
451                 return retval;
452
453         return value;
454 }
455
456 static int wlan_led_unknown_state(struct asus_wmi *asus)
457 {
458         u32 result;
459
460         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
461
462         return result & ASUS_WMI_DSTS_UNKNOWN_BIT;
463 }
464
465 static int wlan_led_presence(struct asus_wmi *asus)
466 {
467         u32 result;
468
469         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
470
471         return result & ASUS_WMI_DSTS_PRESENCE_BIT;
472 }
473
474 static void wlan_led_update(struct work_struct *work)
475 {
476         int ctrl_param;
477         struct asus_wmi *asus;
478
479         asus = container_of(work, struct asus_wmi, wlan_led_work);
480
481         ctrl_param = asus->wlan_led_wk;
482         asus_wmi_set_devstate(ASUS_WMI_DEVID_WIRELESS_LED, ctrl_param, NULL);
483 }
484
485 static void wlan_led_set(struct led_classdev *led_cdev,
486                          enum led_brightness value)
487 {
488         struct asus_wmi *asus;
489
490         asus = container_of(led_cdev, struct asus_wmi, wlan_led);
491
492         asus->wlan_led_wk = !!value;
493         queue_work(asus->led_workqueue, &asus->wlan_led_work);
494 }
495
496 static enum led_brightness wlan_led_get(struct led_classdev *led_cdev)
497 {
498         struct asus_wmi *asus;
499         u32 result;
500
501         asus = container_of(led_cdev, struct asus_wmi, wlan_led);
502         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
503
504         return result & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
505 }
506
507 static void lightbar_led_update(struct work_struct *work)
508 {
509         struct asus_wmi *asus;
510         int ctrl_param;
511
512         asus = container_of(work, struct asus_wmi, lightbar_led_work);
513
514         ctrl_param = asus->lightbar_led_wk;
515         asus_wmi_set_devstate(ASUS_WMI_DEVID_LIGHTBAR, ctrl_param, NULL);
516 }
517
518 static void lightbar_led_set(struct led_classdev *led_cdev,
519                              enum led_brightness value)
520 {
521         struct asus_wmi *asus;
522
523         asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
524
525         asus->lightbar_led_wk = !!value;
526         queue_work(asus->led_workqueue, &asus->lightbar_led_work);
527 }
528
529 static enum led_brightness lightbar_led_get(struct led_classdev *led_cdev)
530 {
531         struct asus_wmi *asus;
532         u32 result;
533
534         asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
535         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_LIGHTBAR, &result);
536
537         return result & ASUS_WMI_DSTS_LIGHTBAR_MASK;
538 }
539
540 static int lightbar_led_presence(struct asus_wmi *asus)
541 {
542         u32 result;
543
544         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_LIGHTBAR, &result);
545
546         return result & ASUS_WMI_DSTS_PRESENCE_BIT;
547 }
548
549 static void asus_wmi_led_exit(struct asus_wmi *asus)
550 {
551         if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
552                 led_classdev_unregister(&asus->kbd_led);
553         if (!IS_ERR_OR_NULL(asus->tpd_led.dev))
554                 led_classdev_unregister(&asus->tpd_led);
555         if (!IS_ERR_OR_NULL(asus->wlan_led.dev))
556                 led_classdev_unregister(&asus->wlan_led);
557         if (!IS_ERR_OR_NULL(asus->lightbar_led.dev))
558                 led_classdev_unregister(&asus->lightbar_led);
559         if (asus->led_workqueue)
560                 destroy_workqueue(asus->led_workqueue);
561 }
562
563 static int asus_wmi_led_init(struct asus_wmi *asus)
564 {
565         int rv = 0, led_val;
566
567         asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
568         if (!asus->led_workqueue)
569                 return -ENOMEM;
570
571         if (read_tpd_led_state(asus) >= 0) {
572                 INIT_WORK(&asus->tpd_led_work, tpd_led_update);
573
574                 asus->tpd_led.name = "asus::touchpad";
575                 asus->tpd_led.brightness_set = tpd_led_set;
576                 asus->tpd_led.brightness_get = tpd_led_get;
577                 asus->tpd_led.max_brightness = 1;
578
579                 rv = led_classdev_register(&asus->platform_device->dev,
580                                            &asus->tpd_led);
581                 if (rv)
582                         goto error;
583         }
584
585         led_val = kbd_led_read(asus, NULL, NULL);
586         if (led_val >= 0) {
587                 asus->kbd_led_wk = led_val;
588                 asus->kbd_led.name = "asus::kbd_backlight";
589                 asus->kbd_led.flags = LED_BRIGHT_HW_CHANGED;
590                 asus->kbd_led.brightness_set = kbd_led_set;
591                 asus->kbd_led.brightness_get = kbd_led_get;
592                 asus->kbd_led.max_brightness = 3;
593
594                 rv = led_classdev_register(&asus->platform_device->dev,
595                                            &asus->kbd_led);
596                 if (rv)
597                         goto error;
598         }
599
600         if (wlan_led_presence(asus) && (asus->driver->quirks->wapf > 0)) {
601                 INIT_WORK(&asus->wlan_led_work, wlan_led_update);
602
603                 asus->wlan_led.name = "asus::wlan";
604                 asus->wlan_led.brightness_set = wlan_led_set;
605                 if (!wlan_led_unknown_state(asus))
606                         asus->wlan_led.brightness_get = wlan_led_get;
607                 asus->wlan_led.flags = LED_CORE_SUSPENDRESUME;
608                 asus->wlan_led.max_brightness = 1;
609                 asus->wlan_led.default_trigger = "asus-wlan";
610
611                 rv = led_classdev_register(&asus->platform_device->dev,
612                                            &asus->wlan_led);
613                 if (rv)
614                         goto error;
615         }
616
617         if (lightbar_led_presence(asus)) {
618                 INIT_WORK(&asus->lightbar_led_work, lightbar_led_update);
619
620                 asus->lightbar_led.name = "asus::lightbar";
621                 asus->lightbar_led.brightness_set = lightbar_led_set;
622                 asus->lightbar_led.brightness_get = lightbar_led_get;
623                 asus->lightbar_led.max_brightness = 1;
624
625                 rv = led_classdev_register(&asus->platform_device->dev,
626                                            &asus->lightbar_led);
627         }
628
629 error:
630         if (rv)
631                 asus_wmi_led_exit(asus);
632
633         return rv;
634 }
635
636
637 /*
638  * PCI hotplug (for wlan rfkill)
639  */
640 static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
641 {
642         int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
643
644         if (result < 0)
645                 return false;
646         return !result;
647 }
648
649 static void asus_rfkill_hotplug(struct asus_wmi *asus)
650 {
651         struct pci_dev *dev;
652         struct pci_bus *bus;
653         bool blocked;
654         bool absent;
655         u32 l;
656
657         mutex_lock(&asus->wmi_lock);
658         blocked = asus_wlan_rfkill_blocked(asus);
659         mutex_unlock(&asus->wmi_lock);
660
661         mutex_lock(&asus->hotplug_lock);
662         pci_lock_rescan_remove();
663
664         if (asus->wlan.rfkill)
665                 rfkill_set_sw_state(asus->wlan.rfkill, blocked);
666
667         if (asus->hotplug_slot.ops) {
668                 bus = pci_find_bus(0, 1);
669                 if (!bus) {
670                         pr_warn("Unable to find PCI bus 1?\n");
671                         goto out_unlock;
672                 }
673
674                 if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
675                         pr_err("Unable to read PCI config space?\n");
676                         goto out_unlock;
677                 }
678                 absent = (l == 0xffffffff);
679
680                 if (blocked != absent) {
681                         pr_warn("BIOS says wireless lan is %s, "
682                                 "but the pci device is %s\n",
683                                 blocked ? "blocked" : "unblocked",
684                                 absent ? "absent" : "present");
685                         pr_warn("skipped wireless hotplug as probably "
686                                 "inappropriate for this model\n");
687                         goto out_unlock;
688                 }
689
690                 if (!blocked) {
691                         dev = pci_get_slot(bus, 0);
692                         if (dev) {
693                                 /* Device already present */
694                                 pci_dev_put(dev);
695                                 goto out_unlock;
696                         }
697                         dev = pci_scan_single_device(bus, 0);
698                         if (dev) {
699                                 pci_bus_assign_resources(bus);
700                                 pci_bus_add_device(dev);
701                         }
702                 } else {
703                         dev = pci_get_slot(bus, 0);
704                         if (dev) {
705                                 pci_stop_and_remove_bus_device(dev);
706                                 pci_dev_put(dev);
707                         }
708                 }
709         }
710
711 out_unlock:
712         pci_unlock_rescan_remove();
713         mutex_unlock(&asus->hotplug_lock);
714 }
715
716 static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
717 {
718         struct asus_wmi *asus = data;
719
720         if (event != ACPI_NOTIFY_BUS_CHECK)
721                 return;
722
723         /*
724          * We can't call directly asus_rfkill_hotplug because most
725          * of the time WMBC is still being executed and not reetrant.
726          * There is currently no way to tell ACPICA that  we want this
727          * method to be serialized, we schedule a asus_rfkill_hotplug
728          * call later, in a safer context.
729          */
730         queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
731 }
732
733 static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
734 {
735         acpi_status status;
736         acpi_handle handle;
737
738         status = acpi_get_handle(NULL, node, &handle);
739
740         if (ACPI_SUCCESS(status)) {
741                 status = acpi_install_notify_handler(handle,
742                                                      ACPI_SYSTEM_NOTIFY,
743                                                      asus_rfkill_notify, asus);
744                 if (ACPI_FAILURE(status))
745                         pr_warn("Failed to register notify on %s\n", node);
746         } else
747                 return -ENODEV;
748
749         return 0;
750 }
751
752 static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
753 {
754         acpi_status status = AE_OK;
755         acpi_handle handle;
756
757         status = acpi_get_handle(NULL, node, &handle);
758
759         if (ACPI_SUCCESS(status)) {
760                 status = acpi_remove_notify_handler(handle,
761                                                     ACPI_SYSTEM_NOTIFY,
762                                                     asus_rfkill_notify);
763                 if (ACPI_FAILURE(status))
764                         pr_err("Error removing rfkill notify handler %s\n",
765                                node);
766         }
767 }
768
769 static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
770                                    u8 *value)
771 {
772         struct asus_wmi *asus = container_of(hotplug_slot,
773                                              struct asus_wmi, hotplug_slot);
774         int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
775
776         if (result < 0)
777                 return result;
778
779         *value = !!result;
780         return 0;
781 }
782
783 static const struct hotplug_slot_ops asus_hotplug_slot_ops = {
784         .get_adapter_status = asus_get_adapter_status,
785         .get_power_status = asus_get_adapter_status,
786 };
787
788 static void asus_hotplug_work(struct work_struct *work)
789 {
790         struct asus_wmi *asus;
791
792         asus = container_of(work, struct asus_wmi, hotplug_work);
793         asus_rfkill_hotplug(asus);
794 }
795
796 static int asus_setup_pci_hotplug(struct asus_wmi *asus)
797 {
798         int ret = -ENOMEM;
799         struct pci_bus *bus = pci_find_bus(0, 1);
800
801         if (!bus) {
802                 pr_err("Unable to find wifi PCI bus\n");
803                 return -ENODEV;
804         }
805
806         asus->hotplug_workqueue =
807             create_singlethread_workqueue("hotplug_workqueue");
808         if (!asus->hotplug_workqueue)
809                 goto error_workqueue;
810
811         INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
812
813         asus->hotplug_slot.ops = &asus_hotplug_slot_ops;
814
815         ret = pci_hp_register(&asus->hotplug_slot, bus, 0, "asus-wifi");
816         if (ret) {
817                 pr_err("Unable to register hotplug slot - %d\n", ret);
818                 goto error_register;
819         }
820
821         return 0;
822
823 error_register:
824         asus->hotplug_slot.ops = NULL;
825         destroy_workqueue(asus->hotplug_workqueue);
826 error_workqueue:
827         return ret;
828 }
829
830 /*
831  * Rfkill devices
832  */
833 static int asus_rfkill_set(void *data, bool blocked)
834 {
835         struct asus_rfkill *priv = data;
836         u32 ctrl_param = !blocked;
837         u32 dev_id = priv->dev_id;
838
839         /*
840          * If the user bit is set, BIOS can't set and record the wlan status,
841          * it will report the value read from id ASUS_WMI_DEVID_WLAN_LED
842          * while we query the wlan status through WMI(ASUS_WMI_DEVID_WLAN).
843          * So, we have to record wlan status in id ASUS_WMI_DEVID_WLAN_LED
844          * while setting the wlan status through WMI.
845          * This is also the behavior that windows app will do.
846          */
847         if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
848              priv->asus->driver->wlan_ctrl_by_user)
849                 dev_id = ASUS_WMI_DEVID_WLAN_LED;
850
851         return asus_wmi_set_devstate(dev_id, ctrl_param, NULL);
852 }
853
854 static void asus_rfkill_query(struct rfkill *rfkill, void *data)
855 {
856         struct asus_rfkill *priv = data;
857         int result;
858
859         result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
860
861         if (result < 0)
862                 return;
863
864         rfkill_set_sw_state(priv->rfkill, !result);
865 }
866
867 static int asus_rfkill_wlan_set(void *data, bool blocked)
868 {
869         struct asus_rfkill *priv = data;
870         struct asus_wmi *asus = priv->asus;
871         int ret;
872
873         /*
874          * This handler is enabled only if hotplug is enabled.
875          * In this case, the asus_wmi_set_devstate() will
876          * trigger a wmi notification and we need to wait
877          * this call to finish before being able to call
878          * any wmi method
879          */
880         mutex_lock(&asus->wmi_lock);
881         ret = asus_rfkill_set(data, blocked);
882         mutex_unlock(&asus->wmi_lock);
883         return ret;
884 }
885
886 static const struct rfkill_ops asus_rfkill_wlan_ops = {
887         .set_block = asus_rfkill_wlan_set,
888         .query = asus_rfkill_query,
889 };
890
891 static const struct rfkill_ops asus_rfkill_ops = {
892         .set_block = asus_rfkill_set,
893         .query = asus_rfkill_query,
894 };
895
896 static int asus_new_rfkill(struct asus_wmi *asus,
897                            struct asus_rfkill *arfkill,
898                            const char *name, enum rfkill_type type, int dev_id)
899 {
900         int result = asus_wmi_get_devstate_simple(asus, dev_id);
901         struct rfkill **rfkill = &arfkill->rfkill;
902
903         if (result < 0)
904                 return result;
905
906         arfkill->dev_id = dev_id;
907         arfkill->asus = asus;
908
909         if (dev_id == ASUS_WMI_DEVID_WLAN &&
910             asus->driver->quirks->hotplug_wireless)
911                 *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
912                                        &asus_rfkill_wlan_ops, arfkill);
913         else
914                 *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
915                                        &asus_rfkill_ops, arfkill);
916
917         if (!*rfkill)
918                 return -EINVAL;
919
920         if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
921                         (asus->driver->quirks->wapf > 0))
922                 rfkill_set_led_trigger_name(*rfkill, "asus-wlan");
923
924         rfkill_init_sw_state(*rfkill, !result);
925         result = rfkill_register(*rfkill);
926         if (result) {
927                 rfkill_destroy(*rfkill);
928                 *rfkill = NULL;
929                 return result;
930         }
931         return 0;
932 }
933
934 static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
935 {
936         if (asus->driver->wlan_ctrl_by_user && ashs_present())
937                 return;
938
939         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
940         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
941         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
942         if (asus->wlan.rfkill) {
943                 rfkill_unregister(asus->wlan.rfkill);
944                 rfkill_destroy(asus->wlan.rfkill);
945                 asus->wlan.rfkill = NULL;
946         }
947         /*
948          * Refresh pci hotplug in case the rfkill state was changed after
949          * asus_unregister_rfkill_notifier()
950          */
951         asus_rfkill_hotplug(asus);
952         if (asus->hotplug_slot.ops)
953                 pci_hp_deregister(&asus->hotplug_slot);
954         if (asus->hotplug_workqueue)
955                 destroy_workqueue(asus->hotplug_workqueue);
956
957         if (asus->bluetooth.rfkill) {
958                 rfkill_unregister(asus->bluetooth.rfkill);
959                 rfkill_destroy(asus->bluetooth.rfkill);
960                 asus->bluetooth.rfkill = NULL;
961         }
962         if (asus->wimax.rfkill) {
963                 rfkill_unregister(asus->wimax.rfkill);
964                 rfkill_destroy(asus->wimax.rfkill);
965                 asus->wimax.rfkill = NULL;
966         }
967         if (asus->wwan3g.rfkill) {
968                 rfkill_unregister(asus->wwan3g.rfkill);
969                 rfkill_destroy(asus->wwan3g.rfkill);
970                 asus->wwan3g.rfkill = NULL;
971         }
972         if (asus->gps.rfkill) {
973                 rfkill_unregister(asus->gps.rfkill);
974                 rfkill_destroy(asus->gps.rfkill);
975                 asus->gps.rfkill = NULL;
976         }
977         if (asus->uwb.rfkill) {
978                 rfkill_unregister(asus->uwb.rfkill);
979                 rfkill_destroy(asus->uwb.rfkill);
980                 asus->uwb.rfkill = NULL;
981         }
982 }
983
984 static int asus_wmi_rfkill_init(struct asus_wmi *asus)
985 {
986         int result = 0;
987
988         mutex_init(&asus->hotplug_lock);
989         mutex_init(&asus->wmi_lock);
990
991         result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
992                                  RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
993
994         if (result && result != -ENODEV)
995                 goto exit;
996
997         result = asus_new_rfkill(asus, &asus->bluetooth,
998                                  "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
999                                  ASUS_WMI_DEVID_BLUETOOTH);
1000
1001         if (result && result != -ENODEV)
1002                 goto exit;
1003
1004         result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
1005                                  RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
1006
1007         if (result && result != -ENODEV)
1008                 goto exit;
1009
1010         result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
1011                                  RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
1012
1013         if (result && result != -ENODEV)
1014                 goto exit;
1015
1016         result = asus_new_rfkill(asus, &asus->gps, "asus-gps",
1017                                  RFKILL_TYPE_GPS, ASUS_WMI_DEVID_GPS);
1018
1019         if (result && result != -ENODEV)
1020                 goto exit;
1021
1022         result = asus_new_rfkill(asus, &asus->uwb, "asus-uwb",
1023                                  RFKILL_TYPE_UWB, ASUS_WMI_DEVID_UWB);
1024
1025         if (result && result != -ENODEV)
1026                 goto exit;
1027
1028         if (!asus->driver->quirks->hotplug_wireless)
1029                 goto exit;
1030
1031         result = asus_setup_pci_hotplug(asus);
1032         /*
1033          * If we get -EBUSY then something else is handling the PCI hotplug -
1034          * don't fail in this case
1035          */
1036         if (result == -EBUSY)
1037                 result = 0;
1038
1039         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
1040         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
1041         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1042         /*
1043          * Refresh pci hotplug in case the rfkill state was changed during
1044          * setup.
1045          */
1046         asus_rfkill_hotplug(asus);
1047
1048 exit:
1049         if (result && result != -ENODEV)
1050                 asus_wmi_rfkill_exit(asus);
1051
1052         if (result == -ENODEV)
1053                 result = 0;
1054
1055         return result;
1056 }
1057
1058 static void asus_wmi_set_xusb2pr(struct asus_wmi *asus)
1059 {
1060         struct pci_dev *xhci_pdev;
1061         u32 orig_ports_available;
1062         u32 ports_available = asus->driver->quirks->xusb2pr;
1063
1064         xhci_pdev = pci_get_device(PCI_VENDOR_ID_INTEL,
1065                         PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI,
1066                         NULL);
1067
1068         if (!xhci_pdev)
1069                 return;
1070
1071         pci_read_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1072                                 &orig_ports_available);
1073
1074         pci_write_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1075                                 cpu_to_le32(ports_available));
1076
1077         pr_info("set USB_INTEL_XUSB2PR old: 0x%04x, new: 0x%04x\n",
1078                         orig_ports_available, ports_available);
1079 }
1080
1081 /*
1082  * Some devices dont support or have borcken get_als method
1083  * but still support set method.
1084  */
1085 static void asus_wmi_set_als(void)
1086 {
1087         asus_wmi_set_devstate(ASUS_WMI_DEVID_ALS_ENABLE, 1, NULL);
1088 }
1089
1090 /*
1091  * Hwmon device
1092  */
1093 static int asus_hwmon_agfn_fan_speed_read(struct asus_wmi *asus, int fan,
1094                                           int *speed)
1095 {
1096         struct fan_args args = {
1097                 .agfn.len = sizeof(args),
1098                 .agfn.mfun = ASUS_FAN_MFUN,
1099                 .agfn.sfun = ASUS_FAN_SFUN_READ,
1100                 .fan = fan,
1101                 .speed = 0,
1102         };
1103         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1104         int status;
1105
1106         if (fan != 1)
1107                 return -EINVAL;
1108
1109         status = asus_wmi_evaluate_method_agfn(input);
1110
1111         if (status || args.agfn.err)
1112                 return -ENXIO;
1113
1114         if (speed)
1115                 *speed = args.speed;
1116
1117         return 0;
1118 }
1119
1120 static int asus_hwmon_agfn_fan_speed_write(struct asus_wmi *asus, int fan,
1121                                      int *speed)
1122 {
1123         struct fan_args args = {
1124                 .agfn.len = sizeof(args),
1125                 .agfn.mfun = ASUS_FAN_MFUN,
1126                 .agfn.sfun = ASUS_FAN_SFUN_WRITE,
1127                 .fan = fan,
1128                 .speed = speed ?  *speed : 0,
1129         };
1130         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1131         int status;
1132
1133         /* 1: for setting 1st fan's speed 0: setting auto mode */
1134         if (fan != 1 && fan != 0)
1135                 return -EINVAL;
1136
1137         status = asus_wmi_evaluate_method_agfn(input);
1138
1139         if (status || args.agfn.err)
1140                 return -ENXIO;
1141
1142         if (speed && fan == 1)
1143                 asus->asus_hwmon_pwm = *speed;
1144
1145         return 0;
1146 }
1147
1148 /*
1149  * Check if we can read the speed of one fan. If true we assume we can also
1150  * control it.
1151  */
1152 static int asus_hwmon_get_fan_number(struct asus_wmi *asus, int *num_fans)
1153 {
1154         int status;
1155         int speed = 0;
1156
1157         *num_fans = 0;
1158
1159         status = asus_hwmon_agfn_fan_speed_read(asus, 1, &speed);
1160         if (!status)
1161                 *num_fans = 1;
1162
1163         return 0;
1164 }
1165
1166 static int asus_hwmon_fan_set_auto(struct asus_wmi *asus)
1167 {
1168         int status;
1169
1170         status = asus_hwmon_agfn_fan_speed_write(asus, 0, NULL);
1171         if (status)
1172                 return -ENXIO;
1173
1174         asus->asus_hwmon_fan_manual_mode = false;
1175
1176         return 0;
1177 }
1178
1179 static int asus_hwmon_fan_rpm_show(struct device *dev, int fan)
1180 {
1181         struct asus_wmi *asus = dev_get_drvdata(dev);
1182         int value;
1183         int ret;
1184
1185         /* no speed readable on manual mode */
1186         if (asus->asus_hwmon_fan_manual_mode)
1187                 return -ENXIO;
1188
1189         ret = asus_hwmon_agfn_fan_speed_read(asus, fan+1, &value);
1190         if (ret) {
1191                 pr_warn("reading fan speed failed: %d\n", ret);
1192                 return -ENXIO;
1193         }
1194
1195         return value;
1196 }
1197
1198 static void asus_hwmon_pwm_show(struct asus_wmi *asus, int fan, int *value)
1199 {
1200         int err;
1201
1202         if (asus->asus_hwmon_pwm >= 0) {
1203                 *value = asus->asus_hwmon_pwm;
1204                 return;
1205         }
1206
1207         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, value);
1208         if (err < 0)
1209                 return;
1210
1211         *value &= 0xFF;
1212
1213         if (*value == 1) /* Low Speed */
1214                 *value = 85;
1215         else if (*value == 2)
1216                 *value = 170;
1217         else if (*value == 3)
1218                 *value = 255;
1219         else if (*value) {
1220                 pr_err("Unknown fan speed %#x\n", *value);
1221                 *value = -1;
1222         }
1223 }
1224
1225 static ssize_t pwm1_show(struct device *dev,
1226                                struct device_attribute *attr,
1227                                char *buf)
1228 {
1229         struct asus_wmi *asus = dev_get_drvdata(dev);
1230         int value;
1231
1232         asus_hwmon_pwm_show(asus, 0, &value);
1233
1234         return sprintf(buf, "%d\n", value);
1235 }
1236
1237 static ssize_t pwm1_store(struct device *dev,
1238                                      struct device_attribute *attr,
1239                                      const char *buf, size_t count) {
1240         struct asus_wmi *asus = dev_get_drvdata(dev);
1241         int value;
1242         int state;
1243         int ret;
1244
1245         ret = kstrtouint(buf, 10, &value);
1246
1247         if (ret)
1248                 return ret;
1249
1250         value = clamp(value, 0, 255);
1251
1252         state = asus_hwmon_agfn_fan_speed_write(asus, 1, &value);
1253         if (state)
1254                 pr_warn("Setting fan speed failed: %d\n", state);
1255         else
1256                 asus->asus_hwmon_fan_manual_mode = true;
1257
1258         return count;
1259 }
1260
1261 static ssize_t fan1_input_show(struct device *dev,
1262                                         struct device_attribute *attr,
1263                                         char *buf)
1264 {
1265         int value = asus_hwmon_fan_rpm_show(dev, 0);
1266
1267         return sprintf(buf, "%d\n", value < 0 ? -1 : value*100);
1268
1269 }
1270
1271 static ssize_t pwm1_enable_show(struct device *dev,
1272                                                  struct device_attribute *attr,
1273                                                  char *buf)
1274 {
1275         struct asus_wmi *asus = dev_get_drvdata(dev);
1276
1277         if (asus->asus_hwmon_fan_manual_mode)
1278                 return sprintf(buf, "%d\n", ASUS_FAN_CTRL_MANUAL);
1279
1280         return sprintf(buf, "%d\n", ASUS_FAN_CTRL_AUTO);
1281 }
1282
1283 static ssize_t pwm1_enable_store(struct device *dev,
1284                                                   struct device_attribute *attr,
1285                                                   const char *buf, size_t count)
1286 {
1287         struct asus_wmi *asus = dev_get_drvdata(dev);
1288         int status = 0;
1289         int state;
1290         int ret;
1291
1292         ret = kstrtouint(buf, 10, &state);
1293
1294         if (ret)
1295                 return ret;
1296
1297         if (state == ASUS_FAN_CTRL_MANUAL)
1298                 asus->asus_hwmon_fan_manual_mode = true;
1299         else
1300                 status = asus_hwmon_fan_set_auto(asus);
1301
1302         if (status)
1303                 return status;
1304
1305         return count;
1306 }
1307
1308 static ssize_t fan1_label_show(struct device *dev,
1309                                           struct device_attribute *attr,
1310                                           char *buf)
1311 {
1312         return sprintf(buf, "%s\n", ASUS_FAN_DESC);
1313 }
1314
1315 static ssize_t asus_hwmon_temp1(struct device *dev,
1316                                 struct device_attribute *attr,
1317                                 char *buf)
1318 {
1319         struct asus_wmi *asus = dev_get_drvdata(dev);
1320         u32 value;
1321         int err;
1322
1323         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);
1324
1325         if (err < 0)
1326                 return err;
1327
1328         value = DECI_KELVIN_TO_CELSIUS((value & 0xFFFF)) * 1000;
1329
1330         return sprintf(buf, "%d\n", value);
1331 }
1332
1333 /* Fan1 */
1334 static DEVICE_ATTR_RW(pwm1);
1335 static DEVICE_ATTR_RW(pwm1_enable);
1336 static DEVICE_ATTR_RO(fan1_input);
1337 static DEVICE_ATTR_RO(fan1_label);
1338
1339 /* Temperature */
1340 static DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL);
1341
1342 static struct attribute *hwmon_attributes[] = {
1343         &dev_attr_pwm1.attr,
1344         &dev_attr_pwm1_enable.attr,
1345         &dev_attr_fan1_input.attr,
1346         &dev_attr_fan1_label.attr,
1347
1348         &dev_attr_temp1_input.attr,
1349         NULL
1350 };
1351
1352 static umode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
1353                                           struct attribute *attr, int idx)
1354 {
1355         struct device *dev = container_of(kobj, struct device, kobj);
1356         struct platform_device *pdev = to_platform_device(dev->parent);
1357         struct asus_wmi *asus = platform_get_drvdata(pdev);
1358         int dev_id = -1;
1359         int fan_attr = -1;
1360         u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
1361         bool ok = true;
1362
1363         if (attr == &dev_attr_pwm1.attr)
1364                 dev_id = ASUS_WMI_DEVID_FAN_CTRL;
1365         else if (attr == &dev_attr_temp1_input.attr)
1366                 dev_id = ASUS_WMI_DEVID_THERMAL_CTRL;
1367
1368
1369         if (attr == &dev_attr_fan1_input.attr
1370             || attr == &dev_attr_fan1_label.attr
1371             || attr == &dev_attr_pwm1.attr
1372             || attr == &dev_attr_pwm1_enable.attr) {
1373                 fan_attr = 1;
1374         }
1375
1376         if (dev_id != -1) {
1377                 int err = asus_wmi_get_devstate(asus, dev_id, &value);
1378
1379                 if (err < 0 && fan_attr == -1)
1380                         return 0; /* can't return negative here */
1381         }
1382
1383         if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) {
1384                 /*
1385                  * We need to find a better way, probably using sfun,
1386                  * bits or spec ...
1387                  * Currently we disable it if:
1388                  * - ASUS_WMI_UNSUPPORTED_METHOD is returned
1389                  * - reverved bits are non-zero
1390                  * - sfun and presence bit are not set
1391                  */
1392                 if (value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1393                     || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)))
1394                         ok = false;
1395                 else
1396                         ok = fan_attr <= asus->asus_hwmon_num_fans;
1397         } else if (dev_id == ASUS_WMI_DEVID_THERMAL_CTRL) {
1398                 /* If value is zero, something is clearly wrong */
1399                 if (!value)
1400                         ok = false;
1401         } else if (fan_attr <= asus->asus_hwmon_num_fans && fan_attr != -1) {
1402                 ok = true;
1403         } else {
1404                 ok = false;
1405         }
1406
1407         return ok ? attr->mode : 0;
1408 }
1409
1410 static const struct attribute_group hwmon_attribute_group = {
1411         .is_visible = asus_hwmon_sysfs_is_visible,
1412         .attrs = hwmon_attributes
1413 };
1414 __ATTRIBUTE_GROUPS(hwmon_attribute);
1415
1416 static int asus_wmi_hwmon_init(struct asus_wmi *asus)
1417 {
1418         struct device *hwmon;
1419
1420         hwmon = hwmon_device_register_with_groups(&asus->platform_device->dev,
1421                                                   "asus", asus,
1422                                                   hwmon_attribute_groups);
1423         if (IS_ERR(hwmon)) {
1424                 pr_err("Could not register asus hwmon device\n");
1425                 return PTR_ERR(hwmon);
1426         }
1427         return 0;
1428 }
1429
1430 /*
1431  * Backlight
1432  */
1433 static int read_backlight_power(struct asus_wmi *asus)
1434 {
1435         int ret;
1436         if (asus->driver->quirks->store_backlight_power)
1437                 ret = !asus->driver->panel_power;
1438         else
1439                 ret = asus_wmi_get_devstate_simple(asus,
1440                                                    ASUS_WMI_DEVID_BACKLIGHT);
1441
1442         if (ret < 0)
1443                 return ret;
1444
1445         return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
1446 }
1447
1448 static int read_brightness_max(struct asus_wmi *asus)
1449 {
1450         u32 retval;
1451         int err;
1452
1453         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1454
1455         if (err < 0)
1456                 return err;
1457
1458         retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
1459         retval >>= 8;
1460
1461         if (!retval)
1462                 return -ENODEV;
1463
1464         return retval;
1465 }
1466
1467 static int read_brightness(struct backlight_device *bd)
1468 {
1469         struct asus_wmi *asus = bl_get_data(bd);
1470         u32 retval;
1471         int err;
1472
1473         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1474
1475         if (err < 0)
1476                 return err;
1477
1478         return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
1479 }
1480
1481 static u32 get_scalar_command(struct backlight_device *bd)
1482 {
1483         struct asus_wmi *asus = bl_get_data(bd);
1484         u32 ctrl_param = 0;
1485
1486         if ((asus->driver->brightness < bd->props.brightness) ||
1487             bd->props.brightness == bd->props.max_brightness)
1488                 ctrl_param = 0x00008001;
1489         else if ((asus->driver->brightness > bd->props.brightness) ||
1490                  bd->props.brightness == 0)
1491                 ctrl_param = 0x00008000;
1492
1493         asus->driver->brightness = bd->props.brightness;
1494
1495         return ctrl_param;
1496 }
1497
1498 static int update_bl_status(struct backlight_device *bd)
1499 {
1500         struct asus_wmi *asus = bl_get_data(bd);
1501         u32 ctrl_param;
1502         int power, err = 0;
1503
1504         power = read_backlight_power(asus);
1505         if (power != -ENODEV && bd->props.power != power) {
1506                 ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1507                 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
1508                                             ctrl_param, NULL);
1509                 if (asus->driver->quirks->store_backlight_power)
1510                         asus->driver->panel_power = bd->props.power;
1511
1512                 /* When using scalar brightness, updating the brightness
1513                  * will mess with the backlight power */
1514                 if (asus->driver->quirks->scalar_panel_brightness)
1515                         return err;
1516         }
1517
1518         if (asus->driver->quirks->scalar_panel_brightness)
1519                 ctrl_param = get_scalar_command(bd);
1520         else
1521                 ctrl_param = bd->props.brightness;
1522
1523         err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
1524                                     ctrl_param, NULL);
1525
1526         return err;
1527 }
1528
1529 static const struct backlight_ops asus_wmi_bl_ops = {
1530         .get_brightness = read_brightness,
1531         .update_status = update_bl_status,
1532 };
1533
1534 static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
1535 {
1536         struct backlight_device *bd = asus->backlight_device;
1537         int old = bd->props.brightness;
1538         int new = old;
1539
1540         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1541                 new = code - NOTIFY_BRNUP_MIN + 1;
1542         else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
1543                 new = code - NOTIFY_BRNDOWN_MIN;
1544
1545         bd->props.brightness = new;
1546         backlight_update_status(bd);
1547         backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1548
1549         return old;
1550 }
1551
1552 static int asus_wmi_backlight_init(struct asus_wmi *asus)
1553 {
1554         struct backlight_device *bd;
1555         struct backlight_properties props;
1556         int max;
1557         int power;
1558
1559         max = read_brightness_max(asus);
1560         if (max < 0)
1561                 return max;
1562
1563         power = read_backlight_power(asus);
1564
1565         if (power == -ENODEV)
1566                 power = FB_BLANK_UNBLANK;
1567         else if (power < 0)
1568                 return power;
1569
1570         memset(&props, 0, sizeof(struct backlight_properties));
1571         props.type = BACKLIGHT_PLATFORM;
1572         props.max_brightness = max;
1573         bd = backlight_device_register(asus->driver->name,
1574                                        &asus->platform_device->dev, asus,
1575                                        &asus_wmi_bl_ops, &props);
1576         if (IS_ERR(bd)) {
1577                 pr_err("Could not register backlight device\n");
1578                 return PTR_ERR(bd);
1579         }
1580
1581         asus->backlight_device = bd;
1582
1583         if (asus->driver->quirks->store_backlight_power)
1584                 asus->driver->panel_power = power;
1585
1586         bd->props.brightness = read_brightness(bd);
1587         bd->props.power = power;
1588         backlight_update_status(bd);
1589
1590         asus->driver->brightness = bd->props.brightness;
1591
1592         return 0;
1593 }
1594
1595 static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1596 {
1597         backlight_device_unregister(asus->backlight_device);
1598
1599         asus->backlight_device = NULL;
1600 }
1601
1602 static int is_display_toggle(int code)
1603 {
1604         /* display toggle keys */
1605         if ((code >= 0x61 && code <= 0x67) ||
1606             (code >= 0x8c && code <= 0x93) ||
1607             (code >= 0xa0 && code <= 0xa7) ||
1608             (code >= 0xd0 && code <= 0xd5))
1609                 return 1;
1610
1611         return 0;
1612 }
1613
1614 static bool asus_wmi_has_fnlock_key(struct asus_wmi *asus)
1615 {
1616         u32 result;
1617
1618         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FNLOCK, &result);
1619
1620         return (result & ASUS_WMI_DSTS_PRESENCE_BIT) &&
1621                 !(result & ASUS_WMI_FNLOCK_BIOS_DISABLED);
1622 }
1623
1624 static void asus_wmi_fnlock_update(struct asus_wmi *asus)
1625 {
1626         int mode = asus->fnlock_locked;
1627
1628         asus_wmi_set_devstate(ASUS_WMI_DEVID_FNLOCK, mode, NULL);
1629 }
1630
1631 static void asus_wmi_notify(u32 value, void *context)
1632 {
1633         struct asus_wmi *asus = context;
1634         struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1635         union acpi_object *obj;
1636         acpi_status status;
1637         int code;
1638         int orig_code;
1639         unsigned int key_value = 1;
1640         bool autorelease = 1;
1641
1642         status = wmi_get_event_data(value, &response);
1643         if (status != AE_OK) {
1644                 pr_err("bad event status 0x%x\n", status);
1645                 return;
1646         }
1647
1648         obj = (union acpi_object *)response.pointer;
1649
1650         if (!obj || obj->type != ACPI_TYPE_INTEGER)
1651                 goto exit;
1652
1653         code = obj->integer.value;
1654         orig_code = code;
1655
1656         if (asus->driver->key_filter) {
1657                 asus->driver->key_filter(asus->driver, &code, &key_value,
1658                                          &autorelease);
1659                 if (code == ASUS_WMI_KEY_IGNORE)
1660                         goto exit;
1661         }
1662
1663         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1664                 code = ASUS_WMI_BRN_UP;
1665         else if (code >= NOTIFY_BRNDOWN_MIN &&
1666                  code <= NOTIFY_BRNDOWN_MAX)
1667                 code = ASUS_WMI_BRN_DOWN;
1668
1669         if (code == ASUS_WMI_BRN_DOWN || code == ASUS_WMI_BRN_UP) {
1670                 if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
1671                         asus_wmi_backlight_notify(asus, orig_code);
1672                         goto exit;
1673                 }
1674         }
1675
1676         if (code == NOTIFY_KBD_BRTUP) {
1677                 kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
1678                 goto exit;
1679         }
1680         if (code == NOTIFY_KBD_BRTDWN) {
1681                 kbd_led_set_by_kbd(asus, asus->kbd_led_wk - 1);
1682                 goto exit;
1683         }
1684         if (code == NOTIFY_KBD_BRTTOGGLE) {
1685                 if (asus->kbd_led_wk == asus->kbd_led.max_brightness)
1686                         kbd_led_set_by_kbd(asus, 0);
1687                 else
1688                         kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
1689                 goto exit;
1690         }
1691
1692         if (code == NOTIFY_FNLOCK_TOGGLE) {
1693                 asus->fnlock_locked = !asus->fnlock_locked;
1694                 asus_wmi_fnlock_update(asus);
1695                 goto exit;
1696         }
1697
1698         if (is_display_toggle(code) &&
1699             asus->driver->quirks->no_display_toggle)
1700                 goto exit;
1701
1702         if (!sparse_keymap_report_event(asus->inputdev, code,
1703                                         key_value, autorelease))
1704                 pr_info("Unknown key %x pressed\n", code);
1705
1706 exit:
1707         kfree(obj);
1708 }
1709
1710 /*
1711  * Sys helpers
1712  */
1713 static int parse_arg(const char *buf, unsigned long count, int *val)
1714 {
1715         if (!count)
1716                 return 0;
1717         if (sscanf(buf, "%i", val) != 1)
1718                 return -EINVAL;
1719         return count;
1720 }
1721
1722 static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1723                              const char *buf, size_t count)
1724 {
1725         u32 retval;
1726         int rv, err, value;
1727
1728         value = asus_wmi_get_devstate_simple(asus, devid);
1729         if (value < 0)
1730                 return value;
1731
1732         rv = parse_arg(buf, count, &value);
1733         err = asus_wmi_set_devstate(devid, value, &retval);
1734
1735         if (err < 0)
1736                 return err;
1737
1738         return rv;
1739 }
1740
1741 static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1742 {
1743         int value = asus_wmi_get_devstate_simple(asus, devid);
1744
1745         if (value < 0)
1746                 return value;
1747
1748         return sprintf(buf, "%d\n", value);
1749 }
1750
1751 #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)                  \
1752         static ssize_t show_##_name(struct device *dev,                 \
1753                                     struct device_attribute *attr,      \
1754                                     char *buf)                          \
1755         {                                                               \
1756                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
1757                                                                         \
1758                 return show_sys_wmi(asus, _cm, buf);                    \
1759         }                                                               \
1760         static ssize_t store_##_name(struct device *dev,                \
1761                                      struct device_attribute *attr,     \
1762                                      const char *buf, size_t count)     \
1763         {                                                               \
1764                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
1765                                                                         \
1766                 return store_sys_wmi(asus, _cm, buf, count);            \
1767         }                                                               \
1768         static struct device_attribute dev_attr_##_name = {             \
1769                 .attr = {                                               \
1770                         .name = __stringify(_name),                     \
1771                         .mode = _mode },                                \
1772                 .show   = show_##_name,                                 \
1773                 .store  = store_##_name,                                \
1774         }
1775
1776 ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1777 ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1778 ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
1779 ASUS_WMI_CREATE_DEVICE_ATTR(lid_resume, 0644, ASUS_WMI_DEVID_LID_RESUME);
1780 ASUS_WMI_CREATE_DEVICE_ATTR(als_enable, 0644, ASUS_WMI_DEVID_ALS_ENABLE);
1781
1782 static ssize_t cpufv_store(struct device *dev, struct device_attribute *attr,
1783                            const char *buf, size_t count)
1784 {
1785         int value, rv;
1786
1787         if (!count || sscanf(buf, "%i", &value) != 1)
1788                 return -EINVAL;
1789         if (value < 0 || value > 2)
1790                 return -EINVAL;
1791
1792         rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1793         if (rv < 0)
1794                 return rv;
1795
1796         return count;
1797 }
1798
1799 static DEVICE_ATTR_WO(cpufv);
1800
1801 static struct attribute *platform_attributes[] = {
1802         &dev_attr_cpufv.attr,
1803         &dev_attr_camera.attr,
1804         &dev_attr_cardr.attr,
1805         &dev_attr_touchpad.attr,
1806         &dev_attr_lid_resume.attr,
1807         &dev_attr_als_enable.attr,
1808         NULL
1809 };
1810
1811 static umode_t asus_sysfs_is_visible(struct kobject *kobj,
1812                                     struct attribute *attr, int idx)
1813 {
1814         struct device *dev = container_of(kobj, struct device, kobj);
1815         struct asus_wmi *asus = dev_get_drvdata(dev);
1816         bool ok = true;
1817         int devid = -1;
1818
1819         if (attr == &dev_attr_camera.attr)
1820                 devid = ASUS_WMI_DEVID_CAMERA;
1821         else if (attr == &dev_attr_cardr.attr)
1822                 devid = ASUS_WMI_DEVID_CARDREADER;
1823         else if (attr == &dev_attr_touchpad.attr)
1824                 devid = ASUS_WMI_DEVID_TOUCHPAD;
1825         else if (attr == &dev_attr_lid_resume.attr)
1826                 devid = ASUS_WMI_DEVID_LID_RESUME;
1827         else if (attr == &dev_attr_als_enable.attr)
1828                 devid = ASUS_WMI_DEVID_ALS_ENABLE;
1829
1830         if (devid != -1)
1831                 ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1832
1833         return ok ? attr->mode : 0;
1834 }
1835
1836 static const struct attribute_group platform_attribute_group = {
1837         .is_visible = asus_sysfs_is_visible,
1838         .attrs = platform_attributes
1839 };
1840
1841 static void asus_wmi_sysfs_exit(struct platform_device *device)
1842 {
1843         sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1844 }
1845
1846 static int asus_wmi_sysfs_init(struct platform_device *device)
1847 {
1848         return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1849 }
1850
1851 /*
1852  * Platform device
1853  */
1854 static int asus_wmi_platform_init(struct asus_wmi *asus)
1855 {
1856         int rv;
1857
1858         /* INIT enable hotkeys on some models */
1859         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1860                 pr_info("Initialization: %#x\n", rv);
1861
1862         /* We don't know yet what to do with this version... */
1863         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1864                 pr_info("BIOS WMI version: %d.%d\n", rv >> 16, rv & 0xFF);
1865                 asus->spec = rv;
1866         }
1867
1868         /*
1869          * The SFUN method probably allows the original driver to get the list
1870          * of features supported by a given model. For now, 0x0100 or 0x0800
1871          * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1872          * The significance of others is yet to be found.
1873          */
1874         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1875                 pr_info("SFUN value: %#x\n", rv);
1876                 asus->sfun = rv;
1877         }
1878
1879         /*
1880          * Eee PC and Notebooks seems to have different method_id for DSTS,
1881          * but it may also be related to the BIOS's SPEC.
1882          * Note, on most Eeepc, there is no way to check if a method exist
1883          * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1884          * but once again, SPEC may probably be used for that kind of things.
1885          */
1886         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
1887                 asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1888         else
1889                 asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1890
1891         /* CWAP allow to define the behavior of the Fn+F2 key,
1892          * this method doesn't seems to be present on Eee PCs */
1893         if (asus->driver->quirks->wapf >= 0)
1894                 asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
1895                                       asus->driver->quirks->wapf, NULL);
1896
1897         return asus_wmi_sysfs_init(asus->platform_device);
1898 }
1899
1900 static void asus_wmi_platform_exit(struct asus_wmi *asus)
1901 {
1902         asus_wmi_sysfs_exit(asus->platform_device);
1903 }
1904
1905 /*
1906  * debugfs
1907  */
1908 struct asus_wmi_debugfs_node {
1909         struct asus_wmi *asus;
1910         char *name;
1911         int (*show) (struct seq_file *m, void *data);
1912 };
1913
1914 static int show_dsts(struct seq_file *m, void *data)
1915 {
1916         struct asus_wmi *asus = m->private;
1917         int err;
1918         u32 retval = -1;
1919
1920         err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1921
1922         if (err < 0)
1923                 return err;
1924
1925         seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1926
1927         return 0;
1928 }
1929
1930 static int show_devs(struct seq_file *m, void *data)
1931 {
1932         struct asus_wmi *asus = m->private;
1933         int err;
1934         u32 retval = -1;
1935
1936         err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
1937                                     &retval);
1938
1939         if (err < 0)
1940                 return err;
1941
1942         seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1943                    asus->debug.ctrl_param, retval);
1944
1945         return 0;
1946 }
1947
1948 static int show_call(struct seq_file *m, void *data)
1949 {
1950         struct asus_wmi *asus = m->private;
1951         struct bios_args args = {
1952                 .arg0 = asus->debug.dev_id,
1953                 .arg1 = asus->debug.ctrl_param,
1954         };
1955         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1956         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
1957         union acpi_object *obj;
1958         acpi_status status;
1959
1960         status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
1961                                      0, asus->debug.method_id,
1962                                      &input, &output);
1963
1964         if (ACPI_FAILURE(status))
1965                 return -EIO;
1966
1967         obj = (union acpi_object *)output.pointer;
1968         if (obj && obj->type == ACPI_TYPE_INTEGER)
1969                 seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
1970                            asus->debug.dev_id, asus->debug.ctrl_param,
1971                            (u32) obj->integer.value);
1972         else
1973                 seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
1974                            asus->debug.dev_id, asus->debug.ctrl_param,
1975                            obj ? obj->type : -1);
1976
1977         kfree(obj);
1978
1979         return 0;
1980 }
1981
1982 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
1983         {NULL, "devs", show_devs},
1984         {NULL, "dsts", show_dsts},
1985         {NULL, "call", show_call},
1986 };
1987
1988 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
1989 {
1990         struct asus_wmi_debugfs_node *node = inode->i_private;
1991
1992         return single_open(file, node->show, node->asus);
1993 }
1994
1995 static const struct file_operations asus_wmi_debugfs_io_ops = {
1996         .owner = THIS_MODULE,
1997         .open = asus_wmi_debugfs_open,
1998         .read = seq_read,
1999         .llseek = seq_lseek,
2000         .release = single_release,
2001 };
2002
2003 static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
2004 {
2005         debugfs_remove_recursive(asus->debug.root);
2006 }
2007
2008 static int asus_wmi_debugfs_init(struct asus_wmi *asus)
2009 {
2010         struct dentry *dent;
2011         int i;
2012
2013         asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
2014         if (!asus->debug.root) {
2015                 pr_err("failed to create debugfs directory\n");
2016                 goto error_debugfs;
2017         }
2018
2019         dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
2020                                   asus->debug.root, &asus->debug.method_id);
2021         if (!dent)
2022                 goto error_debugfs;
2023
2024         dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
2025                                   asus->debug.root, &asus->debug.dev_id);
2026         if (!dent)
2027                 goto error_debugfs;
2028
2029         dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
2030                                   asus->debug.root, &asus->debug.ctrl_param);
2031         if (!dent)
2032                 goto error_debugfs;
2033
2034         for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
2035                 struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
2036
2037                 node->asus = asus;
2038                 dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
2039                                            asus->debug.root, node,
2040                                            &asus_wmi_debugfs_io_ops);
2041                 if (!dent) {
2042                         pr_err("failed to create debug file: %s\n", node->name);
2043                         goto error_debugfs;
2044                 }
2045         }
2046
2047         return 0;
2048
2049 error_debugfs:
2050         asus_wmi_debugfs_exit(asus);
2051         return -ENOMEM;
2052 }
2053
2054 static int asus_wmi_fan_init(struct asus_wmi *asus)
2055 {
2056         int status;
2057
2058         asus->asus_hwmon_pwm = -1;
2059         asus->asus_hwmon_num_fans = -1;
2060         asus->asus_hwmon_fan_manual_mode = false;
2061
2062         status = asus_hwmon_get_fan_number(asus, &asus->asus_hwmon_num_fans);
2063         if (status) {
2064                 asus->asus_hwmon_num_fans = 0;
2065                 pr_warn("Could not determine number of fans: %d\n", status);
2066                 return -ENXIO;
2067         }
2068
2069         pr_info("Number of fans: %d\n", asus->asus_hwmon_num_fans);
2070         return 0;
2071 }
2072
2073 /*
2074  * WMI Driver
2075  */
2076 static int asus_wmi_add(struct platform_device *pdev)
2077 {
2078         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2079         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2080         struct asus_wmi *asus;
2081         const char *chassis_type;
2082         acpi_status status;
2083         int err;
2084         u32 result;
2085
2086         asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
2087         if (!asus)
2088                 return -ENOMEM;
2089
2090         asus->driver = wdrv;
2091         asus->platform_device = pdev;
2092         wdrv->platform_device = pdev;
2093         platform_set_drvdata(asus->platform_device, asus);
2094
2095         if (wdrv->detect_quirks)
2096                 wdrv->detect_quirks(asus->driver);
2097
2098         err = asus_wmi_platform_init(asus);
2099         if (err)
2100                 goto fail_platform;
2101
2102         err = asus_wmi_input_init(asus);
2103         if (err)
2104                 goto fail_input;
2105
2106         err = asus_wmi_fan_init(asus); /* probably no problems on error */
2107         asus_hwmon_fan_set_auto(asus);
2108
2109         err = asus_wmi_hwmon_init(asus);
2110         if (err)
2111                 goto fail_hwmon;
2112
2113         err = asus_wmi_led_init(asus);
2114         if (err)
2115                 goto fail_leds;
2116
2117         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WLAN, &result);
2118         if (result & (ASUS_WMI_DSTS_PRESENCE_BIT | ASUS_WMI_DSTS_USER_BIT))
2119                 asus->driver->wlan_ctrl_by_user = 1;
2120
2121         if (!(asus->driver->wlan_ctrl_by_user && ashs_present())) {
2122                 err = asus_wmi_rfkill_init(asus);
2123                 if (err)
2124                         goto fail_rfkill;
2125         }
2126
2127         if (asus->driver->quirks->wmi_force_als_set)
2128                 asus_wmi_set_als();
2129
2130         /* Some Asus desktop boards export an acpi-video backlight interface,
2131            stop this from showing up */
2132         chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE);
2133         if (chassis_type && !strcmp(chassis_type, "3"))
2134                 acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2135
2136         if (asus->driver->quirks->wmi_backlight_power)
2137                 acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2138
2139         if (asus->driver->quirks->wmi_backlight_native)
2140                 acpi_video_set_dmi_backlight_type(acpi_backlight_native);
2141
2142         if (asus->driver->quirks->xusb2pr)
2143                 asus_wmi_set_xusb2pr(asus);
2144
2145         if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2146                 err = asus_wmi_backlight_init(asus);
2147                 if (err && err != -ENODEV)
2148                         goto fail_backlight;
2149         } else if (asus->driver->quirks->wmi_backlight_set_devstate)
2150                 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT, 2, NULL);
2151
2152         if (asus_wmi_has_fnlock_key(asus)) {
2153                 asus->fnlock_locked = true;
2154                 asus_wmi_fnlock_update(asus);
2155         }
2156
2157         status = wmi_install_notify_handler(asus->driver->event_guid,
2158                                             asus_wmi_notify, asus);
2159         if (ACPI_FAILURE(status)) {
2160                 pr_err("Unable to register notify handler - %d\n", status);
2161                 err = -ENODEV;
2162                 goto fail_wmi_handler;
2163         }
2164
2165         err = asus_wmi_debugfs_init(asus);
2166         if (err)
2167                 goto fail_debugfs;
2168
2169         return 0;
2170
2171 fail_debugfs:
2172         wmi_remove_notify_handler(asus->driver->event_guid);
2173 fail_wmi_handler:
2174         asus_wmi_backlight_exit(asus);
2175 fail_backlight:
2176         asus_wmi_rfkill_exit(asus);
2177 fail_rfkill:
2178         asus_wmi_led_exit(asus);
2179 fail_leds:
2180 fail_hwmon:
2181         asus_wmi_input_exit(asus);
2182 fail_input:
2183         asus_wmi_platform_exit(asus);
2184 fail_platform:
2185         kfree(asus);
2186         return err;
2187 }
2188
2189 static int asus_wmi_remove(struct platform_device *device)
2190 {
2191         struct asus_wmi *asus;
2192
2193         asus = platform_get_drvdata(device);
2194         wmi_remove_notify_handler(asus->driver->event_guid);
2195         asus_wmi_backlight_exit(asus);
2196         asus_wmi_input_exit(asus);
2197         asus_wmi_led_exit(asus);
2198         asus_wmi_rfkill_exit(asus);
2199         asus_wmi_debugfs_exit(asus);
2200         asus_wmi_platform_exit(asus);
2201         asus_hwmon_fan_set_auto(asus);
2202
2203         kfree(asus);
2204         return 0;
2205 }
2206
2207 /*
2208  * Platform driver - hibernate/resume callbacks
2209  */
2210 static int asus_hotk_thaw(struct device *device)
2211 {
2212         struct asus_wmi *asus = dev_get_drvdata(device);
2213
2214         if (asus->wlan.rfkill) {
2215                 bool wlan;
2216
2217                 /*
2218                  * Work around bios bug - acpi _PTS turns off the wireless led
2219                  * during suspend.  Normally it restores it on resume, but
2220                  * we should kick it ourselves in case hibernation is aborted.
2221                  */
2222                 wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
2223                 asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
2224         }
2225
2226         return 0;
2227 }
2228
2229 static int asus_hotk_resume(struct device *device)
2230 {
2231         struct asus_wmi *asus = dev_get_drvdata(device);
2232
2233         if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2234                 kbd_led_update(asus);
2235
2236         if (asus_wmi_has_fnlock_key(asus))
2237                 asus_wmi_fnlock_update(asus);
2238         return 0;
2239 }
2240
2241 static int asus_hotk_restore(struct device *device)
2242 {
2243         struct asus_wmi *asus = dev_get_drvdata(device);
2244         int bl;
2245
2246         /* Refresh both wlan rfkill state and pci hotplug */
2247         if (asus->wlan.rfkill)
2248                 asus_rfkill_hotplug(asus);
2249
2250         if (asus->bluetooth.rfkill) {
2251                 bl = !asus_wmi_get_devstate_simple(asus,
2252                                                    ASUS_WMI_DEVID_BLUETOOTH);
2253                 rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
2254         }
2255         if (asus->wimax.rfkill) {
2256                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
2257                 rfkill_set_sw_state(asus->wimax.rfkill, bl);
2258         }
2259         if (asus->wwan3g.rfkill) {
2260                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
2261                 rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
2262         }
2263         if (asus->gps.rfkill) {
2264                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
2265                 rfkill_set_sw_state(asus->gps.rfkill, bl);
2266         }
2267         if (asus->uwb.rfkill) {
2268                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
2269                 rfkill_set_sw_state(asus->uwb.rfkill, bl);
2270         }
2271         if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2272                 kbd_led_update(asus);
2273
2274         if (asus_wmi_has_fnlock_key(asus))
2275                 asus_wmi_fnlock_update(asus);
2276         return 0;
2277 }
2278
2279 static const struct dev_pm_ops asus_pm_ops = {
2280         .thaw = asus_hotk_thaw,
2281         .restore = asus_hotk_restore,
2282         .resume = asus_hotk_resume,
2283 };
2284
2285 static int asus_wmi_probe(struct platform_device *pdev)
2286 {
2287         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2288         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2289         int ret;
2290
2291         if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
2292                 pr_warn("ASUS Management GUID not found\n");
2293                 return -ENODEV;
2294         }
2295
2296         if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
2297                 pr_warn("ASUS Event GUID not found\n");
2298                 return -ENODEV;
2299         }
2300
2301         if (wdrv->probe) {
2302                 ret = wdrv->probe(pdev);
2303                 if (ret)
2304                         return ret;
2305         }
2306
2307         return asus_wmi_add(pdev);
2308 }
2309
2310 static bool used;
2311
2312 int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
2313 {
2314         struct platform_driver *platform_driver;
2315         struct platform_device *platform_device;
2316
2317         if (used)
2318                 return -EBUSY;
2319
2320         platform_driver = &driver->platform_driver;
2321         platform_driver->remove = asus_wmi_remove;
2322         platform_driver->driver.owner = driver->owner;
2323         platform_driver->driver.name = driver->name;
2324         platform_driver->driver.pm = &asus_pm_ops;
2325
2326         platform_device = platform_create_bundle(platform_driver,
2327                                                  asus_wmi_probe,
2328                                                  NULL, 0, NULL, 0);
2329         if (IS_ERR(platform_device))
2330                 return PTR_ERR(platform_device);
2331
2332         used = true;
2333         return 0;
2334 }
2335 EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
2336
2337 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
2338 {
2339         platform_device_unregister(driver->platform_device);
2340         platform_driver_unregister(&driver->platform_driver);
2341         used = false;
2342 }
2343 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
2344
2345 static int __init asus_wmi_init(void)
2346 {
2347         pr_info("ASUS WMI generic driver loaded\n");
2348         return 0;
2349 }
2350
2351 static void __exit asus_wmi_exit(void)
2352 {
2353         pr_info("ASUS WMI generic driver unloaded\n");
2354 }
2355
2356 module_init(asus_wmi_init);
2357 module_exit(asus_wmi_exit);