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