drivers/platform/x86/asus-wmi.c

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