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