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; 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 if (kbd_led_read(asus, NULL, NULL) >= 0) { 606 INIT_WORK(&asus->kbd_led_work, kbd_led_update); 607 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 = 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 == -ENODEV) /* Check device presence */ 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 1735 static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr, 1736 const char *buf, size_t count) 1737 { 1738 int value, rv; 1739 1740 if (!count || sscanf(buf, "%i", &value) != 1) 1741 return -EINVAL; 1742 if (value < 0 || value > 2) 1743 return -EINVAL; 1744 1745 rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL); 1746 if (rv < 0) 1747 return rv; 1748 1749 return count; 1750 } 1751 1752 static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv); 1753 1754 static struct attribute *platform_attributes[] = { 1755 &dev_attr_cpufv.attr, 1756 &dev_attr_camera.attr, 1757 &dev_attr_cardr.attr, 1758 &dev_attr_touchpad.attr, 1759 &dev_attr_lid_resume.attr, 1760 NULL 1761 }; 1762 1763 static umode_t asus_sysfs_is_visible(struct kobject *kobj, 1764 struct attribute *attr, int idx) 1765 { 1766 struct device *dev = container_of(kobj, struct device, kobj); 1767 struct platform_device *pdev = to_platform_device(dev); 1768 struct asus_wmi *asus = platform_get_drvdata(pdev); 1769 bool ok = true; 1770 int devid = -1; 1771 1772 if (attr == &dev_attr_camera.attr) 1773 devid = ASUS_WMI_DEVID_CAMERA; 1774 else if (attr == &dev_attr_cardr.attr) 1775 devid = ASUS_WMI_DEVID_CARDREADER; 1776 else if (attr == &dev_attr_touchpad.attr) 1777 devid = ASUS_WMI_DEVID_TOUCHPAD; 1778 else if (attr == &dev_attr_lid_resume.attr) 1779 devid = ASUS_WMI_DEVID_LID_RESUME; 1780 1781 if (devid != -1) 1782 ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0); 1783 1784 return ok ? attr->mode : 0; 1785 } 1786 1787 static struct attribute_group platform_attribute_group = { 1788 .is_visible = asus_sysfs_is_visible, 1789 .attrs = platform_attributes 1790 }; 1791 1792 static void asus_wmi_sysfs_exit(struct platform_device *device) 1793 { 1794 sysfs_remove_group(&device->dev.kobj, &platform_attribute_group); 1795 } 1796 1797 static int asus_wmi_sysfs_init(struct platform_device *device) 1798 { 1799 return sysfs_create_group(&device->dev.kobj, &platform_attribute_group); 1800 } 1801 1802 /* 1803 * Platform device 1804 */ 1805 static int asus_wmi_platform_init(struct asus_wmi *asus) 1806 { 1807 int rv; 1808 1809 /* INIT enable hotkeys on some models */ 1810 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv)) 1811 pr_info("Initialization: %#x\n", rv); 1812 1813 /* We don't know yet what to do with this version... */ 1814 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) { 1815 pr_info("BIOS WMI version: %d.%d\n", rv >> 16, rv & 0xFF); 1816 asus->spec = rv; 1817 } 1818 1819 /* 1820 * The SFUN method probably allows the original driver to get the list 1821 * of features supported by a given model. For now, 0x0100 or 0x0800 1822 * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card. 1823 * The significance of others is yet to be found. 1824 */ 1825 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) { 1826 pr_info("SFUN value: %#x\n", rv); 1827 asus->sfun = rv; 1828 } 1829 1830 /* 1831 * Eee PC and Notebooks seems to have different method_id for DSTS, 1832 * but it may also be related to the BIOS's SPEC. 1833 * Note, on most Eeepc, there is no way to check if a method exist 1834 * or note, while on notebooks, they returns 0xFFFFFFFE on failure, 1835 * but once again, SPEC may probably be used for that kind of things. 1836 */ 1837 if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL)) 1838 asus->dsts_id = ASUS_WMI_METHODID_DSTS; 1839 else 1840 asus->dsts_id = ASUS_WMI_METHODID_DSTS2; 1841 1842 /* CWAP allow to define the behavior of the Fn+F2 key, 1843 * this method doesn't seems to be present on Eee PCs */ 1844 if (asus->driver->quirks->wapf >= 0) 1845 asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP, 1846 asus->driver->quirks->wapf, NULL); 1847 1848 return asus_wmi_sysfs_init(asus->platform_device); 1849 } 1850 1851 static void asus_wmi_platform_exit(struct asus_wmi *asus) 1852 { 1853 asus_wmi_sysfs_exit(asus->platform_device); 1854 } 1855 1856 /* 1857 * debugfs 1858 */ 1859 struct asus_wmi_debugfs_node { 1860 struct asus_wmi *asus; 1861 char *name; 1862 int (*show) (struct seq_file *m, void *data); 1863 }; 1864 1865 static int show_dsts(struct seq_file *m, void *data) 1866 { 1867 struct asus_wmi *asus = m->private; 1868 int err; 1869 u32 retval = -1; 1870 1871 err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval); 1872 1873 if (err < 0) 1874 return err; 1875 1876 seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval); 1877 1878 return 0; 1879 } 1880 1881 static int show_devs(struct seq_file *m, void *data) 1882 { 1883 struct asus_wmi *asus = m->private; 1884 int err; 1885 u32 retval = -1; 1886 1887 err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param, 1888 &retval); 1889 1890 if (err < 0) 1891 return err; 1892 1893 seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id, 1894 asus->debug.ctrl_param, retval); 1895 1896 return 0; 1897 } 1898 1899 static int show_call(struct seq_file *m, void *data) 1900 { 1901 struct asus_wmi *asus = m->private; 1902 struct bios_args args = { 1903 .arg0 = asus->debug.dev_id, 1904 .arg1 = asus->debug.ctrl_param, 1905 }; 1906 struct acpi_buffer input = { (acpi_size) sizeof(args), &args }; 1907 struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL }; 1908 union acpi_object *obj; 1909 acpi_status status; 1910 1911 status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 1912 1, asus->debug.method_id, 1913 &input, &output); 1914 1915 if (ACPI_FAILURE(status)) 1916 return -EIO; 1917 1918 obj = (union acpi_object *)output.pointer; 1919 if (obj && obj->type == ACPI_TYPE_INTEGER) 1920 seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id, 1921 asus->debug.dev_id, asus->debug.ctrl_param, 1922 (u32) obj->integer.value); 1923 else 1924 seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id, 1925 asus->debug.dev_id, asus->debug.ctrl_param, 1926 obj ? obj->type : -1); 1927 1928 kfree(obj); 1929 1930 return 0; 1931 } 1932 1933 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = { 1934 {NULL, "devs", show_devs}, 1935 {NULL, "dsts", show_dsts}, 1936 {NULL, "call", show_call}, 1937 }; 1938 1939 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file) 1940 { 1941 struct asus_wmi_debugfs_node *node = inode->i_private; 1942 1943 return single_open(file, node->show, node->asus); 1944 } 1945 1946 static const struct file_operations asus_wmi_debugfs_io_ops = { 1947 .owner = THIS_MODULE, 1948 .open = asus_wmi_debugfs_open, 1949 .read = seq_read, 1950 .llseek = seq_lseek, 1951 .release = single_release, 1952 }; 1953 1954 static void asus_wmi_debugfs_exit(struct asus_wmi *asus) 1955 { 1956 debugfs_remove_recursive(asus->debug.root); 1957 } 1958 1959 static int asus_wmi_debugfs_init(struct asus_wmi *asus) 1960 { 1961 struct dentry *dent; 1962 int i; 1963 1964 asus->debug.root = debugfs_create_dir(asus->driver->name, NULL); 1965 if (!asus->debug.root) { 1966 pr_err("failed to create debugfs directory\n"); 1967 goto error_debugfs; 1968 } 1969 1970 dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR, 1971 asus->debug.root, &asus->debug.method_id); 1972 if (!dent) 1973 goto error_debugfs; 1974 1975 dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR, 1976 asus->debug.root, &asus->debug.dev_id); 1977 if (!dent) 1978 goto error_debugfs; 1979 1980 dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR, 1981 asus->debug.root, &asus->debug.ctrl_param); 1982 if (!dent) 1983 goto error_debugfs; 1984 1985 for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) { 1986 struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i]; 1987 1988 node->asus = asus; 1989 dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO, 1990 asus->debug.root, node, 1991 &asus_wmi_debugfs_io_ops); 1992 if (!dent) { 1993 pr_err("failed to create debug file: %s\n", node->name); 1994 goto error_debugfs; 1995 } 1996 } 1997 1998 return 0; 1999 2000 error_debugfs: 2001 asus_wmi_debugfs_exit(asus); 2002 return -ENOMEM; 2003 } 2004 2005 static int asus_wmi_fan_init(struct asus_wmi *asus) 2006 { 2007 int status; 2008 2009 asus->asus_hwmon_pwm = -1; 2010 asus->asus_hwmon_num_fans = -1; 2011 asus->asus_hwmon_fan_manual_mode = false; 2012 2013 status = asus_hwmon_get_fan_number(asus, &asus->asus_hwmon_num_fans); 2014 if (status) { 2015 asus->asus_hwmon_num_fans = 0; 2016 pr_warn("Could not determine number of fans: %d\n", status); 2017 return -ENXIO; 2018 } 2019 2020 pr_info("Number of fans: %d\n", asus->asus_hwmon_num_fans); 2021 return 0; 2022 } 2023 2024 /* 2025 * WMI Driver 2026 */ 2027 static int asus_wmi_add(struct platform_device *pdev) 2028 { 2029 struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver); 2030 struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv); 2031 struct asus_wmi *asus; 2032 const char *chassis_type; 2033 acpi_status status; 2034 int err; 2035 u32 result; 2036 2037 asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL); 2038 if (!asus) 2039 return -ENOMEM; 2040 2041 asus->driver = wdrv; 2042 asus->platform_device = pdev; 2043 wdrv->platform_device = pdev; 2044 platform_set_drvdata(asus->platform_device, asus); 2045 2046 if (wdrv->detect_quirks) 2047 wdrv->detect_quirks(asus->driver); 2048 2049 err = asus_wmi_platform_init(asus); 2050 if (err) 2051 goto fail_platform; 2052 2053 err = asus_wmi_input_init(asus); 2054 if (err) 2055 goto fail_input; 2056 2057 err = asus_wmi_fan_init(asus); /* probably no problems on error */ 2058 asus_hwmon_fan_set_auto(asus); 2059 2060 err = asus_wmi_hwmon_init(asus); 2061 if (err) 2062 goto fail_hwmon; 2063 2064 err = asus_wmi_led_init(asus); 2065 if (err) 2066 goto fail_leds; 2067 2068 err = asus_wmi_rfkill_init(asus); 2069 if (err) 2070 goto fail_rfkill; 2071 2072 /* Some Asus desktop boards export an acpi-video backlight interface, 2073 stop this from showing up */ 2074 chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE); 2075 if (chassis_type && !strcmp(chassis_type, "3")) 2076 acpi_video_set_dmi_backlight_type(acpi_backlight_vendor); 2077 2078 if (asus->driver->quirks->wmi_backlight_power) 2079 acpi_video_set_dmi_backlight_type(acpi_backlight_vendor); 2080 2081 if (acpi_video_get_backlight_type() == acpi_backlight_vendor) { 2082 err = asus_wmi_backlight_init(asus); 2083 if (err && err != -ENODEV) 2084 goto fail_backlight; 2085 } 2086 2087 status = wmi_install_notify_handler(asus->driver->event_guid, 2088 asus_wmi_notify, asus); 2089 if (ACPI_FAILURE(status)) { 2090 pr_err("Unable to register notify handler - %d\n", status); 2091 err = -ENODEV; 2092 goto fail_wmi_handler; 2093 } 2094 2095 err = asus_wmi_debugfs_init(asus); 2096 if (err) 2097 goto fail_debugfs; 2098 2099 asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WLAN, &result); 2100 if (result & (ASUS_WMI_DSTS_PRESENCE_BIT | ASUS_WMI_DSTS_USER_BIT)) 2101 asus->driver->wlan_ctrl_by_user = 1; 2102 2103 return 0; 2104 2105 fail_debugfs: 2106 wmi_remove_notify_handler(asus->driver->event_guid); 2107 fail_wmi_handler: 2108 asus_wmi_backlight_exit(asus); 2109 fail_backlight: 2110 asus_wmi_rfkill_exit(asus); 2111 fail_rfkill: 2112 asus_wmi_led_exit(asus); 2113 fail_leds: 2114 fail_hwmon: 2115 asus_wmi_input_exit(asus); 2116 fail_input: 2117 asus_wmi_platform_exit(asus); 2118 fail_platform: 2119 kfree(asus); 2120 return err; 2121 } 2122 2123 static int asus_wmi_remove(struct platform_device *device) 2124 { 2125 struct asus_wmi *asus; 2126 2127 asus = platform_get_drvdata(device); 2128 wmi_remove_notify_handler(asus->driver->event_guid); 2129 asus_wmi_backlight_exit(asus); 2130 asus_wmi_input_exit(asus); 2131 asus_wmi_led_exit(asus); 2132 asus_wmi_rfkill_exit(asus); 2133 asus_wmi_debugfs_exit(asus); 2134 asus_wmi_platform_exit(asus); 2135 asus_hwmon_fan_set_auto(asus); 2136 2137 kfree(asus); 2138 return 0; 2139 } 2140 2141 /* 2142 * Platform driver - hibernate/resume callbacks 2143 */ 2144 static int asus_hotk_thaw(struct device *device) 2145 { 2146 struct asus_wmi *asus = dev_get_drvdata(device); 2147 2148 if (asus->wlan.rfkill) { 2149 bool wlan; 2150 2151 /* 2152 * Work around bios bug - acpi _PTS turns off the wireless led 2153 * during suspend. Normally it restores it on resume, but 2154 * we should kick it ourselves in case hibernation is aborted. 2155 */ 2156 wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN); 2157 asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL); 2158 } 2159 2160 return 0; 2161 } 2162 2163 static int asus_hotk_restore(struct device *device) 2164 { 2165 struct asus_wmi *asus = dev_get_drvdata(device); 2166 int bl; 2167 2168 /* Refresh both wlan rfkill state and pci hotplug */ 2169 if (asus->wlan.rfkill) 2170 asus_rfkill_hotplug(asus); 2171 2172 if (asus->bluetooth.rfkill) { 2173 bl = !asus_wmi_get_devstate_simple(asus, 2174 ASUS_WMI_DEVID_BLUETOOTH); 2175 rfkill_set_sw_state(asus->bluetooth.rfkill, bl); 2176 } 2177 if (asus->wimax.rfkill) { 2178 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX); 2179 rfkill_set_sw_state(asus->wimax.rfkill, bl); 2180 } 2181 if (asus->wwan3g.rfkill) { 2182 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G); 2183 rfkill_set_sw_state(asus->wwan3g.rfkill, bl); 2184 } 2185 if (asus->gps.rfkill) { 2186 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS); 2187 rfkill_set_sw_state(asus->gps.rfkill, bl); 2188 } 2189 if (asus->uwb.rfkill) { 2190 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB); 2191 rfkill_set_sw_state(asus->uwb.rfkill, bl); 2192 } 2193 2194 return 0; 2195 } 2196 2197 static const struct dev_pm_ops asus_pm_ops = { 2198 .thaw = asus_hotk_thaw, 2199 .restore = asus_hotk_restore, 2200 }; 2201 2202 static int asus_wmi_probe(struct platform_device *pdev) 2203 { 2204 struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver); 2205 struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv); 2206 int ret; 2207 2208 if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) { 2209 pr_warn("Management GUID not found\n"); 2210 return -ENODEV; 2211 } 2212 2213 if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) { 2214 pr_warn("Event GUID not found\n"); 2215 return -ENODEV; 2216 } 2217 2218 if (wdrv->probe) { 2219 ret = wdrv->probe(pdev); 2220 if (ret) 2221 return ret; 2222 } 2223 2224 return asus_wmi_add(pdev); 2225 } 2226 2227 static bool used; 2228 2229 int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver) 2230 { 2231 struct platform_driver *platform_driver; 2232 struct platform_device *platform_device; 2233 2234 if (used) 2235 return -EBUSY; 2236 2237 platform_driver = &driver->platform_driver; 2238 platform_driver->remove = asus_wmi_remove; 2239 platform_driver->driver.owner = driver->owner; 2240 platform_driver->driver.name = driver->name; 2241 platform_driver->driver.pm = &asus_pm_ops; 2242 2243 platform_device = platform_create_bundle(platform_driver, 2244 asus_wmi_probe, 2245 NULL, 0, NULL, 0); 2246 if (IS_ERR(platform_device)) 2247 return PTR_ERR(platform_device); 2248 2249 used = true; 2250 return 0; 2251 } 2252 EXPORT_SYMBOL_GPL(asus_wmi_register_driver); 2253 2254 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver) 2255 { 2256 platform_device_unregister(driver->platform_device); 2257 platform_driver_unregister(&driver->platform_driver); 2258 used = false; 2259 } 2260 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver); 2261 2262 static int __init asus_wmi_init(void) 2263 { 2264 if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) { 2265 pr_info("Asus Management GUID not found\n"); 2266 return -ENODEV; 2267 } 2268 2269 pr_info("ASUS WMI generic driver loaded\n"); 2270 return 0; 2271 } 2272 2273 static void __exit asus_wmi_exit(void) 2274 { 2275 pr_info("ASUS WMI generic driver unloaded\n"); 2276 } 2277 2278 module_init(asus_wmi_init); 2279 module_exit(asus_wmi_exit); 2280