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