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