xref: /OK3568_Linux_fs/kernel/drivers/platform/x86/asus-wmi.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
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 
ashs_present(void)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 
asus_wmi_evaluate_method3(u32 method_id,u32 arg0,u32 arg1,u32 arg2,u32 * retval)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 
asus_wmi_evaluate_method(u32 method_id,u32 arg0,u32 arg1,u32 * retval)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 
asus_wmi_evaluate_method_agfn(const struct acpi_buffer args)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 
asus_wmi_get_devstate(struct asus_wmi * asus,u32 dev_id,u32 * retval)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 
asus_wmi_set_devstate(u32 dev_id,u32 ctrl_param,u32 * retval)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 */
asus_wmi_get_devstate_bits(struct asus_wmi * asus,u32 dev_id,u32 mask)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 
asus_wmi_get_devstate_simple(struct asus_wmi * asus,u32 dev_id)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 
asus_wmi_dev_is_present(struct asus_wmi * asus,u32 dev_id)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 
asus_wmi_input_init(struct asus_wmi * asus)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 
asus_wmi_input_exit(struct asus_wmi * asus)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 
charge_control_end_threshold_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)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 
charge_control_end_threshold_show(struct device * device,struct device_attribute * attr,char * buf)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 
asus_wmi_battery_add(struct power_supply * battery)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 
asus_wmi_battery_remove(struct power_supply * battery)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 
asus_wmi_battery_init(struct asus_wmi * asus)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 
asus_wmi_battery_exit(struct asus_wmi * asus)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  */
tpd_led_update(struct work_struct * work)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 
tpd_led_set(struct led_classdev * led_cdev,enum led_brightness value)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 
read_tpd_led_state(struct asus_wmi * asus)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 
tpd_led_get(struct led_classdev * led_cdev)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 
kbd_led_update(struct asus_wmi * asus)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 
kbd_led_read(struct asus_wmi * asus,int * level,int * env)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 
do_kbd_led_set(struct led_classdev * led_cdev,int value)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 
kbd_led_set(struct led_classdev * led_cdev,enum led_brightness value)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 
kbd_led_set_by_kbd(struct asus_wmi * asus,enum led_brightness value)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 
kbd_led_get(struct led_classdev * led_cdev)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 
wlan_led_unknown_state(struct asus_wmi * asus)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 
wlan_led_update(struct work_struct * work)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 
wlan_led_set(struct led_classdev * led_cdev,enum led_brightness value)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 
wlan_led_get(struct led_classdev * led_cdev)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 
lightbar_led_update(struct work_struct * work)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 
lightbar_led_set(struct led_classdev * led_cdev,enum led_brightness value)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 
lightbar_led_get(struct led_classdev * led_cdev)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 
asus_wmi_led_exit(struct asus_wmi * asus)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 
asus_wmi_led_init(struct asus_wmi * asus)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  */
asus_wlan_rfkill_blocked(struct asus_wmi * asus)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 
asus_rfkill_hotplug(struct asus_wmi * asus)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 
asus_rfkill_notify(acpi_handle handle,u32 event,void * data)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 
asus_register_rfkill_notifier(struct asus_wmi * asus,char * node)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 
asus_unregister_rfkill_notifier(struct asus_wmi * asus,char * node)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 
asus_get_adapter_status(struct hotplug_slot * hotplug_slot,u8 * value)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 
asus_hotplug_work(struct work_struct * work)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 
asus_setup_pci_hotplug(struct asus_wmi * asus)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  */
asus_rfkill_set(void * data,bool blocked)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 
asus_rfkill_query(struct rfkill * rfkill,void * data)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 
asus_rfkill_wlan_set(void * data,bool blocked)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 
asus_new_rfkill(struct asus_wmi * asus,struct asus_rfkill * arfkill,const char * name,enum rfkill_type type,int dev_id)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 
asus_wmi_rfkill_exit(struct asus_wmi * asus)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 
asus_wmi_rfkill_init(struct asus_wmi * asus)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 
asus_wmi_set_xusb2pr(struct asus_wmi * asus)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 	pci_dev_put(xhci_pdev);
1216 
1217 	pr_info("set USB_INTEL_XUSB2PR old: 0x%04x, new: 0x%04x\n",
1218 			orig_ports_available, ports_available);
1219 }
1220 
1221 /*
1222  * Some devices dont support or have borcken get_als method
1223  * but still support set method.
1224  */
asus_wmi_set_als(void)1225 static void asus_wmi_set_als(void)
1226 {
1227 	asus_wmi_set_devstate(ASUS_WMI_DEVID_ALS_ENABLE, 1, NULL);
1228 }
1229 
1230 /* Hwmon device ***************************************************************/
1231 
asus_agfn_fan_speed_read(struct asus_wmi * asus,int fan,int * speed)1232 static int asus_agfn_fan_speed_read(struct asus_wmi *asus, int fan,
1233 					  int *speed)
1234 {
1235 	struct agfn_fan_args args = {
1236 		.agfn.len = sizeof(args),
1237 		.agfn.mfun = ASUS_FAN_MFUN,
1238 		.agfn.sfun = ASUS_FAN_SFUN_READ,
1239 		.fan = fan,
1240 		.speed = 0,
1241 	};
1242 	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1243 	int status;
1244 
1245 	if (fan != 1)
1246 		return -EINVAL;
1247 
1248 	status = asus_wmi_evaluate_method_agfn(input);
1249 
1250 	if (status || args.agfn.err)
1251 		return -ENXIO;
1252 
1253 	if (speed)
1254 		*speed = args.speed;
1255 
1256 	return 0;
1257 }
1258 
asus_agfn_fan_speed_write(struct asus_wmi * asus,int fan,int * speed)1259 static int asus_agfn_fan_speed_write(struct asus_wmi *asus, int fan,
1260 				     int *speed)
1261 {
1262 	struct agfn_fan_args args = {
1263 		.agfn.len = sizeof(args),
1264 		.agfn.mfun = ASUS_FAN_MFUN,
1265 		.agfn.sfun = ASUS_FAN_SFUN_WRITE,
1266 		.fan = fan,
1267 		.speed = speed ?  *speed : 0,
1268 	};
1269 	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1270 	int status;
1271 
1272 	/* 1: for setting 1st fan's speed 0: setting auto mode */
1273 	if (fan != 1 && fan != 0)
1274 		return -EINVAL;
1275 
1276 	status = asus_wmi_evaluate_method_agfn(input);
1277 
1278 	if (status || args.agfn.err)
1279 		return -ENXIO;
1280 
1281 	if (speed && fan == 1)
1282 		asus->agfn_pwm = *speed;
1283 
1284 	return 0;
1285 }
1286 
1287 /*
1288  * Check if we can read the speed of one fan. If true we assume we can also
1289  * control it.
1290  */
asus_wmi_has_agfn_fan(struct asus_wmi * asus)1291 static bool asus_wmi_has_agfn_fan(struct asus_wmi *asus)
1292 {
1293 	int status;
1294 	int speed;
1295 	u32 value;
1296 
1297 	status = asus_agfn_fan_speed_read(asus, 1, &speed);
1298 	if (status != 0)
1299 		return false;
1300 
1301 	status = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
1302 	if (status != 0)
1303 		return false;
1304 
1305 	/*
1306 	 * We need to find a better way, probably using sfun,
1307 	 * bits or spec ...
1308 	 * Currently we disable it if:
1309 	 * - ASUS_WMI_UNSUPPORTED_METHOD is returned
1310 	 * - reverved bits are non-zero
1311 	 * - sfun and presence bit are not set
1312 	 */
1313 	return !(value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1314 		 || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)));
1315 }
1316 
asus_fan_set_auto(struct asus_wmi * asus)1317 static int asus_fan_set_auto(struct asus_wmi *asus)
1318 {
1319 	int status;
1320 	u32 retval;
1321 
1322 	switch (asus->fan_type) {
1323 	case FAN_TYPE_SPEC83:
1324 		status = asus_wmi_set_devstate(ASUS_WMI_DEVID_CPU_FAN_CTRL,
1325 					       0, &retval);
1326 		if (status)
1327 			return status;
1328 
1329 		if (retval != 1)
1330 			return -EIO;
1331 		break;
1332 
1333 	case FAN_TYPE_AGFN:
1334 		status = asus_agfn_fan_speed_write(asus, 0, NULL);
1335 		if (status)
1336 			return -ENXIO;
1337 		break;
1338 
1339 	default:
1340 		return -ENXIO;
1341 	}
1342 
1343 
1344 	return 0;
1345 }
1346 
pwm1_show(struct device * dev,struct device_attribute * attr,char * buf)1347 static ssize_t pwm1_show(struct device *dev,
1348 			       struct device_attribute *attr,
1349 			       char *buf)
1350 {
1351 	struct asus_wmi *asus = dev_get_drvdata(dev);
1352 	int err;
1353 	int value;
1354 
1355 	/* If we already set a value then just return it */
1356 	if (asus->agfn_pwm >= 0)
1357 		return sprintf(buf, "%d\n", asus->agfn_pwm);
1358 
1359 	/*
1360 	 * If we haven't set already set a value through the AGFN interface,
1361 	 * we read a current value through the (now-deprecated) FAN_CTRL device.
1362 	 */
1363 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
1364 	if (err < 0)
1365 		return err;
1366 
1367 	value &= 0xFF;
1368 
1369 	if (value == 1) /* Low Speed */
1370 		value = 85;
1371 	else if (value == 2)
1372 		value = 170;
1373 	else if (value == 3)
1374 		value = 255;
1375 	else if (value) {
1376 		pr_err("Unknown fan speed %#x\n", value);
1377 		value = -1;
1378 	}
1379 
1380 	return sprintf(buf, "%d\n", value);
1381 }
1382 
pwm1_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1383 static ssize_t pwm1_store(struct device *dev,
1384 				     struct device_attribute *attr,
1385 				     const char *buf, size_t count) {
1386 	struct asus_wmi *asus = dev_get_drvdata(dev);
1387 	int value;
1388 	int state;
1389 	int ret;
1390 
1391 	ret = kstrtouint(buf, 10, &value);
1392 	if (ret)
1393 		return ret;
1394 
1395 	value = clamp(value, 0, 255);
1396 
1397 	state = asus_agfn_fan_speed_write(asus, 1, &value);
1398 	if (state)
1399 		pr_warn("Setting fan speed failed: %d\n", state);
1400 	else
1401 		asus->fan_pwm_mode = ASUS_FAN_CTRL_MANUAL;
1402 
1403 	return count;
1404 }
1405 
fan1_input_show(struct device * dev,struct device_attribute * attr,char * buf)1406 static ssize_t fan1_input_show(struct device *dev,
1407 					struct device_attribute *attr,
1408 					char *buf)
1409 {
1410 	struct asus_wmi *asus = dev_get_drvdata(dev);
1411 	int value;
1412 	int ret;
1413 
1414 	switch (asus->fan_type) {
1415 	case FAN_TYPE_SPEC83:
1416 		ret = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_CPU_FAN_CTRL,
1417 					    &value);
1418 		if (ret < 0)
1419 			return ret;
1420 
1421 		value &= 0xffff;
1422 		break;
1423 
1424 	case FAN_TYPE_AGFN:
1425 		/* no speed readable on manual mode */
1426 		if (asus->fan_pwm_mode == ASUS_FAN_CTRL_MANUAL)
1427 			return -ENXIO;
1428 
1429 		ret = asus_agfn_fan_speed_read(asus, 1, &value);
1430 		if (ret) {
1431 			pr_warn("reading fan speed failed: %d\n", ret);
1432 			return -ENXIO;
1433 		}
1434 		break;
1435 
1436 	default:
1437 		return -ENXIO;
1438 	}
1439 
1440 	return sprintf(buf, "%d\n", value < 0 ? -1 : value*100);
1441 }
1442 
pwm1_enable_show(struct device * dev,struct device_attribute * attr,char * buf)1443 static ssize_t pwm1_enable_show(struct device *dev,
1444 						 struct device_attribute *attr,
1445 						 char *buf)
1446 {
1447 	struct asus_wmi *asus = dev_get_drvdata(dev);
1448 
1449 	/*
1450 	 * Just read back the cached pwm mode.
1451 	 *
1452 	 * For the CPU_FAN device, the spec indicates that we should be
1453 	 * able to read the device status and consult bit 19 to see if we
1454 	 * are in Full On or Automatic mode. However, this does not work
1455 	 * in practice on X532FL at least (the bit is always 0) and there's
1456 	 * also nothing in the DSDT to indicate that this behaviour exists.
1457 	 */
1458 	return sprintf(buf, "%d\n", asus->fan_pwm_mode);
1459 }
1460 
pwm1_enable_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1461 static ssize_t pwm1_enable_store(struct device *dev,
1462 						  struct device_attribute *attr,
1463 						  const char *buf, size_t count)
1464 {
1465 	struct asus_wmi *asus = dev_get_drvdata(dev);
1466 	int status = 0;
1467 	int state;
1468 	int value;
1469 	int ret;
1470 	u32 retval;
1471 
1472 	ret = kstrtouint(buf, 10, &state);
1473 	if (ret)
1474 		return ret;
1475 
1476 	if (asus->fan_type == FAN_TYPE_SPEC83) {
1477 		switch (state) { /* standard documented hwmon values */
1478 		case ASUS_FAN_CTRL_FULLSPEED:
1479 			value = 1;
1480 			break;
1481 		case ASUS_FAN_CTRL_AUTO:
1482 			value = 0;
1483 			break;
1484 		default:
1485 			return -EINVAL;
1486 		}
1487 
1488 		ret = asus_wmi_set_devstate(ASUS_WMI_DEVID_CPU_FAN_CTRL,
1489 					    value, &retval);
1490 		if (ret)
1491 			return ret;
1492 
1493 		if (retval != 1)
1494 			return -EIO;
1495 	} else if (asus->fan_type == FAN_TYPE_AGFN) {
1496 		switch (state) {
1497 		case ASUS_FAN_CTRL_MANUAL:
1498 			break;
1499 
1500 		case ASUS_FAN_CTRL_AUTO:
1501 			status = asus_fan_set_auto(asus);
1502 			if (status)
1503 				return status;
1504 			break;
1505 
1506 		default:
1507 			return -EINVAL;
1508 		}
1509 	}
1510 
1511 	asus->fan_pwm_mode = state;
1512 	return count;
1513 }
1514 
fan1_label_show(struct device * dev,struct device_attribute * attr,char * buf)1515 static ssize_t fan1_label_show(struct device *dev,
1516 					  struct device_attribute *attr,
1517 					  char *buf)
1518 {
1519 	return sprintf(buf, "%s\n", ASUS_FAN_DESC);
1520 }
1521 
asus_hwmon_temp1(struct device * dev,struct device_attribute * attr,char * buf)1522 static ssize_t asus_hwmon_temp1(struct device *dev,
1523 				struct device_attribute *attr,
1524 				char *buf)
1525 {
1526 	struct asus_wmi *asus = dev_get_drvdata(dev);
1527 	u32 value;
1528 	int err;
1529 
1530 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);
1531 	if (err < 0)
1532 		return err;
1533 
1534 	return sprintf(buf, "%ld\n",
1535 		       deci_kelvin_to_millicelsius(value & 0xFFFF));
1536 }
1537 
1538 /* Fan1 */
1539 static DEVICE_ATTR_RW(pwm1);
1540 static DEVICE_ATTR_RW(pwm1_enable);
1541 static DEVICE_ATTR_RO(fan1_input);
1542 static DEVICE_ATTR_RO(fan1_label);
1543 
1544 /* Temperature */
1545 static DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL);
1546 
1547 static struct attribute *hwmon_attributes[] = {
1548 	&dev_attr_pwm1.attr,
1549 	&dev_attr_pwm1_enable.attr,
1550 	&dev_attr_fan1_input.attr,
1551 	&dev_attr_fan1_label.attr,
1552 
1553 	&dev_attr_temp1_input.attr,
1554 	NULL
1555 };
1556 
asus_hwmon_sysfs_is_visible(struct kobject * kobj,struct attribute * attr,int idx)1557 static umode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
1558 					  struct attribute *attr, int idx)
1559 {
1560 	struct device *dev = container_of(kobj, struct device, kobj);
1561 	struct asus_wmi *asus = dev_get_drvdata(dev->parent);
1562 	u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
1563 
1564 	if (attr == &dev_attr_pwm1.attr) {
1565 		if (asus->fan_type != FAN_TYPE_AGFN)
1566 			return 0;
1567 	} else if (attr == &dev_attr_fan1_input.attr
1568 	    || attr == &dev_attr_fan1_label.attr
1569 	    || attr == &dev_attr_pwm1_enable.attr) {
1570 		if (asus->fan_type == FAN_TYPE_NONE)
1571 			return 0;
1572 	} else if (attr == &dev_attr_temp1_input.attr) {
1573 		int err = asus_wmi_get_devstate(asus,
1574 						ASUS_WMI_DEVID_THERMAL_CTRL,
1575 						&value);
1576 
1577 		if (err < 0)
1578 			return 0; /* can't return negative here */
1579 
1580 		/*
1581 		 * If the temperature value in deci-Kelvin is near the absolute
1582 		 * zero temperature, something is clearly wrong
1583 		 */
1584 		if (value == 0 || value == 1)
1585 			return 0;
1586 	}
1587 
1588 	return attr->mode;
1589 }
1590 
1591 static const struct attribute_group hwmon_attribute_group = {
1592 	.is_visible = asus_hwmon_sysfs_is_visible,
1593 	.attrs = hwmon_attributes
1594 };
1595 __ATTRIBUTE_GROUPS(hwmon_attribute);
1596 
asus_wmi_hwmon_init(struct asus_wmi * asus)1597 static int asus_wmi_hwmon_init(struct asus_wmi *asus)
1598 {
1599 	struct device *dev = &asus->platform_device->dev;
1600 	struct device *hwmon;
1601 
1602 	hwmon = devm_hwmon_device_register_with_groups(dev, "asus", asus,
1603 			hwmon_attribute_groups);
1604 
1605 	if (IS_ERR(hwmon)) {
1606 		pr_err("Could not register asus hwmon device\n");
1607 		return PTR_ERR(hwmon);
1608 	}
1609 	return 0;
1610 }
1611 
asus_wmi_fan_init(struct asus_wmi * asus)1612 static int asus_wmi_fan_init(struct asus_wmi *asus)
1613 {
1614 	asus->fan_type = FAN_TYPE_NONE;
1615 	asus->agfn_pwm = -1;
1616 
1617 	if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_CPU_FAN_CTRL))
1618 		asus->fan_type = FAN_TYPE_SPEC83;
1619 	else if (asus_wmi_has_agfn_fan(asus))
1620 		asus->fan_type = FAN_TYPE_AGFN;
1621 
1622 	if (asus->fan_type == FAN_TYPE_NONE)
1623 		return -ENODEV;
1624 
1625 	asus_fan_set_auto(asus);
1626 	asus->fan_pwm_mode = ASUS_FAN_CTRL_AUTO;
1627 	return 0;
1628 }
1629 
1630 /* Fan mode *******************************************************************/
1631 
fan_boost_mode_check_present(struct asus_wmi * asus)1632 static int fan_boost_mode_check_present(struct asus_wmi *asus)
1633 {
1634 	u32 result;
1635 	int err;
1636 
1637 	asus->fan_boost_mode_available = false;
1638 
1639 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_BOOST_MODE,
1640 				    &result);
1641 	if (err) {
1642 		if (err == -ENODEV)
1643 			return 0;
1644 		else
1645 			return err;
1646 	}
1647 
1648 	if ((result & ASUS_WMI_DSTS_PRESENCE_BIT) &&
1649 			(result & ASUS_FAN_BOOST_MODES_MASK)) {
1650 		asus->fan_boost_mode_available = true;
1651 		asus->fan_boost_mode_mask = result & ASUS_FAN_BOOST_MODES_MASK;
1652 	}
1653 
1654 	return 0;
1655 }
1656 
fan_boost_mode_write(struct asus_wmi * asus)1657 static int fan_boost_mode_write(struct asus_wmi *asus)
1658 {
1659 	int err;
1660 	u8 value;
1661 	u32 retval;
1662 
1663 	value = asus->fan_boost_mode;
1664 
1665 	pr_info("Set fan boost mode: %u\n", value);
1666 	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_FAN_BOOST_MODE, value,
1667 				    &retval);
1668 	if (err) {
1669 		pr_warn("Failed to set fan boost mode: %d\n", err);
1670 		return err;
1671 	}
1672 
1673 	if (retval != 1) {
1674 		pr_warn("Failed to set fan boost mode (retval): 0x%x\n",
1675 			retval);
1676 		return -EIO;
1677 	}
1678 
1679 	return 0;
1680 }
1681 
fan_boost_mode_switch_next(struct asus_wmi * asus)1682 static int fan_boost_mode_switch_next(struct asus_wmi *asus)
1683 {
1684 	u8 mask = asus->fan_boost_mode_mask;
1685 
1686 	if (asus->fan_boost_mode == ASUS_FAN_BOOST_MODE_NORMAL) {
1687 		if (mask & ASUS_FAN_BOOST_MODE_OVERBOOST_MASK)
1688 			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_OVERBOOST;
1689 		else if (mask & ASUS_FAN_BOOST_MODE_SILENT_MASK)
1690 			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_SILENT;
1691 	} else if (asus->fan_boost_mode == ASUS_FAN_BOOST_MODE_OVERBOOST) {
1692 		if (mask & ASUS_FAN_BOOST_MODE_SILENT_MASK)
1693 			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_SILENT;
1694 		else
1695 			asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_NORMAL;
1696 	} else {
1697 		asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_NORMAL;
1698 	}
1699 
1700 	return fan_boost_mode_write(asus);
1701 }
1702 
fan_boost_mode_show(struct device * dev,struct device_attribute * attr,char * buf)1703 static ssize_t fan_boost_mode_show(struct device *dev,
1704 				   struct device_attribute *attr, char *buf)
1705 {
1706 	struct asus_wmi *asus = dev_get_drvdata(dev);
1707 
1708 	return scnprintf(buf, PAGE_SIZE, "%d\n", asus->fan_boost_mode);
1709 }
1710 
fan_boost_mode_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1711 static ssize_t fan_boost_mode_store(struct device *dev,
1712 				    struct device_attribute *attr,
1713 				    const char *buf, size_t count)
1714 {
1715 	int result;
1716 	u8 new_mode;
1717 	struct asus_wmi *asus = dev_get_drvdata(dev);
1718 	u8 mask = asus->fan_boost_mode_mask;
1719 
1720 	result = kstrtou8(buf, 10, &new_mode);
1721 	if (result < 0) {
1722 		pr_warn("Trying to store invalid value\n");
1723 		return result;
1724 	}
1725 
1726 	if (new_mode == ASUS_FAN_BOOST_MODE_OVERBOOST) {
1727 		if (!(mask & ASUS_FAN_BOOST_MODE_OVERBOOST_MASK))
1728 			return -EINVAL;
1729 	} else if (new_mode == ASUS_FAN_BOOST_MODE_SILENT) {
1730 		if (!(mask & ASUS_FAN_BOOST_MODE_SILENT_MASK))
1731 			return -EINVAL;
1732 	} else if (new_mode != ASUS_FAN_BOOST_MODE_NORMAL) {
1733 		return -EINVAL;
1734 	}
1735 
1736 	asus->fan_boost_mode = new_mode;
1737 	fan_boost_mode_write(asus);
1738 
1739 	return count;
1740 }
1741 
1742 // Fan boost mode: 0 - normal, 1 - overboost, 2 - silent
1743 static DEVICE_ATTR_RW(fan_boost_mode);
1744 
1745 /* Throttle thermal policy ****************************************************/
1746 
throttle_thermal_policy_check_present(struct asus_wmi * asus)1747 static int throttle_thermal_policy_check_present(struct asus_wmi *asus)
1748 {
1749 	u32 result;
1750 	int err;
1751 
1752 	asus->throttle_thermal_policy_available = false;
1753 
1754 	err = asus_wmi_get_devstate(asus,
1755 				    ASUS_WMI_DEVID_THROTTLE_THERMAL_POLICY,
1756 				    &result);
1757 	if (err) {
1758 		if (err == -ENODEV)
1759 			return 0;
1760 		return err;
1761 	}
1762 
1763 	if (result & ASUS_WMI_DSTS_PRESENCE_BIT)
1764 		asus->throttle_thermal_policy_available = true;
1765 
1766 	return 0;
1767 }
1768 
throttle_thermal_policy_write(struct asus_wmi * asus)1769 static int throttle_thermal_policy_write(struct asus_wmi *asus)
1770 {
1771 	int err;
1772 	u8 value;
1773 	u32 retval;
1774 
1775 	value = asus->throttle_thermal_policy_mode;
1776 
1777 	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_THROTTLE_THERMAL_POLICY,
1778 				    value, &retval);
1779 	if (err) {
1780 		pr_warn("Failed to set throttle thermal policy: %d\n", err);
1781 		return err;
1782 	}
1783 
1784 	if (retval != 1) {
1785 		pr_warn("Failed to set throttle thermal policy (retval): 0x%x\n",
1786 			retval);
1787 		return -EIO;
1788 	}
1789 
1790 	return 0;
1791 }
1792 
throttle_thermal_policy_set_default(struct asus_wmi * asus)1793 static int throttle_thermal_policy_set_default(struct asus_wmi *asus)
1794 {
1795 	if (!asus->throttle_thermal_policy_available)
1796 		return 0;
1797 
1798 	asus->throttle_thermal_policy_mode = ASUS_THROTTLE_THERMAL_POLICY_DEFAULT;
1799 	return throttle_thermal_policy_write(asus);
1800 }
1801 
throttle_thermal_policy_switch_next(struct asus_wmi * asus)1802 static int throttle_thermal_policy_switch_next(struct asus_wmi *asus)
1803 {
1804 	u8 new_mode = asus->throttle_thermal_policy_mode + 1;
1805 
1806 	if (new_mode > ASUS_THROTTLE_THERMAL_POLICY_SILENT)
1807 		new_mode = ASUS_THROTTLE_THERMAL_POLICY_DEFAULT;
1808 
1809 	asus->throttle_thermal_policy_mode = new_mode;
1810 	return throttle_thermal_policy_write(asus);
1811 }
1812 
throttle_thermal_policy_show(struct device * dev,struct device_attribute * attr,char * buf)1813 static ssize_t throttle_thermal_policy_show(struct device *dev,
1814 				   struct device_attribute *attr, char *buf)
1815 {
1816 	struct asus_wmi *asus = dev_get_drvdata(dev);
1817 	u8 mode = asus->throttle_thermal_policy_mode;
1818 
1819 	return scnprintf(buf, PAGE_SIZE, "%d\n", mode);
1820 }
1821 
throttle_thermal_policy_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1822 static ssize_t throttle_thermal_policy_store(struct device *dev,
1823 				    struct device_attribute *attr,
1824 				    const char *buf, size_t count)
1825 {
1826 	int result;
1827 	u8 new_mode;
1828 	struct asus_wmi *asus = dev_get_drvdata(dev);
1829 
1830 	result = kstrtou8(buf, 10, &new_mode);
1831 	if (result < 0)
1832 		return result;
1833 
1834 	if (new_mode > ASUS_THROTTLE_THERMAL_POLICY_SILENT)
1835 		return -EINVAL;
1836 
1837 	asus->throttle_thermal_policy_mode = new_mode;
1838 	throttle_thermal_policy_write(asus);
1839 
1840 	return count;
1841 }
1842 
1843 // Throttle thermal policy: 0 - default, 1 - overboost, 2 - silent
1844 static DEVICE_ATTR_RW(throttle_thermal_policy);
1845 
1846 /* Backlight ******************************************************************/
1847 
read_backlight_power(struct asus_wmi * asus)1848 static int read_backlight_power(struct asus_wmi *asus)
1849 {
1850 	int ret;
1851 
1852 	if (asus->driver->quirks->store_backlight_power)
1853 		ret = !asus->driver->panel_power;
1854 	else
1855 		ret = asus_wmi_get_devstate_simple(asus,
1856 						   ASUS_WMI_DEVID_BACKLIGHT);
1857 
1858 	if (ret < 0)
1859 		return ret;
1860 
1861 	return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
1862 }
1863 
read_brightness_max(struct asus_wmi * asus)1864 static int read_brightness_max(struct asus_wmi *asus)
1865 {
1866 	u32 retval;
1867 	int err;
1868 
1869 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1870 	if (err < 0)
1871 		return err;
1872 
1873 	retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
1874 	retval >>= 8;
1875 
1876 	if (!retval)
1877 		return -ENODEV;
1878 
1879 	return retval;
1880 }
1881 
read_brightness(struct backlight_device * bd)1882 static int read_brightness(struct backlight_device *bd)
1883 {
1884 	struct asus_wmi *asus = bl_get_data(bd);
1885 	u32 retval;
1886 	int err;
1887 
1888 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1889 	if (err < 0)
1890 		return err;
1891 
1892 	return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
1893 }
1894 
get_scalar_command(struct backlight_device * bd)1895 static u32 get_scalar_command(struct backlight_device *bd)
1896 {
1897 	struct asus_wmi *asus = bl_get_data(bd);
1898 	u32 ctrl_param = 0;
1899 
1900 	if ((asus->driver->brightness < bd->props.brightness) ||
1901 	    bd->props.brightness == bd->props.max_brightness)
1902 		ctrl_param = 0x00008001;
1903 	else if ((asus->driver->brightness > bd->props.brightness) ||
1904 		 bd->props.brightness == 0)
1905 		ctrl_param = 0x00008000;
1906 
1907 	asus->driver->brightness = bd->props.brightness;
1908 
1909 	return ctrl_param;
1910 }
1911 
update_bl_status(struct backlight_device * bd)1912 static int update_bl_status(struct backlight_device *bd)
1913 {
1914 	struct asus_wmi *asus = bl_get_data(bd);
1915 	u32 ctrl_param;
1916 	int power, err = 0;
1917 
1918 	power = read_backlight_power(asus);
1919 	if (power != -ENODEV && bd->props.power != power) {
1920 		ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1921 		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
1922 					    ctrl_param, NULL);
1923 		if (asus->driver->quirks->store_backlight_power)
1924 			asus->driver->panel_power = bd->props.power;
1925 
1926 		/* When using scalar brightness, updating the brightness
1927 		 * will mess with the backlight power */
1928 		if (asus->driver->quirks->scalar_panel_brightness)
1929 			return err;
1930 	}
1931 
1932 	if (asus->driver->quirks->scalar_panel_brightness)
1933 		ctrl_param = get_scalar_command(bd);
1934 	else
1935 		ctrl_param = bd->props.brightness;
1936 
1937 	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
1938 				    ctrl_param, NULL);
1939 
1940 	return err;
1941 }
1942 
1943 static const struct backlight_ops asus_wmi_bl_ops = {
1944 	.get_brightness = read_brightness,
1945 	.update_status = update_bl_status,
1946 };
1947 
asus_wmi_backlight_notify(struct asus_wmi * asus,int code)1948 static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
1949 {
1950 	struct backlight_device *bd = asus->backlight_device;
1951 	int old = bd->props.brightness;
1952 	int new = old;
1953 
1954 	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1955 		new = code - NOTIFY_BRNUP_MIN + 1;
1956 	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
1957 		new = code - NOTIFY_BRNDOWN_MIN;
1958 
1959 	bd->props.brightness = new;
1960 	backlight_update_status(bd);
1961 	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1962 
1963 	return old;
1964 }
1965 
asus_wmi_backlight_init(struct asus_wmi * asus)1966 static int asus_wmi_backlight_init(struct asus_wmi *asus)
1967 {
1968 	struct backlight_device *bd;
1969 	struct backlight_properties props;
1970 	int max;
1971 	int power;
1972 
1973 	max = read_brightness_max(asus);
1974 	if (max < 0)
1975 		return max;
1976 
1977 	power = read_backlight_power(asus);
1978 	if (power == -ENODEV)
1979 		power = FB_BLANK_UNBLANK;
1980 	else if (power < 0)
1981 		return power;
1982 
1983 	memset(&props, 0, sizeof(struct backlight_properties));
1984 	props.type = BACKLIGHT_PLATFORM;
1985 	props.max_brightness = max;
1986 	bd = backlight_device_register(asus->driver->name,
1987 				       &asus->platform_device->dev, asus,
1988 				       &asus_wmi_bl_ops, &props);
1989 	if (IS_ERR(bd)) {
1990 		pr_err("Could not register backlight device\n");
1991 		return PTR_ERR(bd);
1992 	}
1993 
1994 	asus->backlight_device = bd;
1995 
1996 	if (asus->driver->quirks->store_backlight_power)
1997 		asus->driver->panel_power = power;
1998 
1999 	bd->props.brightness = read_brightness(bd);
2000 	bd->props.power = power;
2001 	backlight_update_status(bd);
2002 
2003 	asus->driver->brightness = bd->props.brightness;
2004 
2005 	return 0;
2006 }
2007 
asus_wmi_backlight_exit(struct asus_wmi * asus)2008 static void asus_wmi_backlight_exit(struct asus_wmi *asus)
2009 {
2010 	backlight_device_unregister(asus->backlight_device);
2011 
2012 	asus->backlight_device = NULL;
2013 }
2014 
is_display_toggle(int code)2015 static int is_display_toggle(int code)
2016 {
2017 	/* display toggle keys */
2018 	if ((code >= 0x61 && code <= 0x67) ||
2019 	    (code >= 0x8c && code <= 0x93) ||
2020 	    (code >= 0xa0 && code <= 0xa7) ||
2021 	    (code >= 0xd0 && code <= 0xd5))
2022 		return 1;
2023 
2024 	return 0;
2025 }
2026 
2027 /* Fn-lock ********************************************************************/
2028 
asus_wmi_has_fnlock_key(struct asus_wmi * asus)2029 static bool asus_wmi_has_fnlock_key(struct asus_wmi *asus)
2030 {
2031 	u32 result;
2032 
2033 	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FNLOCK, &result);
2034 
2035 	return (result & ASUS_WMI_DSTS_PRESENCE_BIT) &&
2036 		!(result & ASUS_WMI_FNLOCK_BIOS_DISABLED);
2037 }
2038 
asus_wmi_fnlock_update(struct asus_wmi * asus)2039 static void asus_wmi_fnlock_update(struct asus_wmi *asus)
2040 {
2041 	int mode = asus->fnlock_locked;
2042 
2043 	asus_wmi_set_devstate(ASUS_WMI_DEVID_FNLOCK, mode, NULL);
2044 }
2045 
2046 /* WMI events *****************************************************************/
2047 
asus_wmi_get_event_code(u32 value)2048 static int asus_wmi_get_event_code(u32 value)
2049 {
2050 	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
2051 	union acpi_object *obj;
2052 	acpi_status status;
2053 	int code;
2054 
2055 	status = wmi_get_event_data(value, &response);
2056 	if (ACPI_FAILURE(status)) {
2057 		pr_warn("Failed to get WMI notify code: %s\n",
2058 				acpi_format_exception(status));
2059 		return -EIO;
2060 	}
2061 
2062 	obj = (union acpi_object *)response.pointer;
2063 
2064 	if (obj && obj->type == ACPI_TYPE_INTEGER)
2065 		code = (int)(obj->integer.value & WMI_EVENT_MASK);
2066 	else
2067 		code = -EIO;
2068 
2069 	kfree(obj);
2070 	return code;
2071 }
2072 
asus_wmi_handle_event_code(int code,struct asus_wmi * asus)2073 static void asus_wmi_handle_event_code(int code, struct asus_wmi *asus)
2074 {
2075 	unsigned int key_value = 1;
2076 	bool autorelease = 1;
2077 	int result, orig_code;
2078 
2079 	orig_code = code;
2080 
2081 	if (asus->driver->key_filter) {
2082 		asus->driver->key_filter(asus->driver, &code, &key_value,
2083 					 &autorelease);
2084 		if (code == ASUS_WMI_KEY_IGNORE)
2085 			return;
2086 	}
2087 
2088 	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
2089 		code = ASUS_WMI_BRN_UP;
2090 	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
2091 		code = ASUS_WMI_BRN_DOWN;
2092 
2093 	if (code == ASUS_WMI_BRN_DOWN || code == ASUS_WMI_BRN_UP) {
2094 		if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2095 			asus_wmi_backlight_notify(asus, orig_code);
2096 			return;
2097 		}
2098 	}
2099 
2100 	if (code == NOTIFY_KBD_BRTUP) {
2101 		kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
2102 		return;
2103 	}
2104 	if (code == NOTIFY_KBD_BRTDWN) {
2105 		kbd_led_set_by_kbd(asus, asus->kbd_led_wk - 1);
2106 		return;
2107 	}
2108 	if (code == NOTIFY_KBD_BRTTOGGLE) {
2109 		if (asus->kbd_led_wk == asus->kbd_led.max_brightness)
2110 			kbd_led_set_by_kbd(asus, 0);
2111 		else
2112 			kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
2113 		return;
2114 	}
2115 
2116 	if (code == NOTIFY_FNLOCK_TOGGLE) {
2117 		asus->fnlock_locked = !asus->fnlock_locked;
2118 		asus_wmi_fnlock_update(asus);
2119 		return;
2120 	}
2121 
2122 	if (asus->driver->quirks->use_kbd_dock_devid && code == NOTIFY_KBD_DOCK_CHANGE) {
2123 		result = asus_wmi_get_devstate_simple(asus,
2124 						      ASUS_WMI_DEVID_KBD_DOCK);
2125 		if (result >= 0) {
2126 			input_report_switch(asus->inputdev, SW_TABLET_MODE,
2127 					    !result);
2128 			input_sync(asus->inputdev);
2129 		}
2130 		return;
2131 	}
2132 
2133 	if (asus->fan_boost_mode_available && code == NOTIFY_KBD_FBM) {
2134 		fan_boost_mode_switch_next(asus);
2135 		return;
2136 	}
2137 
2138 	if (asus->throttle_thermal_policy_available && code == NOTIFY_KBD_TTP) {
2139 		throttle_thermal_policy_switch_next(asus);
2140 		return;
2141 	}
2142 
2143 	if (is_display_toggle(code) && asus->driver->quirks->no_display_toggle)
2144 		return;
2145 
2146 	if (!sparse_keymap_report_event(asus->inputdev, code,
2147 					key_value, autorelease))
2148 		pr_info("Unknown key %x pressed\n", code);
2149 }
2150 
asus_wmi_notify(u32 value,void * context)2151 static void asus_wmi_notify(u32 value, void *context)
2152 {
2153 	struct asus_wmi *asus = context;
2154 	int code;
2155 	int i;
2156 
2157 	for (i = 0; i < WMI_EVENT_QUEUE_SIZE + 1; i++) {
2158 		code = asus_wmi_get_event_code(value);
2159 		if (code < 0) {
2160 			pr_warn("Failed to get notify code: %d\n", code);
2161 			return;
2162 		}
2163 
2164 		if (code == WMI_EVENT_QUEUE_END || code == WMI_EVENT_MASK)
2165 			return;
2166 
2167 		asus_wmi_handle_event_code(code, asus);
2168 
2169 		/*
2170 		 * Double check that queue is present:
2171 		 * ATK (with queue) uses 0xff, ASUSWMI (without) 0xd2.
2172 		 */
2173 		if (!asus->wmi_event_queue || value != WMI_EVENT_VALUE_ATK)
2174 			return;
2175 	}
2176 
2177 	pr_warn("Failed to process event queue, last code: 0x%x\n", code);
2178 }
2179 
asus_wmi_notify_queue_flush(struct asus_wmi * asus)2180 static int asus_wmi_notify_queue_flush(struct asus_wmi *asus)
2181 {
2182 	int code;
2183 	int i;
2184 
2185 	for (i = 0; i < WMI_EVENT_QUEUE_SIZE + 1; i++) {
2186 		code = asus_wmi_get_event_code(WMI_EVENT_VALUE_ATK);
2187 		if (code < 0) {
2188 			pr_warn("Failed to get event during flush: %d\n", code);
2189 			return code;
2190 		}
2191 
2192 		if (code == WMI_EVENT_QUEUE_END || code == WMI_EVENT_MASK)
2193 			return 0;
2194 	}
2195 
2196 	pr_warn("Failed to flush event queue\n");
2197 	return -EIO;
2198 }
2199 
2200 /* Sysfs **********************************************************************/
2201 
store_sys_wmi(struct asus_wmi * asus,int devid,const char * buf,size_t count)2202 static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
2203 			     const char *buf, size_t count)
2204 {
2205 	u32 retval;
2206 	int err, value;
2207 
2208 	value = asus_wmi_get_devstate_simple(asus, devid);
2209 	if (value < 0)
2210 		return value;
2211 
2212 	err = kstrtoint(buf, 0, &value);
2213 	if (err)
2214 		return err;
2215 
2216 	err = asus_wmi_set_devstate(devid, value, &retval);
2217 	if (err < 0)
2218 		return err;
2219 
2220 	return count;
2221 }
2222 
show_sys_wmi(struct asus_wmi * asus,int devid,char * buf)2223 static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
2224 {
2225 	int value = asus_wmi_get_devstate_simple(asus, devid);
2226 
2227 	if (value < 0)
2228 		return value;
2229 
2230 	return sprintf(buf, "%d\n", value);
2231 }
2232 
2233 #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
2234 	static ssize_t show_##_name(struct device *dev,			\
2235 				    struct device_attribute *attr,	\
2236 				    char *buf)				\
2237 	{								\
2238 		struct asus_wmi *asus = dev_get_drvdata(dev);		\
2239 									\
2240 		return show_sys_wmi(asus, _cm, buf);			\
2241 	}								\
2242 	static ssize_t store_##_name(struct device *dev,		\
2243 				     struct device_attribute *attr,	\
2244 				     const char *buf, size_t count)	\
2245 	{								\
2246 		struct asus_wmi *asus = dev_get_drvdata(dev);		\
2247 									\
2248 		return store_sys_wmi(asus, _cm, buf, count);		\
2249 	}								\
2250 	static struct device_attribute dev_attr_##_name = {		\
2251 		.attr = {						\
2252 			.name = __stringify(_name),			\
2253 			.mode = _mode },				\
2254 		.show   = show_##_name,					\
2255 		.store  = store_##_name,				\
2256 	}
2257 
2258 ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
2259 ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
2260 ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
2261 ASUS_WMI_CREATE_DEVICE_ATTR(lid_resume, 0644, ASUS_WMI_DEVID_LID_RESUME);
2262 ASUS_WMI_CREATE_DEVICE_ATTR(als_enable, 0644, ASUS_WMI_DEVID_ALS_ENABLE);
2263 
cpufv_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)2264 static ssize_t cpufv_store(struct device *dev, struct device_attribute *attr,
2265 			   const char *buf, size_t count)
2266 {
2267 	int value, rv;
2268 
2269 	rv = kstrtoint(buf, 0, &value);
2270 	if (rv)
2271 		return rv;
2272 
2273 	if (value < 0 || value > 2)
2274 		return -EINVAL;
2275 
2276 	rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
2277 	if (rv < 0)
2278 		return rv;
2279 
2280 	return count;
2281 }
2282 
2283 static DEVICE_ATTR_WO(cpufv);
2284 
2285 static struct attribute *platform_attributes[] = {
2286 	&dev_attr_cpufv.attr,
2287 	&dev_attr_camera.attr,
2288 	&dev_attr_cardr.attr,
2289 	&dev_attr_touchpad.attr,
2290 	&dev_attr_lid_resume.attr,
2291 	&dev_attr_als_enable.attr,
2292 	&dev_attr_fan_boost_mode.attr,
2293 	&dev_attr_throttle_thermal_policy.attr,
2294 	NULL
2295 };
2296 
asus_sysfs_is_visible(struct kobject * kobj,struct attribute * attr,int idx)2297 static umode_t asus_sysfs_is_visible(struct kobject *kobj,
2298 				    struct attribute *attr, int idx)
2299 {
2300 	struct device *dev = container_of(kobj, struct device, kobj);
2301 	struct asus_wmi *asus = dev_get_drvdata(dev);
2302 	bool ok = true;
2303 	int devid = -1;
2304 
2305 	if (attr == &dev_attr_camera.attr)
2306 		devid = ASUS_WMI_DEVID_CAMERA;
2307 	else if (attr == &dev_attr_cardr.attr)
2308 		devid = ASUS_WMI_DEVID_CARDREADER;
2309 	else if (attr == &dev_attr_touchpad.attr)
2310 		devid = ASUS_WMI_DEVID_TOUCHPAD;
2311 	else if (attr == &dev_attr_lid_resume.attr)
2312 		devid = ASUS_WMI_DEVID_LID_RESUME;
2313 	else if (attr == &dev_attr_als_enable.attr)
2314 		devid = ASUS_WMI_DEVID_ALS_ENABLE;
2315 	else if (attr == &dev_attr_fan_boost_mode.attr)
2316 		ok = asus->fan_boost_mode_available;
2317 	else if (attr == &dev_attr_throttle_thermal_policy.attr)
2318 		ok = asus->throttle_thermal_policy_available;
2319 
2320 	if (devid != -1)
2321 		ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
2322 
2323 	return ok ? attr->mode : 0;
2324 }
2325 
2326 static const struct attribute_group platform_attribute_group = {
2327 	.is_visible = asus_sysfs_is_visible,
2328 	.attrs = platform_attributes
2329 };
2330 
asus_wmi_sysfs_exit(struct platform_device * device)2331 static void asus_wmi_sysfs_exit(struct platform_device *device)
2332 {
2333 	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
2334 }
2335 
asus_wmi_sysfs_init(struct platform_device * device)2336 static int asus_wmi_sysfs_init(struct platform_device *device)
2337 {
2338 	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
2339 }
2340 
2341 /* Platform device ************************************************************/
2342 
asus_wmi_platform_init(struct asus_wmi * asus)2343 static int asus_wmi_platform_init(struct asus_wmi *asus)
2344 {
2345 	struct device *dev = &asus->platform_device->dev;
2346 	char *wmi_uid;
2347 	int rv;
2348 
2349 	/* INIT enable hotkeys on some models */
2350 	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
2351 		pr_info("Initialization: %#x\n", rv);
2352 
2353 	/* We don't know yet what to do with this version... */
2354 	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
2355 		pr_info("BIOS WMI version: %d.%d\n", rv >> 16, rv & 0xFF);
2356 		asus->spec = rv;
2357 	}
2358 
2359 	/*
2360 	 * The SFUN method probably allows the original driver to get the list
2361 	 * of features supported by a given model. For now, 0x0100 or 0x0800
2362 	 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
2363 	 * The significance of others is yet to be found.
2364 	 */
2365 	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
2366 		pr_info("SFUN value: %#x\n", rv);
2367 		asus->sfun = rv;
2368 	}
2369 
2370 	/*
2371 	 * Eee PC and Notebooks seems to have different method_id for DSTS,
2372 	 * but it may also be related to the BIOS's SPEC.
2373 	 * Note, on most Eeepc, there is no way to check if a method exist
2374 	 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
2375 	 * but once again, SPEC may probably be used for that kind of things.
2376 	 *
2377 	 * Additionally at least TUF Gaming series laptops return nothing for
2378 	 * unknown methods, so the detection in this way is not possible.
2379 	 *
2380 	 * There is strong indication that only ACPI WMI devices that have _UID
2381 	 * equal to "ASUSWMI" use DCTS whereas those with "ATK" use DSTS.
2382 	 */
2383 	wmi_uid = wmi_get_acpi_device_uid(ASUS_WMI_MGMT_GUID);
2384 	if (!wmi_uid)
2385 		return -ENODEV;
2386 
2387 	if (!strcmp(wmi_uid, ASUS_ACPI_UID_ASUSWMI)) {
2388 		dev_info(dev, "Detected ASUSWMI, use DCTS\n");
2389 		asus->dsts_id = ASUS_WMI_METHODID_DCTS;
2390 	} else {
2391 		dev_info(dev, "Detected %s, not ASUSWMI, use DSTS\n", wmi_uid);
2392 		asus->dsts_id = ASUS_WMI_METHODID_DSTS;
2393 	}
2394 
2395 	/*
2396 	 * Some devices can have multiple event codes stored in a queue before
2397 	 * the module load if it was unloaded intermittently after calling
2398 	 * the INIT method (enables event handling). The WMI notify handler is
2399 	 * expected to retrieve all event codes until a retrieved code equals
2400 	 * queue end marker (One or Ones). Old codes are flushed from the queue
2401 	 * upon module load. Not enabling this when it should be has minimal
2402 	 * visible impact so fall back if anything goes wrong.
2403 	 */
2404 	wmi_uid = wmi_get_acpi_device_uid(asus->driver->event_guid);
2405 	if (wmi_uid && !strcmp(wmi_uid, ASUS_ACPI_UID_ATK)) {
2406 		dev_info(dev, "Detected ATK, enable event queue\n");
2407 
2408 		if (!asus_wmi_notify_queue_flush(asus))
2409 			asus->wmi_event_queue = true;
2410 	}
2411 
2412 	/* CWAP allow to define the behavior of the Fn+F2 key,
2413 	 * this method doesn't seems to be present on Eee PCs */
2414 	if (asus->driver->quirks->wapf >= 0)
2415 		asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
2416 				      asus->driver->quirks->wapf, NULL);
2417 
2418 	return 0;
2419 }
2420 
2421 /* debugfs ********************************************************************/
2422 
2423 struct asus_wmi_debugfs_node {
2424 	struct asus_wmi *asus;
2425 	char *name;
2426 	int (*show) (struct seq_file *m, void *data);
2427 };
2428 
show_dsts(struct seq_file * m,void * data)2429 static int show_dsts(struct seq_file *m, void *data)
2430 {
2431 	struct asus_wmi *asus = m->private;
2432 	int err;
2433 	u32 retval = -1;
2434 
2435 	err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
2436 	if (err < 0)
2437 		return err;
2438 
2439 	seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
2440 
2441 	return 0;
2442 }
2443 
show_devs(struct seq_file * m,void * data)2444 static int show_devs(struct seq_file *m, void *data)
2445 {
2446 	struct asus_wmi *asus = m->private;
2447 	int err;
2448 	u32 retval = -1;
2449 
2450 	err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
2451 				    &retval);
2452 	if (err < 0)
2453 		return err;
2454 
2455 	seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
2456 		   asus->debug.ctrl_param, retval);
2457 
2458 	return 0;
2459 }
2460 
show_call(struct seq_file * m,void * data)2461 static int show_call(struct seq_file *m, void *data)
2462 {
2463 	struct asus_wmi *asus = m->private;
2464 	struct bios_args args = {
2465 		.arg0 = asus->debug.dev_id,
2466 		.arg1 = asus->debug.ctrl_param,
2467 	};
2468 	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
2469 	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
2470 	union acpi_object *obj;
2471 	acpi_status status;
2472 
2473 	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
2474 				     0, asus->debug.method_id,
2475 				     &input, &output);
2476 
2477 	if (ACPI_FAILURE(status))
2478 		return -EIO;
2479 
2480 	obj = (union acpi_object *)output.pointer;
2481 	if (obj && obj->type == ACPI_TYPE_INTEGER)
2482 		seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
2483 			   asus->debug.dev_id, asus->debug.ctrl_param,
2484 			   (u32) obj->integer.value);
2485 	else
2486 		seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
2487 			   asus->debug.dev_id, asus->debug.ctrl_param,
2488 			   obj ? obj->type : -1);
2489 
2490 	kfree(obj);
2491 
2492 	return 0;
2493 }
2494 
2495 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
2496 	{NULL, "devs", show_devs},
2497 	{NULL, "dsts", show_dsts},
2498 	{NULL, "call", show_call},
2499 };
2500 
asus_wmi_debugfs_open(struct inode * inode,struct file * file)2501 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
2502 {
2503 	struct asus_wmi_debugfs_node *node = inode->i_private;
2504 
2505 	return single_open(file, node->show, node->asus);
2506 }
2507 
2508 static const struct file_operations asus_wmi_debugfs_io_ops = {
2509 	.owner = THIS_MODULE,
2510 	.open = asus_wmi_debugfs_open,
2511 	.read = seq_read,
2512 	.llseek = seq_lseek,
2513 	.release = single_release,
2514 };
2515 
asus_wmi_debugfs_exit(struct asus_wmi * asus)2516 static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
2517 {
2518 	debugfs_remove_recursive(asus->debug.root);
2519 }
2520 
asus_wmi_debugfs_init(struct asus_wmi * asus)2521 static void asus_wmi_debugfs_init(struct asus_wmi *asus)
2522 {
2523 	int i;
2524 
2525 	asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
2526 
2527 	debugfs_create_x32("method_id", S_IRUGO | S_IWUSR, asus->debug.root,
2528 			   &asus->debug.method_id);
2529 
2530 	debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR, asus->debug.root,
2531 			   &asus->debug.dev_id);
2532 
2533 	debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR, asus->debug.root,
2534 			   &asus->debug.ctrl_param);
2535 
2536 	for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
2537 		struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
2538 
2539 		node->asus = asus;
2540 		debugfs_create_file(node->name, S_IFREG | S_IRUGO,
2541 				    asus->debug.root, node,
2542 				    &asus_wmi_debugfs_io_ops);
2543 	}
2544 }
2545 
2546 /* Init / exit ****************************************************************/
2547 
asus_wmi_add(struct platform_device * pdev)2548 static int asus_wmi_add(struct platform_device *pdev)
2549 {
2550 	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2551 	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2552 	struct asus_wmi *asus;
2553 	const char *chassis_type;
2554 	acpi_status status;
2555 	int err;
2556 	u32 result;
2557 
2558 	asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
2559 	if (!asus)
2560 		return -ENOMEM;
2561 
2562 	asus->driver = wdrv;
2563 	asus->platform_device = pdev;
2564 	wdrv->platform_device = pdev;
2565 	platform_set_drvdata(asus->platform_device, asus);
2566 
2567 	if (wdrv->detect_quirks)
2568 		wdrv->detect_quirks(asus->driver);
2569 
2570 	err = asus_wmi_platform_init(asus);
2571 	if (err)
2572 		goto fail_platform;
2573 
2574 	err = fan_boost_mode_check_present(asus);
2575 	if (err)
2576 		goto fail_fan_boost_mode;
2577 
2578 	err = throttle_thermal_policy_check_present(asus);
2579 	if (err)
2580 		goto fail_throttle_thermal_policy;
2581 	else
2582 		throttle_thermal_policy_set_default(asus);
2583 
2584 	err = asus_wmi_sysfs_init(asus->platform_device);
2585 	if (err)
2586 		goto fail_sysfs;
2587 
2588 	err = asus_wmi_input_init(asus);
2589 	if (err)
2590 		goto fail_input;
2591 
2592 	err = asus_wmi_fan_init(asus); /* probably no problems on error */
2593 
2594 	err = asus_wmi_hwmon_init(asus);
2595 	if (err)
2596 		goto fail_hwmon;
2597 
2598 	err = asus_wmi_led_init(asus);
2599 	if (err)
2600 		goto fail_leds;
2601 
2602 	asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WLAN, &result);
2603 	if (result & (ASUS_WMI_DSTS_PRESENCE_BIT | ASUS_WMI_DSTS_USER_BIT))
2604 		asus->driver->wlan_ctrl_by_user = 1;
2605 
2606 	if (!(asus->driver->wlan_ctrl_by_user && ashs_present())) {
2607 		err = asus_wmi_rfkill_init(asus);
2608 		if (err)
2609 			goto fail_rfkill;
2610 	}
2611 
2612 	if (asus->driver->quirks->wmi_force_als_set)
2613 		asus_wmi_set_als();
2614 
2615 	/* Some Asus desktop boards export an acpi-video backlight interface,
2616 	   stop this from showing up */
2617 	chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE);
2618 	if (chassis_type && !strcmp(chassis_type, "3"))
2619 		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2620 
2621 	if (asus->driver->quirks->wmi_backlight_power)
2622 		acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2623 
2624 	if (asus->driver->quirks->wmi_backlight_native)
2625 		acpi_video_set_dmi_backlight_type(acpi_backlight_native);
2626 
2627 	if (asus->driver->quirks->xusb2pr)
2628 		asus_wmi_set_xusb2pr(asus);
2629 
2630 	if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2631 		err = asus_wmi_backlight_init(asus);
2632 		if (err && err != -ENODEV)
2633 			goto fail_backlight;
2634 	} else if (asus->driver->quirks->wmi_backlight_set_devstate)
2635 		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT, 2, NULL);
2636 
2637 	if (asus_wmi_has_fnlock_key(asus)) {
2638 		asus->fnlock_locked = true;
2639 		asus_wmi_fnlock_update(asus);
2640 	}
2641 
2642 	status = wmi_install_notify_handler(asus->driver->event_guid,
2643 					    asus_wmi_notify, asus);
2644 	if (ACPI_FAILURE(status)) {
2645 		pr_err("Unable to register notify handler - %d\n", status);
2646 		err = -ENODEV;
2647 		goto fail_wmi_handler;
2648 	}
2649 
2650 	asus_wmi_battery_init(asus);
2651 
2652 	asus_wmi_debugfs_init(asus);
2653 
2654 	return 0;
2655 
2656 fail_wmi_handler:
2657 	asus_wmi_backlight_exit(asus);
2658 fail_backlight:
2659 	asus_wmi_rfkill_exit(asus);
2660 fail_rfkill:
2661 	asus_wmi_led_exit(asus);
2662 fail_leds:
2663 fail_hwmon:
2664 	asus_wmi_input_exit(asus);
2665 fail_input:
2666 	asus_wmi_sysfs_exit(asus->platform_device);
2667 fail_sysfs:
2668 fail_throttle_thermal_policy:
2669 fail_fan_boost_mode:
2670 fail_platform:
2671 	kfree(asus);
2672 	return err;
2673 }
2674 
asus_wmi_remove(struct platform_device * device)2675 static int asus_wmi_remove(struct platform_device *device)
2676 {
2677 	struct asus_wmi *asus;
2678 
2679 	asus = platform_get_drvdata(device);
2680 	wmi_remove_notify_handler(asus->driver->event_guid);
2681 	asus_wmi_backlight_exit(asus);
2682 	asus_wmi_input_exit(asus);
2683 	asus_wmi_led_exit(asus);
2684 	asus_wmi_rfkill_exit(asus);
2685 	asus_wmi_debugfs_exit(asus);
2686 	asus_wmi_sysfs_exit(asus->platform_device);
2687 	asus_fan_set_auto(asus);
2688 	asus_wmi_battery_exit(asus);
2689 
2690 	kfree(asus);
2691 	return 0;
2692 }
2693 
2694 /* Platform driver - hibernate/resume callbacks *******************************/
2695 
asus_hotk_thaw(struct device * device)2696 static int asus_hotk_thaw(struct device *device)
2697 {
2698 	struct asus_wmi *asus = dev_get_drvdata(device);
2699 
2700 	if (asus->wlan.rfkill) {
2701 		bool wlan;
2702 
2703 		/*
2704 		 * Work around bios bug - acpi _PTS turns off the wireless led
2705 		 * during suspend.  Normally it restores it on resume, but
2706 		 * we should kick it ourselves in case hibernation is aborted.
2707 		 */
2708 		wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
2709 		asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
2710 	}
2711 
2712 	return 0;
2713 }
2714 
asus_hotk_resume(struct device * device)2715 static int asus_hotk_resume(struct device *device)
2716 {
2717 	struct asus_wmi *asus = dev_get_drvdata(device);
2718 
2719 	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2720 		kbd_led_update(asus);
2721 
2722 	if (asus_wmi_has_fnlock_key(asus))
2723 		asus_wmi_fnlock_update(asus);
2724 	return 0;
2725 }
2726 
asus_hotk_restore(struct device * device)2727 static int asus_hotk_restore(struct device *device)
2728 {
2729 	struct asus_wmi *asus = dev_get_drvdata(device);
2730 	int bl;
2731 
2732 	/* Refresh both wlan rfkill state and pci hotplug */
2733 	if (asus->wlan.rfkill)
2734 		asus_rfkill_hotplug(asus);
2735 
2736 	if (asus->bluetooth.rfkill) {
2737 		bl = !asus_wmi_get_devstate_simple(asus,
2738 						   ASUS_WMI_DEVID_BLUETOOTH);
2739 		rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
2740 	}
2741 	if (asus->wimax.rfkill) {
2742 		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
2743 		rfkill_set_sw_state(asus->wimax.rfkill, bl);
2744 	}
2745 	if (asus->wwan3g.rfkill) {
2746 		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
2747 		rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
2748 	}
2749 	if (asus->gps.rfkill) {
2750 		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
2751 		rfkill_set_sw_state(asus->gps.rfkill, bl);
2752 	}
2753 	if (asus->uwb.rfkill) {
2754 		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
2755 		rfkill_set_sw_state(asus->uwb.rfkill, bl);
2756 	}
2757 	if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2758 		kbd_led_update(asus);
2759 
2760 	if (asus_wmi_has_fnlock_key(asus))
2761 		asus_wmi_fnlock_update(asus);
2762 	return 0;
2763 }
2764 
2765 static const struct dev_pm_ops asus_pm_ops = {
2766 	.thaw = asus_hotk_thaw,
2767 	.restore = asus_hotk_restore,
2768 	.resume = asus_hotk_resume,
2769 };
2770 
2771 /* Registration ***************************************************************/
2772 
asus_wmi_probe(struct platform_device * pdev)2773 static int asus_wmi_probe(struct platform_device *pdev)
2774 {
2775 	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2776 	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2777 	int ret;
2778 
2779 	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
2780 		pr_warn("ASUS Management GUID not found\n");
2781 		return -ENODEV;
2782 	}
2783 
2784 	if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
2785 		pr_warn("ASUS Event GUID not found\n");
2786 		return -ENODEV;
2787 	}
2788 
2789 	if (wdrv->probe) {
2790 		ret = wdrv->probe(pdev);
2791 		if (ret)
2792 			return ret;
2793 	}
2794 
2795 	return asus_wmi_add(pdev);
2796 }
2797 
2798 static bool used;
2799 
asus_wmi_register_driver(struct asus_wmi_driver * driver)2800 int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
2801 {
2802 	struct platform_driver *platform_driver;
2803 	struct platform_device *platform_device;
2804 
2805 	if (used)
2806 		return -EBUSY;
2807 
2808 	platform_driver = &driver->platform_driver;
2809 	platform_driver->remove = asus_wmi_remove;
2810 	platform_driver->driver.owner = driver->owner;
2811 	platform_driver->driver.name = driver->name;
2812 	platform_driver->driver.pm = &asus_pm_ops;
2813 
2814 	platform_device = platform_create_bundle(platform_driver,
2815 						 asus_wmi_probe,
2816 						 NULL, 0, NULL, 0);
2817 	if (IS_ERR(platform_device))
2818 		return PTR_ERR(platform_device);
2819 
2820 	used = true;
2821 	return 0;
2822 }
2823 EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
2824 
asus_wmi_unregister_driver(struct asus_wmi_driver * driver)2825 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
2826 {
2827 	platform_device_unregister(driver->platform_device);
2828 	platform_driver_unregister(&driver->platform_driver);
2829 	used = false;
2830 }
2831 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
2832 
asus_wmi_init(void)2833 static int __init asus_wmi_init(void)
2834 {
2835 	pr_info("ASUS WMI generic driver loaded\n");
2836 	return 0;
2837 }
2838 
asus_wmi_exit(void)2839 static void __exit asus_wmi_exit(void)
2840 {
2841 	pr_info("ASUS WMI generic driver unloaded\n");
2842 }
2843 
2844 module_init(asus_wmi_init);
2845 module_exit(asus_wmi_exit);
2846