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