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