drivers/platform/x86/asus-wmi.c

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