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