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