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