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