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