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