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