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