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