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