1 /*
2  * Asus PC WMI hotkey driver
3  *
4  * Copyright(C) 2010 Intel Corporation.
5  * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com>
6  *
7  * Portions based on wistron_btns.c:
8  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
9  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
10  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
11  *
12  *  This program is free software; you can redistribute it and/or modify
13  *  it under the terms of the GNU General Public License as published by
14  *  the Free Software Foundation; either version 2 of the License, or
15  *  (at your option) any later version.
16  *
17  *  This program is distributed in the hope that it will be useful,
18  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
19  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
20  *  GNU General Public License for more details.
21  *
22  *  You should have received a copy of the GNU General Public License
23  *  along with this program; if not, write to the Free Software
24  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
25  */
26 
27 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
28 
29 #include <linux/kernel.h>
30 #include <linux/module.h>
31 #include <linux/init.h>
32 #include <linux/types.h>
33 #include <linux/slab.h>
34 #include <linux/input.h>
35 #include <linux/input/sparse-keymap.h>
36 #include <linux/fb.h>
37 #include <linux/backlight.h>
38 #include <linux/leds.h>
39 #include <linux/rfkill.h>
40 #include <linux/pci.h>
41 #include <linux/pci_hotplug.h>
42 #include <linux/hwmon.h>
43 #include <linux/hwmon-sysfs.h>
44 #include <linux/debugfs.h>
45 #include <linux/seq_file.h>
46 #include <linux/platform_device.h>
47 #include <acpi/acpi_bus.h>
48 #include <acpi/acpi_drivers.h>
49 
50 #include "asus-wmi.h"
51 
52 MODULE_AUTHOR("Corentin Chary <corentincj@iksaif.net>, "
53 	      "Yong Wang <yong.y.wang@intel.com>");
54 MODULE_DESCRIPTION("Asus Generic WMI Driver");
55 MODULE_LICENSE("GPL");
56 
57 #define to_platform_driver(drv)					\
58 	(container_of((drv), struct platform_driver, driver))
59 
60 #define to_asus_wmi_driver(pdrv)					\
61 	(container_of((pdrv), struct asus_wmi_driver, platform_driver))
62 
63 #define ASUS_WMI_MGMT_GUID	"97845ED0-4E6D-11DE-8A39-0800200C9A66"
64 
65 #define NOTIFY_BRNUP_MIN		0x11
66 #define NOTIFY_BRNUP_MAX		0x1f
67 #define NOTIFY_BRNDOWN_MIN		0x20
68 #define NOTIFY_BRNDOWN_MAX		0x2e
69 
70 /* WMI Methods */
71 #define ASUS_WMI_METHODID_SPEC	        0x43455053 /* BIOS SPECification */
72 #define ASUS_WMI_METHODID_SFBD		0x44424653 /* Set First Boot Device */
73 #define ASUS_WMI_METHODID_GLCD		0x44434C47 /* Get LCD status */
74 #define ASUS_WMI_METHODID_GPID		0x44495047 /* Get Panel ID?? (Resol) */
75 #define ASUS_WMI_METHODID_QMOD		0x444F4D51 /* Quiet MODe */
76 #define ASUS_WMI_METHODID_SPLV		0x4C425053 /* Set Panel Light Value */
77 #define ASUS_WMI_METHODID_SFUN		0x4E554653 /* FUNCtionalities */
78 #define ASUS_WMI_METHODID_SDSP		0x50534453 /* Set DiSPlay output */
79 #define ASUS_WMI_METHODID_GDSP		0x50534447 /* Get DiSPlay output */
80 #define ASUS_WMI_METHODID_DEVP		0x50564544 /* DEVice Policy */
81 #define ASUS_WMI_METHODID_OSVR		0x5256534F /* OS VeRsion */
82 #define ASUS_WMI_METHODID_DSTS		0x53544344 /* Device STatuS */
83 #define ASUS_WMI_METHODID_DSTS2		0x53545344 /* Device STatuS #2*/
84 #define ASUS_WMI_METHODID_BSTS		0x53545342 /* Bios STatuS ? */
85 #define ASUS_WMI_METHODID_DEVS		0x53564544 /* DEVice Set */
86 #define ASUS_WMI_METHODID_CFVS		0x53564643 /* CPU Frequency Volt Set */
87 #define ASUS_WMI_METHODID_KBFT		0x5446424B /* KeyBoard FilTer */
88 #define ASUS_WMI_METHODID_INIT		0x54494E49 /* INITialize */
89 #define ASUS_WMI_METHODID_HKEY		0x59454B48 /* Hot KEY ?? */
90 
91 #define ASUS_WMI_UNSUPPORTED_METHOD	0xFFFFFFFE
92 
93 /* Wireless */
94 #define ASUS_WMI_DEVID_HW_SWITCH	0x00010001
95 #define ASUS_WMI_DEVID_WIRELESS_LED	0x00010002
96 #define ASUS_WMI_DEVID_WLAN		0x00010011
97 #define ASUS_WMI_DEVID_BLUETOOTH	0x00010013
98 #define ASUS_WMI_DEVID_GPS		0x00010015
99 #define ASUS_WMI_DEVID_WIMAX		0x00010017
100 #define ASUS_WMI_DEVID_WWAN3G		0x00010019
101 #define ASUS_WMI_DEVID_UWB		0x00010021
102 
103 /* Leds */
104 /* 0x000200XX and 0x000400XX */
105 
106 /* Backlight and Brightness */
107 #define ASUS_WMI_DEVID_BACKLIGHT	0x00050011
108 #define ASUS_WMI_DEVID_BRIGHTNESS	0x00050012
109 #define ASUS_WMI_DEVID_KBD_BACKLIGHT	0x00050021
110 #define ASUS_WMI_DEVID_LIGHT_SENSOR	0x00050022 /* ?? */
111 
112 /* Misc */
113 #define ASUS_WMI_DEVID_CAMERA		0x00060013
114 
115 /* Storage */
116 #define ASUS_WMI_DEVID_CARDREADER	0x00080013
117 
118 /* Input */
119 #define ASUS_WMI_DEVID_TOUCHPAD		0x00100011
120 #define ASUS_WMI_DEVID_TOUCHPAD_LED	0x00100012
121 
122 /* Fan, Thermal */
123 #define ASUS_WMI_DEVID_THERMAL_CTRL	0x00110011
124 #define ASUS_WMI_DEVID_FAN_CTRL		0x00110012
125 
126 /* Power */
127 #define ASUS_WMI_DEVID_PROCESSOR_STATE	0x00120012
128 
129 /* DSTS masks */
130 #define ASUS_WMI_DSTS_STATUS_BIT	0x00000001
131 #define ASUS_WMI_DSTS_UNKNOWN_BIT	0x00000002
132 #define ASUS_WMI_DSTS_PRESENCE_BIT	0x00010000
133 #define ASUS_WMI_DSTS_USER_BIT		0x00020000
134 #define ASUS_WMI_DSTS_BIOS_BIT		0x00040000
135 #define ASUS_WMI_DSTS_BRIGHTNESS_MASK	0x000000FF
136 #define ASUS_WMI_DSTS_MAX_BRIGTH_MASK	0x0000FF00
137 
138 struct bios_args {
139 	u32 arg0;
140 	u32 arg1;
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 struct asus_wmi {
166 	int dsts_id;
167 	int spec;
168 	int sfun;
169 
170 	struct input_dev *inputdev;
171 	struct backlight_device *backlight_device;
172 	struct device *hwmon_device;
173 	struct platform_device *platform_device;
174 
175 	struct led_classdev tpd_led;
176 	int tpd_led_wk;
177 	struct workqueue_struct *led_workqueue;
178 	struct work_struct tpd_led_work;
179 
180 	struct asus_rfkill wlan;
181 	struct asus_rfkill bluetooth;
182 	struct asus_rfkill wimax;
183 	struct asus_rfkill wwan3g;
184 
185 	struct hotplug_slot *hotplug_slot;
186 	struct mutex hotplug_lock;
187 	struct mutex wmi_lock;
188 	struct workqueue_struct *hotplug_workqueue;
189 	struct work_struct hotplug_work;
190 
191 	struct asus_wmi_debug debug;
192 
193 	struct asus_wmi_driver *driver;
194 };
195 
asus_wmi_input_init(struct asus_wmi * asus)196 static int asus_wmi_input_init(struct asus_wmi *asus)
197 {
198 	int err;
199 
200 	asus->inputdev = input_allocate_device();
201 	if (!asus->inputdev)
202 		return -ENOMEM;
203 
204 	asus->inputdev->name = asus->driver->input_name;
205 	asus->inputdev->phys = asus->driver->input_phys;
206 	asus->inputdev->id.bustype = BUS_HOST;
207 	asus->inputdev->dev.parent = &asus->platform_device->dev;
208 
209 	err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
210 	if (err)
211 		goto err_free_dev;
212 
213 	err = input_register_device(asus->inputdev);
214 	if (err)
215 		goto err_free_keymap;
216 
217 	return 0;
218 
219 err_free_keymap:
220 	sparse_keymap_free(asus->inputdev);
221 err_free_dev:
222 	input_free_device(asus->inputdev);
223 	return err;
224 }
225 
asus_wmi_input_exit(struct asus_wmi * asus)226 static void asus_wmi_input_exit(struct asus_wmi *asus)
227 {
228 	if (asus->inputdev) {
229 		sparse_keymap_free(asus->inputdev);
230 		input_unregister_device(asus->inputdev);
231 	}
232 
233 	asus->inputdev = NULL;
234 }
235 
asus_wmi_evaluate_method(u32 method_id,u32 arg0,u32 arg1,u32 * retval)236 static int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1,
237 				    u32 *retval)
238 {
239 	struct bios_args args = {
240 		.arg0 = arg0,
241 		.arg1 = arg1,
242 	};
243 	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
244 	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
245 	acpi_status status;
246 	union acpi_object *obj;
247 	u32 tmp;
248 
249 	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 1, method_id,
250 				     &input, &output);
251 
252 	if (ACPI_FAILURE(status))
253 		goto exit;
254 
255 	obj = (union acpi_object *)output.pointer;
256 	if (obj && obj->type == ACPI_TYPE_INTEGER)
257 		tmp = (u32) obj->integer.value;
258 	else
259 		tmp = 0;
260 
261 	if (retval)
262 		*retval = tmp;
263 
264 	kfree(obj);
265 
266 exit:
267 	if (ACPI_FAILURE(status))
268 		return -EIO;
269 
270 	if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
271 		return -ENODEV;
272 
273 	return 0;
274 }
275 
asus_wmi_get_devstate(struct asus_wmi * asus,u32 dev_id,u32 * retval)276 static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
277 {
278 	return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
279 }
280 
asus_wmi_set_devstate(u32 dev_id,u32 ctrl_param,u32 * retval)281 static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
282 				 u32 *retval)
283 {
284 	return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
285 					ctrl_param, retval);
286 }
287 
288 /* Helper for special devices with magic return codes */
asus_wmi_get_devstate_bits(struct asus_wmi * asus,u32 dev_id,u32 mask)289 static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
290 				      u32 dev_id, u32 mask)
291 {
292 	u32 retval = 0;
293 	int err;
294 
295 	err = asus_wmi_get_devstate(asus, dev_id, &retval);
296 
297 	if (err < 0)
298 		return err;
299 
300 	if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
301 		return -ENODEV;
302 
303 	if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
304 		if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
305 			return -ENODEV;
306 	}
307 
308 	return retval & mask;
309 }
310 
asus_wmi_get_devstate_simple(struct asus_wmi * asus,u32 dev_id)311 static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
312 {
313 	return asus_wmi_get_devstate_bits(asus, dev_id,
314 					  ASUS_WMI_DSTS_STATUS_BIT);
315 }
316 
317 /*
318  * LEDs
319  */
320 /*
321  * These functions actually update the LED's, and are called from a
322  * workqueue. By doing this as separate work rather than when the LED
323  * subsystem asks, we avoid messing with the Asus ACPI stuff during a
324  * potentially bad time, such as a timer interrupt.
325  */
tpd_led_update(struct work_struct * work)326 static void tpd_led_update(struct work_struct *work)
327 {
328 	int ctrl_param;
329 	struct asus_wmi *asus;
330 
331 	asus = container_of(work, struct asus_wmi, tpd_led_work);
332 
333 	ctrl_param = asus->tpd_led_wk;
334 	asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
335 }
336 
tpd_led_set(struct led_classdev * led_cdev,enum led_brightness value)337 static void tpd_led_set(struct led_classdev *led_cdev,
338 			enum led_brightness value)
339 {
340 	struct asus_wmi *asus;
341 
342 	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
343 
344 	asus->tpd_led_wk = !!value;
345 	queue_work(asus->led_workqueue, &asus->tpd_led_work);
346 }
347 
read_tpd_led_state(struct asus_wmi * asus)348 static int read_tpd_led_state(struct asus_wmi *asus)
349 {
350 	return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
351 }
352 
tpd_led_get(struct led_classdev * led_cdev)353 static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
354 {
355 	struct asus_wmi *asus;
356 
357 	asus = container_of(led_cdev, struct asus_wmi, tpd_led);
358 
359 	return read_tpd_led_state(asus);
360 }
361 
asus_wmi_led_init(struct asus_wmi * asus)362 static int asus_wmi_led_init(struct asus_wmi *asus)
363 {
364 	int rv;
365 
366 	if (read_tpd_led_state(asus) < 0)
367 		return 0;
368 
369 	asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
370 	if (!asus->led_workqueue)
371 		return -ENOMEM;
372 	INIT_WORK(&asus->tpd_led_work, tpd_led_update);
373 
374 	asus->tpd_led.name = "asus::touchpad";
375 	asus->tpd_led.brightness_set = tpd_led_set;
376 	asus->tpd_led.brightness_get = tpd_led_get;
377 	asus->tpd_led.max_brightness = 1;
378 
379 	rv = led_classdev_register(&asus->platform_device->dev, &asus->tpd_led);
380 	if (rv) {
381 		destroy_workqueue(asus->led_workqueue);
382 		return rv;
383 	}
384 
385 	return 0;
386 }
387 
asus_wmi_led_exit(struct asus_wmi * asus)388 static void asus_wmi_led_exit(struct asus_wmi *asus)
389 {
390 	if (asus->tpd_led.dev)
391 		led_classdev_unregister(&asus->tpd_led);
392 	if (asus->led_workqueue)
393 		destroy_workqueue(asus->led_workqueue);
394 }
395 
396 /*
397  * PCI hotplug (for wlan rfkill)
398  */
asus_wlan_rfkill_blocked(struct asus_wmi * asus)399 static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
400 {
401 	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
402 
403 	if (result < 0)
404 		return false;
405 	return !result;
406 }
407 
asus_rfkill_hotplug(struct asus_wmi * asus)408 static void asus_rfkill_hotplug(struct asus_wmi *asus)
409 {
410 	struct pci_dev *dev;
411 	struct pci_bus *bus;
412 	bool blocked;
413 	bool absent;
414 	u32 l;
415 
416 	mutex_lock(&asus->wmi_lock);
417 	blocked = asus_wlan_rfkill_blocked(asus);
418 	mutex_unlock(&asus->wmi_lock);
419 
420 	mutex_lock(&asus->hotplug_lock);
421 
422 	if (asus->wlan.rfkill)
423 		rfkill_set_sw_state(asus->wlan.rfkill, blocked);
424 
425 	if (asus->hotplug_slot) {
426 		bus = pci_find_bus(0, 1);
427 		if (!bus) {
428 			pr_warning("Unable to find PCI bus 1?\n");
429 			goto out_unlock;
430 		}
431 
432 		if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
433 			pr_err("Unable to read PCI config space?\n");
434 			goto out_unlock;
435 		}
436 		absent = (l == 0xffffffff);
437 
438 		if (blocked != absent) {
439 			pr_warning("BIOS says wireless lan is %s, "
440 				   "but the pci device is %s\n",
441 				   blocked ? "blocked" : "unblocked",
442 				   absent ? "absent" : "present");
443 			pr_warning("skipped wireless hotplug as probably "
444 				   "inappropriate for this model\n");
445 			goto out_unlock;
446 		}
447 
448 		if (!blocked) {
449 			dev = pci_get_slot(bus, 0);
450 			if (dev) {
451 				/* Device already present */
452 				pci_dev_put(dev);
453 				goto out_unlock;
454 			}
455 			dev = pci_scan_single_device(bus, 0);
456 			if (dev) {
457 				pci_bus_assign_resources(bus);
458 				if (pci_bus_add_device(dev))
459 					pr_err("Unable to hotplug wifi\n");
460 			}
461 		} else {
462 			dev = pci_get_slot(bus, 0);
463 			if (dev) {
464 				pci_remove_bus_device(dev);
465 				pci_dev_put(dev);
466 			}
467 		}
468 	}
469 
470 out_unlock:
471 	mutex_unlock(&asus->hotplug_lock);
472 }
473 
asus_rfkill_notify(acpi_handle handle,u32 event,void * data)474 static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
475 {
476 	struct asus_wmi *asus = data;
477 
478 	if (event != ACPI_NOTIFY_BUS_CHECK)
479 		return;
480 
481 	/*
482 	 * We can't call directly asus_rfkill_hotplug because most
483 	 * of the time WMBC is still being executed and not reetrant.
484 	 * There is currently no way to tell ACPICA that  we want this
485 	 * method to be serialized, we schedule a asus_rfkill_hotplug
486 	 * call later, in a safer context.
487 	 */
488 	queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
489 }
490 
asus_register_rfkill_notifier(struct asus_wmi * asus,char * node)491 static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
492 {
493 	acpi_status status;
494 	acpi_handle handle;
495 
496 	status = acpi_get_handle(NULL, node, &handle);
497 
498 	if (ACPI_SUCCESS(status)) {
499 		status = acpi_install_notify_handler(handle,
500 						     ACPI_SYSTEM_NOTIFY,
501 						     asus_rfkill_notify, asus);
502 		if (ACPI_FAILURE(status))
503 			pr_warning("Failed to register notify on %s\n", node);
504 	} else
505 		return -ENODEV;
506 
507 	return 0;
508 }
509 
asus_unregister_rfkill_notifier(struct asus_wmi * asus,char * node)510 static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
511 {
512 	acpi_status status = AE_OK;
513 	acpi_handle handle;
514 
515 	status = acpi_get_handle(NULL, node, &handle);
516 
517 	if (ACPI_SUCCESS(status)) {
518 		status = acpi_remove_notify_handler(handle,
519 						    ACPI_SYSTEM_NOTIFY,
520 						    asus_rfkill_notify);
521 		if (ACPI_FAILURE(status))
522 			pr_err("Error removing rfkill notify handler %s\n",
523 			       node);
524 	}
525 }
526 
asus_get_adapter_status(struct hotplug_slot * hotplug_slot,u8 * value)527 static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
528 				   u8 *value)
529 {
530 	struct asus_wmi *asus = hotplug_slot->private;
531 	int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
532 
533 	if (result < 0)
534 		return result;
535 
536 	*value = !!result;
537 	return 0;
538 }
539 
asus_cleanup_pci_hotplug(struct hotplug_slot * hotplug_slot)540 static void asus_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
541 {
542 	kfree(hotplug_slot->info);
543 	kfree(hotplug_slot);
544 }
545 
546 static struct hotplug_slot_ops asus_hotplug_slot_ops = {
547 	.owner = THIS_MODULE,
548 	.get_adapter_status = asus_get_adapter_status,
549 	.get_power_status = asus_get_adapter_status,
550 };
551 
asus_hotplug_work(struct work_struct * work)552 static void asus_hotplug_work(struct work_struct *work)
553 {
554 	struct asus_wmi *asus;
555 
556 	asus = container_of(work, struct asus_wmi, hotplug_work);
557 	asus_rfkill_hotplug(asus);
558 }
559 
asus_setup_pci_hotplug(struct asus_wmi * asus)560 static int asus_setup_pci_hotplug(struct asus_wmi *asus)
561 {
562 	int ret = -ENOMEM;
563 	struct pci_bus *bus = pci_find_bus(0, 1);
564 
565 	if (!bus) {
566 		pr_err("Unable to find wifi PCI bus\n");
567 		return -ENODEV;
568 	}
569 
570 	asus->hotplug_workqueue =
571 	    create_singlethread_workqueue("hotplug_workqueue");
572 	if (!asus->hotplug_workqueue)
573 		goto error_workqueue;
574 
575 	INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
576 
577 	asus->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
578 	if (!asus->hotplug_slot)
579 		goto error_slot;
580 
581 	asus->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
582 					   GFP_KERNEL);
583 	if (!asus->hotplug_slot->info)
584 		goto error_info;
585 
586 	asus->hotplug_slot->private = asus;
587 	asus->hotplug_slot->release = &asus_cleanup_pci_hotplug;
588 	asus->hotplug_slot->ops = &asus_hotplug_slot_ops;
589 	asus_get_adapter_status(asus->hotplug_slot,
590 				&asus->hotplug_slot->info->adapter_status);
591 
592 	ret = pci_hp_register(asus->hotplug_slot, bus, 0, "asus-wifi");
593 	if (ret) {
594 		pr_err("Unable to register hotplug slot - %d\n", ret);
595 		goto error_register;
596 	}
597 
598 	return 0;
599 
600 error_register:
601 	kfree(asus->hotplug_slot->info);
602 error_info:
603 	kfree(asus->hotplug_slot);
604 	asus->hotplug_slot = NULL;
605 error_slot:
606 	destroy_workqueue(asus->hotplug_workqueue);
607 error_workqueue:
608 	return ret;
609 }
610 
611 /*
612  * Rfkill devices
613  */
asus_rfkill_set(void * data,bool blocked)614 static int asus_rfkill_set(void *data, bool blocked)
615 {
616 	struct asus_rfkill *priv = data;
617 	u32 ctrl_param = !blocked;
618 
619 	return asus_wmi_set_devstate(priv->dev_id, ctrl_param, NULL);
620 }
621 
asus_rfkill_query(struct rfkill * rfkill,void * data)622 static void asus_rfkill_query(struct rfkill *rfkill, void *data)
623 {
624 	struct asus_rfkill *priv = data;
625 	int result;
626 
627 	result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
628 
629 	if (result < 0)
630 		return;
631 
632 	rfkill_set_sw_state(priv->rfkill, !result);
633 }
634 
asus_rfkill_wlan_set(void * data,bool blocked)635 static int asus_rfkill_wlan_set(void *data, bool blocked)
636 {
637 	struct asus_rfkill *priv = data;
638 	struct asus_wmi *asus = priv->asus;
639 	int ret;
640 
641 	/*
642 	 * This handler is enabled only if hotplug is enabled.
643 	 * In this case, the asus_wmi_set_devstate() will
644 	 * trigger a wmi notification and we need to wait
645 	 * this call to finish before being able to call
646 	 * any wmi method
647 	 */
648 	mutex_lock(&asus->wmi_lock);
649 	ret = asus_rfkill_set(data, blocked);
650 	mutex_unlock(&asus->wmi_lock);
651 	return ret;
652 }
653 
654 static const struct rfkill_ops asus_rfkill_wlan_ops = {
655 	.set_block = asus_rfkill_wlan_set,
656 	.query = asus_rfkill_query,
657 };
658 
659 static const struct rfkill_ops asus_rfkill_ops = {
660 	.set_block = asus_rfkill_set,
661 	.query = asus_rfkill_query,
662 };
663 
asus_new_rfkill(struct asus_wmi * asus,struct asus_rfkill * arfkill,const char * name,enum rfkill_type type,int dev_id)664 static int asus_new_rfkill(struct asus_wmi *asus,
665 			   struct asus_rfkill *arfkill,
666 			   const char *name, enum rfkill_type type, int dev_id)
667 {
668 	int result = asus_wmi_get_devstate_simple(asus, dev_id);
669 	struct rfkill **rfkill = &arfkill->rfkill;
670 
671 	if (result < 0)
672 		return result;
673 
674 	arfkill->dev_id = dev_id;
675 	arfkill->asus = asus;
676 
677 	if (dev_id == ASUS_WMI_DEVID_WLAN && asus->driver->hotplug_wireless)
678 		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
679 				       &asus_rfkill_wlan_ops, arfkill);
680 	else
681 		*rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
682 				       &asus_rfkill_ops, arfkill);
683 
684 	if (!*rfkill)
685 		return -EINVAL;
686 
687 	rfkill_init_sw_state(*rfkill, !result);
688 	result = rfkill_register(*rfkill);
689 	if (result) {
690 		rfkill_destroy(*rfkill);
691 		*rfkill = NULL;
692 		return result;
693 	}
694 	return 0;
695 }
696 
asus_wmi_rfkill_exit(struct asus_wmi * asus)697 static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
698 {
699 	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
700 	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
701 	asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
702 	if (asus->wlan.rfkill) {
703 		rfkill_unregister(asus->wlan.rfkill);
704 		rfkill_destroy(asus->wlan.rfkill);
705 		asus->wlan.rfkill = NULL;
706 	}
707 	/*
708 	 * Refresh pci hotplug in case the rfkill state was changed after
709 	 * asus_unregister_rfkill_notifier()
710 	 */
711 	asus_rfkill_hotplug(asus);
712 	if (asus->hotplug_slot)
713 		pci_hp_deregister(asus->hotplug_slot);
714 	if (asus->hotplug_workqueue)
715 		destroy_workqueue(asus->hotplug_workqueue);
716 
717 	if (asus->bluetooth.rfkill) {
718 		rfkill_unregister(asus->bluetooth.rfkill);
719 		rfkill_destroy(asus->bluetooth.rfkill);
720 		asus->bluetooth.rfkill = NULL;
721 	}
722 	if (asus->wimax.rfkill) {
723 		rfkill_unregister(asus->wimax.rfkill);
724 		rfkill_destroy(asus->wimax.rfkill);
725 		asus->wimax.rfkill = NULL;
726 	}
727 	if (asus->wwan3g.rfkill) {
728 		rfkill_unregister(asus->wwan3g.rfkill);
729 		rfkill_destroy(asus->wwan3g.rfkill);
730 		asus->wwan3g.rfkill = NULL;
731 	}
732 }
733 
asus_wmi_rfkill_init(struct asus_wmi * asus)734 static int asus_wmi_rfkill_init(struct asus_wmi *asus)
735 {
736 	int result = 0;
737 
738 	mutex_init(&asus->hotplug_lock);
739 	mutex_init(&asus->wmi_lock);
740 
741 	result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
742 				 RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
743 
744 	if (result && result != -ENODEV)
745 		goto exit;
746 
747 	result = asus_new_rfkill(asus, &asus->bluetooth,
748 				 "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
749 				 ASUS_WMI_DEVID_BLUETOOTH);
750 
751 	if (result && result != -ENODEV)
752 		goto exit;
753 
754 	result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
755 				 RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
756 
757 	if (result && result != -ENODEV)
758 		goto exit;
759 
760 	result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
761 				 RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
762 
763 	if (result && result != -ENODEV)
764 		goto exit;
765 
766 	if (!asus->driver->hotplug_wireless)
767 		goto exit;
768 
769 	result = asus_setup_pci_hotplug(asus);
770 	/*
771 	 * If we get -EBUSY then something else is handling the PCI hotplug -
772 	 * don't fail in this case
773 	 */
774 	if (result == -EBUSY)
775 		result = 0;
776 
777 	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
778 	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
779 	asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
780 	/*
781 	 * Refresh pci hotplug in case the rfkill state was changed during
782 	 * setup.
783 	 */
784 	asus_rfkill_hotplug(asus);
785 
786 exit:
787 	if (result && result != -ENODEV)
788 		asus_wmi_rfkill_exit(asus);
789 
790 	if (result == -ENODEV)
791 		result = 0;
792 
793 	return result;
794 }
795 
796 /*
797  * Hwmon device
798  */
asus_hwmon_pwm1(struct device * dev,struct device_attribute * attr,char * buf)799 static ssize_t asus_hwmon_pwm1(struct device *dev,
800 			    struct device_attribute *attr,
801 			    char *buf)
802 {
803 	struct asus_wmi *asus = dev_get_drvdata(dev);
804 	u32 value;
805 	int err;
806 
807 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
808 
809 	if (err < 0)
810 		return err;
811 
812 	value |= 0xFF;
813 
814 	if (value == 1) /* Low Speed */
815 		value = 85;
816 	else if (value == 2)
817 		value = 170;
818 	else if (value == 3)
819 		value = 255;
820 	else if (value != 0) {
821 		pr_err("Unknown fan speed %#x", value);
822 		value = -1;
823 	}
824 
825 	return sprintf(buf, "%d\n", value);
826 }
827 
828 static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO, asus_hwmon_pwm1, NULL, 0);
829 
830 static ssize_t
show_name(struct device * dev,struct device_attribute * attr,char * buf)831 show_name(struct device *dev, struct device_attribute *attr, char *buf)
832 {
833 	return sprintf(buf, "asus\n");
834 }
835 static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0);
836 
837 static struct attribute *hwmon_attributes[] = {
838 	&sensor_dev_attr_pwm1.dev_attr.attr,
839 	&sensor_dev_attr_name.dev_attr.attr,
840 	NULL
841 };
842 
asus_hwmon_sysfs_is_visible(struct kobject * kobj,struct attribute * attr,int idx)843 static mode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
844 				    struct attribute *attr, int idx)
845 {
846 	struct device *dev = container_of(kobj, struct device, kobj);
847 	struct platform_device *pdev = to_platform_device(dev->parent);
848 	struct asus_wmi *asus = platform_get_drvdata(pdev);
849 	bool ok = true;
850 	int dev_id = -1;
851 	u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
852 
853 	if (attr == &sensor_dev_attr_pwm1.dev_attr.attr)
854 		dev_id = ASUS_WMI_DEVID_FAN_CTRL;
855 
856 	if (dev_id != -1) {
857 		int err = asus_wmi_get_devstate(asus, dev_id, &value);
858 
859 		if (err < 0)
860 			return err;
861 	}
862 
863 	if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) {
864 		/*
865 		 * We need to find a better way, probably using sfun,
866 		 * bits or spec ...
867 		 * Currently we disable it if:
868 		 * - ASUS_WMI_UNSUPPORTED_METHOD is returned
869 		 * - reverved bits are non-zero
870 		 * - sfun and presence bit are not set
871 		 */
872 		if (value != ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
873 		    || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)))
874 			ok = false;
875 	}
876 
877 	return ok ? attr->mode : 0;
878 }
879 
880 static struct attribute_group hwmon_attribute_group = {
881 	.is_visible = asus_hwmon_sysfs_is_visible,
882 	.attrs = hwmon_attributes
883 };
884 
asus_wmi_hwmon_exit(struct asus_wmi * asus)885 static void asus_wmi_hwmon_exit(struct asus_wmi *asus)
886 {
887 	struct device *hwmon;
888 
889 	hwmon = asus->hwmon_device;
890 	if (!hwmon)
891 		return;
892 	sysfs_remove_group(&hwmon->kobj, &hwmon_attribute_group);
893 	hwmon_device_unregister(hwmon);
894 	asus->hwmon_device = NULL;
895 }
896 
asus_wmi_hwmon_init(struct asus_wmi * asus)897 static int asus_wmi_hwmon_init(struct asus_wmi *asus)
898 {
899 	struct device *hwmon;
900 	int result;
901 
902 	hwmon = hwmon_device_register(&asus->platform_device->dev);
903 	if (IS_ERR(hwmon)) {
904 		pr_err("Could not register asus hwmon device\n");
905 		return PTR_ERR(hwmon);
906 	}
907 	asus->hwmon_device = hwmon;
908 	result = sysfs_create_group(&hwmon->kobj, &hwmon_attribute_group);
909 	if (result)
910 		asus_wmi_hwmon_exit(asus);
911 	return result;
912 }
913 
914 /*
915  * Backlight
916  */
read_backlight_power(struct asus_wmi * asus)917 static int read_backlight_power(struct asus_wmi *asus)
918 {
919 	int ret = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_BACKLIGHT);
920 
921 	if (ret < 0)
922 		return ret;
923 
924 	return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
925 }
926 
read_brightness_max(struct asus_wmi * asus)927 static int read_brightness_max(struct asus_wmi *asus)
928 {
929 	u32 retval;
930 	int err;
931 
932 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
933 
934 	if (err < 0)
935 		return err;
936 
937 	retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
938 	retval >>= 8;
939 
940 	if (!retval)
941 		return -ENODEV;
942 
943 	return retval;
944 }
945 
read_brightness(struct backlight_device * bd)946 static int read_brightness(struct backlight_device *bd)
947 {
948 	struct asus_wmi *asus = bl_get_data(bd);
949 	u32 retval;
950 	int err;
951 
952 	err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
953 
954 	if (err < 0)
955 		return err;
956 
957 	return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
958 }
959 
update_bl_status(struct backlight_device * bd)960 static int update_bl_status(struct backlight_device *bd)
961 {
962 	struct asus_wmi *asus = bl_get_data(bd);
963 	u32 ctrl_param;
964 	int power, err;
965 
966 	ctrl_param = bd->props.brightness;
967 
968 	err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
969 				    ctrl_param, NULL);
970 
971 	if (err < 0)
972 		return err;
973 
974 	power = read_backlight_power(asus);
975 	if (power != -ENODEV && bd->props.power != power) {
976 		ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
977 		err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
978 					    ctrl_param, NULL);
979 	}
980 	return err;
981 }
982 
983 static const struct backlight_ops asus_wmi_bl_ops = {
984 	.get_brightness = read_brightness,
985 	.update_status = update_bl_status,
986 };
987 
asus_wmi_backlight_notify(struct asus_wmi * asus,int code)988 static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
989 {
990 	struct backlight_device *bd = asus->backlight_device;
991 	int old = bd->props.brightness;
992 	int new = old;
993 
994 	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
995 		new = code - NOTIFY_BRNUP_MIN + 1;
996 	else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
997 		new = code - NOTIFY_BRNDOWN_MIN;
998 
999 	bd->props.brightness = new;
1000 	backlight_update_status(bd);
1001 	backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1002 
1003 	return old;
1004 }
1005 
asus_wmi_backlight_init(struct asus_wmi * asus)1006 static int asus_wmi_backlight_init(struct asus_wmi *asus)
1007 {
1008 	struct backlight_device *bd;
1009 	struct backlight_properties props;
1010 	int max;
1011 	int power;
1012 
1013 	max = read_brightness_max(asus);
1014 
1015 	if (max == -ENODEV)
1016 		max = 0;
1017 	else if (max < 0)
1018 		return max;
1019 
1020 	power = read_backlight_power(asus);
1021 
1022 	if (power == -ENODEV)
1023 		power = FB_BLANK_UNBLANK;
1024 	else if (power < 0)
1025 		return power;
1026 
1027 	memset(&props, 0, sizeof(struct backlight_properties));
1028 	props.max_brightness = max;
1029 	bd = backlight_device_register(asus->driver->name,
1030 				       &asus->platform_device->dev, asus,
1031 				       &asus_wmi_bl_ops, &props);
1032 	if (IS_ERR(bd)) {
1033 		pr_err("Could not register backlight device\n");
1034 		return PTR_ERR(bd);
1035 	}
1036 
1037 	asus->backlight_device = bd;
1038 
1039 	bd->props.brightness = read_brightness(bd);
1040 	bd->props.power = power;
1041 	backlight_update_status(bd);
1042 
1043 	return 0;
1044 }
1045 
asus_wmi_backlight_exit(struct asus_wmi * asus)1046 static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1047 {
1048 	if (asus->backlight_device)
1049 		backlight_device_unregister(asus->backlight_device);
1050 
1051 	asus->backlight_device = NULL;
1052 }
1053 
asus_wmi_notify(u32 value,void * context)1054 static void asus_wmi_notify(u32 value, void *context)
1055 {
1056 	struct asus_wmi *asus = context;
1057 	struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1058 	union acpi_object *obj;
1059 	acpi_status status;
1060 	int code;
1061 	int orig_code;
1062 
1063 	status = wmi_get_event_data(value, &response);
1064 	if (status != AE_OK) {
1065 		pr_err("bad event status 0x%x\n", status);
1066 		return;
1067 	}
1068 
1069 	obj = (union acpi_object *)response.pointer;
1070 
1071 	if (!obj || obj->type != ACPI_TYPE_INTEGER)
1072 		goto exit;
1073 
1074 	code = obj->integer.value;
1075 	orig_code = code;
1076 
1077 	if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1078 		code = NOTIFY_BRNUP_MIN;
1079 	else if (code >= NOTIFY_BRNDOWN_MIN &&
1080 		 code <= NOTIFY_BRNDOWN_MAX)
1081 		code = NOTIFY_BRNDOWN_MIN;
1082 
1083 	if (code == NOTIFY_BRNUP_MIN || code == NOTIFY_BRNDOWN_MIN) {
1084 		if (!acpi_video_backlight_support())
1085 			asus_wmi_backlight_notify(asus, orig_code);
1086 	} else if (!sparse_keymap_report_event(asus->inputdev, code, 1, true))
1087 		pr_info("Unknown key %x pressed\n", code);
1088 
1089 exit:
1090 	kfree(obj);
1091 }
1092 
1093 /*
1094  * Sys helpers
1095  */
parse_arg(const char * buf,unsigned long count,int * val)1096 static int parse_arg(const char *buf, unsigned long count, int *val)
1097 {
1098 	if (!count)
1099 		return 0;
1100 	if (sscanf(buf, "%i", val) != 1)
1101 		return -EINVAL;
1102 	return count;
1103 }
1104 
store_sys_wmi(struct asus_wmi * asus,int devid,const char * buf,size_t count)1105 static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1106 			     const char *buf, size_t count)
1107 {
1108 	u32 retval;
1109 	int rv, err, value;
1110 
1111 	value = asus_wmi_get_devstate_simple(asus, devid);
1112 	if (value == -ENODEV)	/* Check device presence */
1113 		return value;
1114 
1115 	rv = parse_arg(buf, count, &value);
1116 	err = asus_wmi_set_devstate(devid, value, &retval);
1117 
1118 	if (err < 0)
1119 		return err;
1120 
1121 	return rv;
1122 }
1123 
show_sys_wmi(struct asus_wmi * asus,int devid,char * buf)1124 static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1125 {
1126 	int value = asus_wmi_get_devstate_simple(asus, devid);
1127 
1128 	if (value < 0)
1129 		return value;
1130 
1131 	return sprintf(buf, "%d\n", value);
1132 }
1133 
1134 #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)			\
1135 	static ssize_t show_##_name(struct device *dev,			\
1136 				    struct device_attribute *attr,	\
1137 				    char *buf)				\
1138 	{								\
1139 		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1140 									\
1141 		return show_sys_wmi(asus, _cm, buf);			\
1142 	}								\
1143 	static ssize_t store_##_name(struct device *dev,		\
1144 				     struct device_attribute *attr,	\
1145 				     const char *buf, size_t count)	\
1146 	{								\
1147 		struct asus_wmi *asus = dev_get_drvdata(dev);		\
1148 									\
1149 		return store_sys_wmi(asus, _cm, buf, count);		\
1150 	}								\
1151 	static struct device_attribute dev_attr_##_name = {		\
1152 		.attr = {						\
1153 			.name = __stringify(_name),			\
1154 			.mode = _mode },				\
1155 		.show   = show_##_name,					\
1156 		.store  = store_##_name,				\
1157 	}
1158 
1159 ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1160 ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1161 ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
1162 
store_cpufv(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)1163 static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr,
1164 			   const char *buf, size_t count)
1165 {
1166 	int value;
1167 
1168 	if (!count || sscanf(buf, "%i", &value) != 1)
1169 		return -EINVAL;
1170 	if (value < 0 || value > 2)
1171 		return -EINVAL;
1172 
1173 	return asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1174 }
1175 
1176 static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv);
1177 
1178 static struct attribute *platform_attributes[] = {
1179 	&dev_attr_cpufv.attr,
1180 	&dev_attr_camera.attr,
1181 	&dev_attr_cardr.attr,
1182 	&dev_attr_touchpad.attr,
1183 	NULL
1184 };
1185 
asus_sysfs_is_visible(struct kobject * kobj,struct attribute * attr,int idx)1186 static mode_t asus_sysfs_is_visible(struct kobject *kobj,
1187 				    struct attribute *attr, int idx)
1188 {
1189 	struct device *dev = container_of(kobj, struct device, kobj);
1190 	struct platform_device *pdev = to_platform_device(dev);
1191 	struct asus_wmi *asus = platform_get_drvdata(pdev);
1192 	bool ok = true;
1193 	int devid = -1;
1194 
1195 	if (attr == &dev_attr_camera.attr)
1196 		devid = ASUS_WMI_DEVID_CAMERA;
1197 	else if (attr == &dev_attr_cardr.attr)
1198 		devid = ASUS_WMI_DEVID_CARDREADER;
1199 	else if (attr == &dev_attr_touchpad.attr)
1200 		devid = ASUS_WMI_DEVID_TOUCHPAD;
1201 
1202 	if (devid != -1)
1203 		ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1204 
1205 	return ok ? attr->mode : 0;
1206 }
1207 
1208 static struct attribute_group platform_attribute_group = {
1209 	.is_visible = asus_sysfs_is_visible,
1210 	.attrs = platform_attributes
1211 };
1212 
asus_wmi_sysfs_exit(struct platform_device * device)1213 static void asus_wmi_sysfs_exit(struct platform_device *device)
1214 {
1215 	sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1216 }
1217 
asus_wmi_sysfs_init(struct platform_device * device)1218 static int asus_wmi_sysfs_init(struct platform_device *device)
1219 {
1220 	return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1221 }
1222 
1223 /*
1224  * Platform device
1225  */
asus_wmi_platform_init(struct asus_wmi * asus)1226 static int __init asus_wmi_platform_init(struct asus_wmi *asus)
1227 {
1228 	int rv;
1229 
1230 	/* INIT enable hotkeys on some models */
1231 	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1232 		pr_info("Initialization: %#x", rv);
1233 
1234 	/* We don't know yet what to do with this version... */
1235 	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1236 		pr_info("BIOS WMI version: %d.%d", rv >> 8, rv & 0xFF);
1237 		asus->spec = rv;
1238 	}
1239 
1240 	/*
1241 	 * The SFUN method probably allows the original driver to get the list
1242 	 * of features supported by a given model. For now, 0x0100 or 0x0800
1243 	 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1244 	 * The significance of others is yet to be found.
1245 	 */
1246 	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1247 		pr_info("SFUN value: %#x", rv);
1248 		asus->sfun = rv;
1249 	}
1250 
1251 	/*
1252 	 * Eee PC and Notebooks seems to have different method_id for DSTS,
1253 	 * but it may also be related to the BIOS's SPEC.
1254 	 * Note, on most Eeepc, there is no way to check if a method exist
1255 	 * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1256 	 * but once again, SPEC may probably be used for that kind of things.
1257 	 */
1258 	if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
1259 		asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1260 	else if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS2, 0, 0, NULL))
1261 		asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1262 
1263 	if (!asus->dsts_id) {
1264 		pr_err("Can't find DSTS");
1265 		return -ENODEV;
1266 	}
1267 
1268 	return asus_wmi_sysfs_init(asus->platform_device);
1269 }
1270 
asus_wmi_platform_exit(struct asus_wmi * asus)1271 static void asus_wmi_platform_exit(struct asus_wmi *asus)
1272 {
1273 	asus_wmi_sysfs_exit(asus->platform_device);
1274 }
1275 
1276 /*
1277  * debugfs
1278  */
1279 struct asus_wmi_debugfs_node {
1280 	struct asus_wmi *asus;
1281 	char *name;
1282 	int (*show) (struct seq_file *m, void *data);
1283 };
1284 
show_dsts(struct seq_file * m,void * data)1285 static int show_dsts(struct seq_file *m, void *data)
1286 {
1287 	struct asus_wmi *asus = m->private;
1288 	int err;
1289 	u32 retval = -1;
1290 
1291 	err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1292 
1293 	if (err < 0)
1294 		return err;
1295 
1296 	seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1297 
1298 	return 0;
1299 }
1300 
show_devs(struct seq_file * m,void * data)1301 static int show_devs(struct seq_file *m, void *data)
1302 {
1303 	struct asus_wmi *asus = m->private;
1304 	int err;
1305 	u32 retval = -1;
1306 
1307 	err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
1308 				    &retval);
1309 
1310 	if (err < 0)
1311 		return err;
1312 
1313 	seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1314 		   asus->debug.ctrl_param, retval);
1315 
1316 	return 0;
1317 }
1318 
show_call(struct seq_file * m,void * data)1319 static int show_call(struct seq_file *m, void *data)
1320 {
1321 	struct asus_wmi *asus = m->private;
1322 	struct bios_args args = {
1323 		.arg0 = asus->debug.dev_id,
1324 		.arg1 = asus->debug.ctrl_param,
1325 	};
1326 	struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1327 	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
1328 	union acpi_object *obj;
1329 	acpi_status status;
1330 
1331 	status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
1332 				     1, asus->debug.method_id,
1333 				     &input, &output);
1334 
1335 	if (ACPI_FAILURE(status))
1336 		return -EIO;
1337 
1338 	obj = (union acpi_object *)output.pointer;
1339 	if (obj && obj->type == ACPI_TYPE_INTEGER)
1340 		seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
1341 			   asus->debug.dev_id, asus->debug.ctrl_param,
1342 			   (u32) obj->integer.value);
1343 	else
1344 		seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
1345 			   asus->debug.dev_id, asus->debug.ctrl_param,
1346 			   obj ? obj->type : -1);
1347 
1348 	kfree(obj);
1349 
1350 	return 0;
1351 }
1352 
1353 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
1354 	{NULL, "devs", show_devs},
1355 	{NULL, "dsts", show_dsts},
1356 	{NULL, "call", show_call},
1357 };
1358 
asus_wmi_debugfs_open(struct inode * inode,struct file * file)1359 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
1360 {
1361 	struct asus_wmi_debugfs_node *node = inode->i_private;
1362 
1363 	return single_open(file, node->show, node->asus);
1364 }
1365 
1366 static const struct file_operations asus_wmi_debugfs_io_ops = {
1367 	.owner = THIS_MODULE,
1368 	.open = asus_wmi_debugfs_open,
1369 	.read = seq_read,
1370 	.llseek = seq_lseek,
1371 	.release = single_release,
1372 };
1373 
asus_wmi_debugfs_exit(struct asus_wmi * asus)1374 static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
1375 {
1376 	debugfs_remove_recursive(asus->debug.root);
1377 }
1378 
asus_wmi_debugfs_init(struct asus_wmi * asus)1379 static int asus_wmi_debugfs_init(struct asus_wmi *asus)
1380 {
1381 	struct dentry *dent;
1382 	int i;
1383 
1384 	asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
1385 	if (!asus->debug.root) {
1386 		pr_err("failed to create debugfs directory");
1387 		goto error_debugfs;
1388 	}
1389 
1390 	dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
1391 				  asus->debug.root, &asus->debug.method_id);
1392 	if (!dent)
1393 		goto error_debugfs;
1394 
1395 	dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
1396 				  asus->debug.root, &asus->debug.dev_id);
1397 	if (!dent)
1398 		goto error_debugfs;
1399 
1400 	dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
1401 				  asus->debug.root, &asus->debug.ctrl_param);
1402 	if (!dent)
1403 		goto error_debugfs;
1404 
1405 	for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
1406 		struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
1407 
1408 		node->asus = asus;
1409 		dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
1410 					   asus->debug.root, node,
1411 					   &asus_wmi_debugfs_io_ops);
1412 		if (!dent) {
1413 			pr_err("failed to create debug file: %s\n", node->name);
1414 			goto error_debugfs;
1415 		}
1416 	}
1417 
1418 	return 0;
1419 
1420 error_debugfs:
1421 	asus_wmi_debugfs_exit(asus);
1422 	return -ENOMEM;
1423 }
1424 
1425 /*
1426  * WMI Driver
1427  */
asus_wmi_add(struct platform_device * pdev)1428 static int asus_wmi_add(struct platform_device *pdev)
1429 {
1430 	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1431 	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1432 	struct asus_wmi *asus;
1433 	acpi_status status;
1434 	int err;
1435 
1436 	asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
1437 	if (!asus)
1438 		return -ENOMEM;
1439 
1440 	asus->driver = wdrv;
1441 	asus->platform_device = pdev;
1442 	wdrv->platform_device = pdev;
1443 	platform_set_drvdata(asus->platform_device, asus);
1444 
1445 	if (wdrv->quirks)
1446 		wdrv->quirks(asus->driver);
1447 
1448 	err = asus_wmi_platform_init(asus);
1449 	if (err)
1450 		goto fail_platform;
1451 
1452 	err = asus_wmi_input_init(asus);
1453 	if (err)
1454 		goto fail_input;
1455 
1456 	err = asus_wmi_hwmon_init(asus);
1457 	if (err)
1458 		goto fail_hwmon;
1459 
1460 	err = asus_wmi_led_init(asus);
1461 	if (err)
1462 		goto fail_leds;
1463 
1464 	err = asus_wmi_rfkill_init(asus);
1465 	if (err)
1466 		goto fail_rfkill;
1467 
1468 	if (!acpi_video_backlight_support()) {
1469 		err = asus_wmi_backlight_init(asus);
1470 		if (err && err != -ENODEV)
1471 			goto fail_backlight;
1472 	} else
1473 		pr_info("Backlight controlled by ACPI video driver\n");
1474 
1475 	status = wmi_install_notify_handler(asus->driver->event_guid,
1476 					    asus_wmi_notify, asus);
1477 	if (ACPI_FAILURE(status)) {
1478 		pr_err("Unable to register notify handler - %d\n", status);
1479 		err = -ENODEV;
1480 		goto fail_wmi_handler;
1481 	}
1482 
1483 	err = asus_wmi_debugfs_init(asus);
1484 	if (err)
1485 		goto fail_debugfs;
1486 
1487 	return 0;
1488 
1489 fail_debugfs:
1490 	wmi_remove_notify_handler(asus->driver->event_guid);
1491 fail_wmi_handler:
1492 	asus_wmi_backlight_exit(asus);
1493 fail_backlight:
1494 	asus_wmi_rfkill_exit(asus);
1495 fail_rfkill:
1496 	asus_wmi_led_exit(asus);
1497 fail_leds:
1498 	asus_wmi_hwmon_exit(asus);
1499 fail_hwmon:
1500 	asus_wmi_input_exit(asus);
1501 fail_input:
1502 	asus_wmi_platform_exit(asus);
1503 fail_platform:
1504 	kfree(asus);
1505 	return err;
1506 }
1507 
asus_wmi_remove(struct platform_device * device)1508 static int asus_wmi_remove(struct platform_device *device)
1509 {
1510 	struct asus_wmi *asus;
1511 
1512 	asus = platform_get_drvdata(device);
1513 	wmi_remove_notify_handler(asus->driver->event_guid);
1514 	asus_wmi_backlight_exit(asus);
1515 	asus_wmi_input_exit(asus);
1516 	asus_wmi_hwmon_exit(asus);
1517 	asus_wmi_led_exit(asus);
1518 	asus_wmi_rfkill_exit(asus);
1519 	asus_wmi_debugfs_exit(asus);
1520 	asus_wmi_platform_exit(asus);
1521 
1522 	kfree(asus);
1523 	return 0;
1524 }
1525 
1526 /*
1527  * Platform driver - hibernate/resume callbacks
1528  */
asus_hotk_thaw(struct device * device)1529 static int asus_hotk_thaw(struct device *device)
1530 {
1531 	struct asus_wmi *asus = dev_get_drvdata(device);
1532 
1533 	if (asus->wlan.rfkill) {
1534 		bool wlan;
1535 
1536 		/*
1537 		 * Work around bios bug - acpi _PTS turns off the wireless led
1538 		 * during suspend.  Normally it restores it on resume, but
1539 		 * we should kick it ourselves in case hibernation is aborted.
1540 		 */
1541 		wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
1542 		asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
1543 	}
1544 
1545 	return 0;
1546 }
1547 
asus_hotk_restore(struct device * device)1548 static int asus_hotk_restore(struct device *device)
1549 {
1550 	struct asus_wmi *asus = dev_get_drvdata(device);
1551 	int bl;
1552 
1553 	/* Refresh both wlan rfkill state and pci hotplug */
1554 	if (asus->wlan.rfkill)
1555 		asus_rfkill_hotplug(asus);
1556 
1557 	if (asus->bluetooth.rfkill) {
1558 		bl = !asus_wmi_get_devstate_simple(asus,
1559 						   ASUS_WMI_DEVID_BLUETOOTH);
1560 		rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
1561 	}
1562 	if (asus->wimax.rfkill) {
1563 		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
1564 		rfkill_set_sw_state(asus->wimax.rfkill, bl);
1565 	}
1566 	if (asus->wwan3g.rfkill) {
1567 		bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
1568 		rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
1569 	}
1570 
1571 	return 0;
1572 }
1573 
1574 static const struct dev_pm_ops asus_pm_ops = {
1575 	.thaw = asus_hotk_thaw,
1576 	.restore = asus_hotk_restore,
1577 };
1578 
asus_wmi_probe(struct platform_device * pdev)1579 static int asus_wmi_probe(struct platform_device *pdev)
1580 {
1581 	struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1582 	struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1583 	int ret;
1584 
1585 	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1586 		pr_warning("Management GUID not found\n");
1587 		return -ENODEV;
1588 	}
1589 
1590 	if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
1591 		pr_warning("Event GUID not found\n");
1592 		return -ENODEV;
1593 	}
1594 
1595 	if (wdrv->probe) {
1596 		ret = wdrv->probe(pdev);
1597 		if (ret)
1598 			return ret;
1599 	}
1600 
1601 	return asus_wmi_add(pdev);
1602 }
1603 
1604 static bool used;
1605 
asus_wmi_register_driver(struct asus_wmi_driver * driver)1606 int asus_wmi_register_driver(struct asus_wmi_driver *driver)
1607 {
1608 	struct platform_driver *platform_driver;
1609 	struct platform_device *platform_device;
1610 
1611 	if (used)
1612 		return -EBUSY;
1613 
1614 	platform_driver = &driver->platform_driver;
1615 	platform_driver->remove = asus_wmi_remove;
1616 	platform_driver->driver.owner = driver->owner;
1617 	platform_driver->driver.name = driver->name;
1618 	platform_driver->driver.pm = &asus_pm_ops;
1619 
1620 	platform_device = platform_create_bundle(platform_driver,
1621 						 asus_wmi_probe,
1622 						 NULL, 0, NULL, 0);
1623 	if (IS_ERR(platform_device))
1624 		return PTR_ERR(platform_device);
1625 
1626 	used = true;
1627 	return 0;
1628 }
1629 EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
1630 
asus_wmi_unregister_driver(struct asus_wmi_driver * driver)1631 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
1632 {
1633 	platform_device_unregister(driver->platform_device);
1634 	platform_driver_unregister(&driver->platform_driver);
1635 	used = false;
1636 }
1637 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
1638 
asus_wmi_init(void)1639 static int __init asus_wmi_init(void)
1640 {
1641 	if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1642 		pr_info("Asus Management GUID not found");
1643 		return -ENODEV;
1644 	}
1645 
1646 	pr_info("ASUS WMI generic driver loaded");
1647 	return 0;
1648 }
1649 
asus_wmi_exit(void)1650 static void __exit asus_wmi_exit(void)
1651 {
1652 	pr_info("ASUS WMI generic driver unloaded");
1653 }
1654 
1655 module_init(asus_wmi_init);
1656 module_exit(asus_wmi_exit);
1657