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