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