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