drivers/platform/x86/asus-wmi.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Asus PC WMI hotkey driver
   4  *
   5  * Copyright(C) 2010 Intel Corporation.
   6  * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com>
   7  *
   8  * Portions based on wistron_btns.c:
   9  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
  10  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
  11  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
  12  */
  13
  14 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  15
  16 #include <linux/kernel.h>
  17 #include <linux/module.h>
  18 #include <linux/init.h>
  19 #include <linux/types.h>
  20 #include <linux/slab.h>
  21 #include <linux/input.h>
  22 #include <linux/input/sparse-keymap.h>
  23 #include <linux/fb.h>
  24 #include <linux/backlight.h>
  25 #include <linux/leds.h>
  26 #include <linux/rfkill.h>
  27 #include <linux/pci.h>
  28 #include <linux/pci_hotplug.h>
  29 #include <linux/power_supply.h>
  30 #include <linux/hwmon.h>
  31 #include <linux/hwmon-sysfs.h>
  32 #include <linux/debugfs.h>
  33 #include <linux/seq_file.h>
  34 #include <linux/platform_data/x86/asus-wmi.h>
  35 #include <linux/platform_device.h>
  36 #include <linux/acpi.h>
  37 #include <linux/dmi.h>
  38 #include <linux/units.h>
  39
  40 #include <acpi/battery.h>
  41 #include <acpi/video.h>
  42
  43 #include "asus-wmi.h"
  44
  45 MODULE_AUTHOR("Corentin Chary <corentin.chary@gmail.com>, "
  46               "Yong Wang <yong.y.wang@intel.com>");
  47 MODULE_DESCRIPTION("Asus Generic WMI Driver");
  48 MODULE_LICENSE("GPL");
  49
  50 #define to_asus_wmi_driver(pdrv)                                        \
  51         (container_of((pdrv), struct asus_wmi_driver, platform_driver))
  52
  53 #define ASUS_WMI_MGMT_GUID      "97845ED0-4E6D-11DE-8A39-0800200C9A66"
  54
  55 #define NOTIFY_BRNUP_MIN                0x11
  56 #define NOTIFY_BRNUP_MAX                0x1f
  57 #define NOTIFY_BRNDOWN_MIN              0x20
  58 #define NOTIFY_BRNDOWN_MAX              0x2e
  59 #define NOTIFY_FNLOCK_TOGGLE            0x4e
  60 #define NOTIFY_KBD_DOCK_CHANGE          0x75
  61 #define NOTIFY_KBD_BRTUP                0xc4
  62 #define NOTIFY_KBD_BRTDWN               0xc5
  63 #define NOTIFY_KBD_BRTTOGGLE            0xc7
  64 #define NOTIFY_KBD_FBM                  0x99
  65 #define NOTIFY_KBD_TTP                  0xae
  66
  67 #define ASUS_WMI_FNLOCK_BIOS_DISABLED   BIT(0)
  68
  69 #define ASUS_FAN_DESC                   "cpu_fan"
  70 #define ASUS_FAN_MFUN                   0x13
  71 #define ASUS_FAN_SFUN_READ              0x06
  72 #define ASUS_FAN_SFUN_WRITE             0x07
  73
  74 /* Based on standard hwmon pwmX_enable values */
  75 #define ASUS_FAN_CTRL_FULLSPEED         0
  76 #define ASUS_FAN_CTRL_MANUAL            1
  77 #define ASUS_FAN_CTRL_AUTO              2
  78
  79 #define ASUS_FAN_BOOST_MODE_NORMAL              0
  80 #define ASUS_FAN_BOOST_MODE_OVERBOOST           1
  81 #define ASUS_FAN_BOOST_MODE_OVERBOOST_MASK      0x01
  82 #define ASUS_FAN_BOOST_MODE_SILENT              2
  83 #define ASUS_FAN_BOOST_MODE_SILENT_MASK         0x02
  84 #define ASUS_FAN_BOOST_MODES_MASK               0x03
  85
  86 #define ASUS_THROTTLE_THERMAL_POLICY_DEFAULT    0
  87 #define ASUS_THROTTLE_THERMAL_POLICY_OVERBOOST  1
  88 #define ASUS_THROTTLE_THERMAL_POLICY_SILENT     2
  89
  90 #define USB_INTEL_XUSB2PR               0xD0
  91 #define PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI   0x9c31
  92
  93 #define ASUS_ACPI_UID_ASUSWMI           "ASUSWMI"
  94 #define ASUS_ACPI_UID_ATK               "ATK"
  95
  96 #define WMI_EVENT_QUEUE_SIZE            0x10
  97 #define WMI_EVENT_QUEUE_END             0x1
  98 #define WMI_EVENT_MASK                  0xFFFF
  99 /* The WMI hotkey event value is always the same. */
 100 #define WMI_EVENT_VALUE_ATK             0xFF
 101
 102 #define WMI_EVENT_MASK                  0xFFFF
 103
 104 static const char * const ashs_ids[] = { "ATK4001", "ATK4002", NULL };
 105
 106 static bool ashs_present(void)
 107 {
 108         int i = 0;
 109         while (ashs_ids[i]) {
 110                 if (acpi_dev_found(ashs_ids[i++]))
 111                         return true;
 112         }
 113         return false;
 114 }
 115
 116 struct bios_args {
 117         u32 arg0;
 118         u32 arg1;
 119         u32 arg2; /* At least TUF Gaming series uses 3 dword input buffer. */
 120         u32 arg4;
 121         u32 arg5;
 122 } __packed;
 123
 124 /*
 125  * Struct that's used for all methods called via AGFN. Naming is
 126  * identically to the AML code.
 127  */
 128 struct agfn_args {
 129         u16 mfun; /* probably "Multi-function" to be called */
 130         u16 sfun; /* probably "Sub-function" to be called */
 131         u16 len;  /* size of the hole struct, including subfunction fields */
 132         u8 stas;  /* not used by now */
 133         u8 err;   /* zero on success */
 134 } __packed;
 135
 136 /* struct used for calling fan read and write methods */
 137 struct agfn_fan_args {
 138         struct agfn_args agfn;  /* common fields */
 139         u8 fan;                 /* fan number: 0: set auto mode 1: 1st fan */
 140         u32 speed;              /* read: RPM/100 - write: 0-255 */
 141 } __packed;
 142
 143 /*
 144  * <platform>/    - debugfs root directory
 145  *   dev_id      - current dev_id
 146  *   ctrl_param  - current ctrl_param
 147  *   method_id   - current method_id
 148  *   devs        - call DEVS(dev_id, ctrl_param) and print result
 149  *   dsts        - call DSTS(dev_id)  and print result
 150  *   call        - call method_id(dev_id, ctrl_param) and print result
 151  */
 152 struct asus_wmi_debug {
 153         struct dentry *root;
 154         u32 method_id;
 155         u32 dev_id;
 156         u32 ctrl_param;
 157 };
 158
 159 struct asus_rfkill {
 160         struct asus_wmi *asus;
 161         struct rfkill *rfkill;
 162         u32 dev_id;
 163 };
 164
 165 enum fan_type {
 166         FAN_TYPE_NONE = 0,
 167         FAN_TYPE_AGFN,          /* deprecated on newer platforms */
 168         FAN_TYPE_SPEC83,        /* starting in Spec 8.3, use CPU_FAN_CTRL */
 169 };
 170
 171 struct asus_wmi {
 172         int dsts_id;
 173         int spec;
 174         int sfun;
 175         bool wmi_event_queue;
 176
 177         struct input_dev *inputdev;
 178         struct backlight_device *backlight_device;
 179         struct platform_device *platform_device;
 180
 181         struct led_classdev wlan_led;
 182         int wlan_led_wk;
 183         struct led_classdev tpd_led;
 184         int tpd_led_wk;
 185         struct led_classdev kbd_led;
 186         int kbd_led_wk;
 187         struct led_classdev lightbar_led;
 188         int lightbar_led_wk;
 189         struct workqueue_struct *led_workqueue;
 190         struct work_struct tpd_led_work;
 191         struct work_struct wlan_led_work;
 192         struct work_struct lightbar_led_work;
 193
 194         struct asus_rfkill wlan;
 195         struct asus_rfkill bluetooth;
 196         struct asus_rfkill wimax;
 197         struct asus_rfkill wwan3g;
 198         struct asus_rfkill gps;
 199         struct asus_rfkill uwb;
 200
 201         enum fan_type fan_type;
 202         int fan_pwm_mode;
 203         int agfn_pwm;
 204
 205         bool fan_boost_mode_available;
 206         u8 fan_boost_mode_mask;
 207         u8 fan_boost_mode;
 208
 209         bool throttle_thermal_policy_available;
 210         u8 throttle_thermal_policy_mode;
 211
 212         // The RSOC controls the maximum charging percentage.
 213         bool battery_rsoc_available;
 214
 215         struct hotplug_slot hotplug_slot;
 216         struct mutex hotplug_lock;
 217         struct mutex wmi_lock;
 218         struct workqueue_struct *hotplug_workqueue;
 219         struct work_struct hotplug_work;
 220
 221         bool fnlock_locked;
 222
 223         struct asus_wmi_debug debug;
 224
 225         struct asus_wmi_driver *driver;
 226 };
 227
 228 /* WMI ************************************************************************/
 229
 230 static int asus_wmi_evaluate_method3(u32 method_id,
 231                 u32 arg0, u32 arg1, u32 arg2, u32 *retval)
 232 {
 233         struct bios_args args = {
 234                 .arg0 = arg0,
 235                 .arg1 = arg1,
 236                 .arg2 = arg2,
 237         };
 238         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
 239         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
 240         acpi_status status;
 241         union acpi_object *obj;
 242         u32 tmp = 0;
 243
 244         status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 0, method_id,
 245                                      &input, &output);
 246
 247         if (ACPI_FAILURE(status))
 248                 return -EIO;
 249
 250         obj = (union acpi_object *)output.pointer;
 251         if (obj && obj->type == ACPI_TYPE_INTEGER)
 252                 tmp = (u32) obj->integer.value;
 253
 254         if (retval)
 255                 *retval = tmp;
 256
 257         kfree(obj);
 258
 259         if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
 260                 return -ENODEV;
 261
 262         return 0;
 263 }
 264
 265 int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1, u32 *retval)
 266 {
 267         return asus_wmi_evaluate_method3(method_id, arg0, arg1, 0, retval);
 268 }
 269 EXPORT_SYMBOL_GPL(asus_wmi_evaluate_method);
 270
 271 static int asus_wmi_evaluate_method_agfn(const struct acpi_buffer args)
 272 {
 273         struct acpi_buffer input;
 274         u64 phys_addr;
 275         u32 retval;
 276         u32 status;
 277
 278         /*
 279          * Copy to dma capable address otherwise memory corruption occurs as
 280          * bios has to be able to access it.
 281          */
 282         input.pointer = kmemdup(args.pointer, args.length, GFP_DMA | GFP_KERNEL);
 283         input.length = args.length;
 284         if (!input.pointer)
 285                 return -ENOMEM;
 286         phys_addr = virt_to_phys(input.pointer);
 287
 288         status = asus_wmi_evaluate_method(ASUS_WMI_METHODID_AGFN,
 289                                         phys_addr, 0, &retval);
 290         if (!status)
 291                 memcpy(args.pointer, input.pointer, args.length);
 292
 293         kfree(input.pointer);
 294         if (status)
 295                 return -ENXIO;
 296
 297         return retval;
 298 }
 299
 300 static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
 301 {
 302         return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
 303 }
 304
 305 static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
 306                                  u32 *retval)
 307 {
 308         return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
 309                                         ctrl_param, retval);
 310 }
 311
 312 /* Helper for special devices with magic return codes */
 313 static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
 314                                       u32 dev_id, u32 mask)
 315 {
 316         u32 retval = 0;
 317         int err;
 318
 319         err = asus_wmi_get_devstate(asus, dev_id, &retval);
 320         if (err < 0)
 321                 return err;
 322
 323         if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
 324                 return -ENODEV;
 325
 326         if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
 327                 if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
 328                         return -ENODEV;
 329         }
 330
 331         return retval & mask;
 332 }
 333
 334 static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
 335 {
 336         return asus_wmi_get_devstate_bits(asus, dev_id,
 337                                           ASUS_WMI_DSTS_STATUS_BIT);
 338 }
 339
 340 static bool asus_wmi_dev_is_present(struct asus_wmi *asus, u32 dev_id)
 341 {
 342         u32 retval;
 343         int status = asus_wmi_get_devstate(asus, dev_id, &retval);
 344
 345         return status == 0 && (retval & ASUS_WMI_DSTS_PRESENCE_BIT);
 346 }
 347
 348 /* Input **********************************************************************/
 349
 350 static int asus_wmi_input_init(struct asus_wmi *asus)
 351 {
 352         int err, result;
 353
 354         asus->inputdev = input_allocate_device();
 355         if (!asus->inputdev)
 356                 return -ENOMEM;
 357
 358         asus->inputdev->name = asus->driver->input_name;
 359         asus->inputdev->phys = asus->driver->input_phys;
 360         asus->inputdev->id.bustype = BUS_HOST;
 361         asus->inputdev->dev.parent = &asus->platform_device->dev;
 362         set_bit(EV_REP, asus->inputdev->evbit);
 363
 364         err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
 365         if (err)
 366                 goto err_free_dev;
 367
 368         if (asus->driver->quirks->use_kbd_dock_devid) {
 369                 result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_KBD_DOCK);
 370                 if (result >= 0) {
 371                         input_set_capability(asus->inputdev, EV_SW, SW_TABLET_MODE);
 372                         input_report_switch(asus->inputdev, SW_TABLET_MODE, !result);
 373                 } else if (result != -ENODEV) {
 374                         pr_err("Error checking for keyboard-dock: %d\n", result);
 375                 }
 376         }
 377
 378         err = input_register_device(asus->inputdev);
 379         if (err)
 380                 goto err_free_dev;
 381
 382         return 0;
 383
 384 err_free_dev:
 385         input_free_device(asus->inputdev);
 386         return err;
 387 }
 388
 389 static void asus_wmi_input_exit(struct asus_wmi *asus)
 390 {
 391         if (asus->inputdev)
 392                 input_unregister_device(asus->inputdev);
 393
 394         asus->inputdev = NULL;
 395 }
 396
 397 /* Battery ********************************************************************/
 398
 399 /* The battery maximum charging percentage */
 400 static int charge_end_threshold;
 401
 402 static ssize_t charge_control_end_threshold_store(struct device *dev,
 403                                                   struct device_attribute *attr,
 404                                                   const char *buf, size_t count)
 405 {
 406         int value, ret, rv;
 407
 408         ret = kstrtouint(buf, 10, &value);
 409         if (ret)
 410                 return ret;
 411
 412         if (value < 0 || value > 100)
 413                 return -EINVAL;
 414
 415         ret = asus_wmi_set_devstate(ASUS_WMI_DEVID_RSOC, value, &rv);
 416         if (ret)
 417                 return ret;
 418
 419         if (rv != 1)
 420                 return -EIO;
 421
 422         /* There isn't any method in the DSDT to read the threshold, so we
 423          * save the threshold.
 424          */
 425         charge_end_threshold = value;
 426         return count;
 427 }
 428
 429 static ssize_t charge_control_end_threshold_show(struct device *device,
 430                                                  struct device_attribute *attr,
 431                                                  char *buf)
 432 {
 433         return sprintf(buf, "%d\n", charge_end_threshold);
 434 }
 435
 436 static DEVICE_ATTR_RW(charge_control_end_threshold);
 437
 438 static int asus_wmi_battery_add(struct power_supply *battery)
 439 {
 440         /* The WMI method does not provide a way to specific a battery, so we
 441          * just assume it is the first battery.
 442          * Note: On some newer ASUS laptops (Zenbook UM431DA), the primary/first
 443          * battery is named BATT.
 444          */
 445         if (strcmp(battery->desc->name, "BAT0") != 0 &&
 446             strcmp(battery->desc->name, "BAT1") != 0 &&
 447             strcmp(battery->desc->name, "BATC") != 0 &&
 448             strcmp(battery->desc->name, "BATT") != 0)
 449                 return -ENODEV;
 450
 451         if (device_create_file(&battery->dev,
 452             &dev_attr_charge_control_end_threshold))
 453                 return -ENODEV;
 454
 455         /* The charge threshold is only reset when the system is power cycled,
 456          * and we can't get the current threshold so let set it to 100% when
 457          * a battery is added.
 458          */
 459         asus_wmi_set_devstate(ASUS_WMI_DEVID_RSOC, 100, NULL);
 460         charge_end_threshold = 100;
 461
 462         return 0;
 463 }
 464
 465 static int asus_wmi_battery_remove(struct power_supply *battery)
 466 {
 467         device_remove_file(&battery->dev,
 468                            &dev_attr_charge_control_end_threshold);
 469         return 0;
 470 }
 471
 472 static struct acpi_battery_hook battery_hook = {
 473         .add_battery = asus_wmi_battery_add,
 474         .remove_battery = asus_wmi_battery_remove,
 475         .name = "ASUS Battery Extension",
 476 };
 477
 478 static void asus_wmi_battery_init(struct asus_wmi *asus)
 479 {
 480         asus->battery_rsoc_available = false;
 481         if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_RSOC)) {
 482                 asus->battery_rsoc_available = true;
 483                 battery_hook_register(&battery_hook);
 484         }
 485 }
 486
 487 static void asus_wmi_battery_exit(struct asus_wmi *asus)
 488 {
 489         if (asus->battery_rsoc_available)
 490                 battery_hook_unregister(&battery_hook);
 491 }
 492
 493 /* LEDs ***********************************************************************/
 494
 495 /*
 496  * These functions actually update the LED's, and are called from a
 497  * workqueue. By doing this as separate work rather than when the LED
 498  * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 499  * potentially bad time, such as a timer interrupt.
 500  */
 501 static void tpd_led_update(struct work_struct *work)
 502 {
 503         int ctrl_param;
 504         struct asus_wmi *asus;
 505
 506         asus = container_of(work, struct asus_wmi, tpd_led_work);
 507
 508         ctrl_param = asus->tpd_led_wk;
 509         asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
 510 }
 511
 512 static void tpd_led_set(struct led_classdev *led_cdev,
 513                         enum led_brightness value)
 514 {
 515         struct asus_wmi *asus;
 516
 517         asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 518
 519         asus->tpd_led_wk = !!value;
 520         queue_work(asus->led_workqueue, &asus->tpd_led_work);
 521 }
 522
 523 static int read_tpd_led_state(struct asus_wmi *asus)
 524 {
 525         return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
 526 }
 527
 528 static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
 529 {
 530         struct asus_wmi *asus;
 531
 532         asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 533
 534         return read_tpd_led_state(asus);
 535 }
 536
 537 static void kbd_led_update(struct asus_wmi *asus)
 538 {
 539         int ctrl_param = 0;
 540
 541         ctrl_param = 0x80 | (asus->kbd_led_wk & 0x7F);
 542         asus_wmi_set_devstate(ASUS_WMI_DEVID_KBD_BACKLIGHT, ctrl_param, NULL);
 543 }
 544
 545 static int kbd_led_read(struct asus_wmi *asus, int *level, int *env)
 546 {
 547         int retval;
 548
 549         /*
 550          * bits 0-2: level
 551          * bit 7: light on/off
 552          * bit 8-10: environment (0: dark, 1: normal, 2: light)
 553          * bit 17: status unknown
 554          */
 555         retval = asus_wmi_get_devstate_bits(asus, ASUS_WMI_DEVID_KBD_BACKLIGHT,
 556                                             0xFFFF);
 557
 558         /* Unknown status is considered as off */
 559         if (retval == 0x8000)
 560                 retval = 0;
 561
 562         if (retval < 0)
 563                 return retval;
 564
 565         if (level)
 566                 *level = retval & 0x7F;
 567         if (env)
 568                 *env = (retval >> 8) & 0x7F;
 569         return 0;
 570 }
 571
 572 static void do_kbd_led_set(struct led_classdev *led_cdev, int value)
 573 {
 574         struct asus_wmi *asus;
 575         int max_level;
 576
 577         asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 578         max_level = asus->kbd_led.max_brightness;
 579
 580         asus->kbd_led_wk = clamp_val(value, 0, max_level);
 581         kbd_led_update(asus);
 582 }
 583
 584 static void kbd_led_set(struct led_classdev *led_cdev,
 585                         enum led_brightness value)
 586 {
 587         /* Prevent disabling keyboard backlight on module unregister */
 588         if (led_cdev->flags & LED_UNREGISTERING)
 589                 return;
 590
 591         do_kbd_led_set(led_cdev, value);
 592 }
 593
 594 static void kbd_led_set_by_kbd(struct asus_wmi *asus, enum led_brightness value)
 595 {
 596         struct led_classdev *led_cdev = &asus->kbd_led;
 597
 598         do_kbd_led_set(led_cdev, value);
 599         led_classdev_notify_brightness_hw_changed(led_cdev, asus->kbd_led_wk);
 600 }
 601
 602 static enum led_brightness kbd_led_get(struct led_classdev *led_cdev)
 603 {
 604         struct asus_wmi *asus;
 605         int retval, value;
 606
 607         asus = container_of(led_cdev, struct asus_wmi, kbd_led);
 608
 609         retval = kbd_led_read(asus, &value, NULL);
 610         if (retval < 0)
 611                 return retval;
 612
 613         return value;
 614 }
 615
 616 static int wlan_led_unknown_state(struct asus_wmi *asus)
 617 {
 618         u32 result;
 619
 620         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
 621
 622         return result & ASUS_WMI_DSTS_UNKNOWN_BIT;
 623 }
 624
 625 static void wlan_led_update(struct work_struct *work)
 626 {
 627         int ctrl_param;
 628         struct asus_wmi *asus;
 629
 630         asus = container_of(work, struct asus_wmi, wlan_led_work);
 631
 632         ctrl_param = asus->wlan_led_wk;
 633         asus_wmi_set_devstate(ASUS_WMI_DEVID_WIRELESS_LED, ctrl_param, NULL);
 634 }
 635
 636 static void wlan_led_set(struct led_classdev *led_cdev,
 637                          enum led_brightness value)
 638 {
 639         struct asus_wmi *asus;
 640
 641         asus = container_of(led_cdev, struct asus_wmi, wlan_led);
 642
 643         asus->wlan_led_wk = !!value;
 644         queue_work(asus->led_workqueue, &asus->wlan_led_work);
 645 }
 646
 647 static enum led_brightness wlan_led_get(struct led_classdev *led_cdev)
 648 {
 649         struct asus_wmi *asus;
 650         u32 result;
 651
 652         asus = container_of(led_cdev, struct asus_wmi, wlan_led);
 653         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WIRELESS_LED, &result);
 654
 655         return result & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
 656 }
 657
 658 static void lightbar_led_update(struct work_struct *work)
 659 {
 660         struct asus_wmi *asus;
 661         int ctrl_param;
 662
 663         asus = container_of(work, struct asus_wmi, lightbar_led_work);
 664
 665         ctrl_param = asus->lightbar_led_wk;
 666         asus_wmi_set_devstate(ASUS_WMI_DEVID_LIGHTBAR, ctrl_param, NULL);
 667 }
 668
 669 static void lightbar_led_set(struct led_classdev *led_cdev,
 670                              enum led_brightness value)
 671 {
 672         struct asus_wmi *asus;
 673
 674         asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
 675
 676         asus->lightbar_led_wk = !!value;
 677         queue_work(asus->led_workqueue, &asus->lightbar_led_work);
 678 }
 679
 680 static enum led_brightness lightbar_led_get(struct led_classdev *led_cdev)
 681 {
 682         struct asus_wmi *asus;
 683         u32 result;
 684
 685         asus = container_of(led_cdev, struct asus_wmi, lightbar_led);
 686         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_LIGHTBAR, &result);
 687
 688         return result & ASUS_WMI_DSTS_LIGHTBAR_MASK;
 689 }
 690
 691 static void asus_wmi_led_exit(struct asus_wmi *asus)
 692 {
 693         led_classdev_unregister(&asus->kbd_led);
 694         led_classdev_unregister(&asus->tpd_led);
 695         led_classdev_unregister(&asus->wlan_led);
 696         led_classdev_unregister(&asus->lightbar_led);
 697
 698         if (asus->led_workqueue)
 699                 destroy_workqueue(asus->led_workqueue);
 700 }
 701
 702 static int asus_wmi_led_init(struct asus_wmi *asus)
 703 {
 704         int rv = 0, led_val;
 705
 706         asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
 707         if (!asus->led_workqueue)
 708                 return -ENOMEM;
 709
 710         if (read_tpd_led_state(asus) >= 0) {
 711                 INIT_WORK(&asus->tpd_led_work, tpd_led_update);
 712
 713                 asus->tpd_led.name = "asus::touchpad";
 714                 asus->tpd_led.brightness_set = tpd_led_set;
 715                 asus->tpd_led.brightness_get = tpd_led_get;
 716                 asus->tpd_led.max_brightness = 1;
 717
 718                 rv = led_classdev_register(&asus->platform_device->dev,
 719                                            &asus->tpd_led);
 720                 if (rv)
 721                         goto error;
 722         }
 723
 724         if (!kbd_led_read(asus, &led_val, NULL)) {
 725                 asus->kbd_led_wk = led_val;
 726                 asus->kbd_led.name = "asus::kbd_backlight";
 727                 asus->kbd_led.flags = LED_BRIGHT_HW_CHANGED;
 728                 asus->kbd_led.brightness_set = kbd_led_set;
 729                 asus->kbd_led.brightness_get = kbd_led_get;
 730                 asus->kbd_led.max_brightness = 3;
 731
 732                 rv = led_classdev_register(&asus->platform_device->dev,
 733                                            &asus->kbd_led);
 734                 if (rv)
 735                         goto error;
 736         }
 737
 738         if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_WIRELESS_LED)
 739                         && (asus->driver->quirks->wapf > 0)) {
 740                 INIT_WORK(&asus->wlan_led_work, wlan_led_update);
 741
 742                 asus->wlan_led.name = "asus::wlan";
 743                 asus->wlan_led.brightness_set = wlan_led_set;
 744                 if (!wlan_led_unknown_state(asus))
 745                         asus->wlan_led.brightness_get = wlan_led_get;
 746                 asus->wlan_led.flags = LED_CORE_SUSPENDRESUME;
 747                 asus->wlan_led.max_brightness = 1;
 748                 asus->wlan_led.default_trigger = "asus-wlan";
 749
 750                 rv = led_classdev_register(&asus->platform_device->dev,
 751                                            &asus->wlan_led);
 752                 if (rv)
 753                         goto error;
 754         }
 755
 756         if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_LIGHTBAR)) {
 757                 INIT_WORK(&asus->lightbar_led_work, lightbar_led_update);
 758
 759                 asus->lightbar_led.name = "asus::lightbar";
 760                 asus->lightbar_led.brightness_set = lightbar_led_set;
 761                 asus->lightbar_led.brightness_get = lightbar_led_get;
 762                 asus->lightbar_led.max_brightness = 1;
 763
 764                 rv = led_classdev_register(&asus->platform_device->dev,
 765                                            &asus->lightbar_led);
 766         }
 767
 768 error:
 769         if (rv)
 770                 asus_wmi_led_exit(asus);
 771
 772         return rv;
 773 }
 774
 775 /* RF *************************************************************************/
 776
 777 /*
 778  * PCI hotplug (for wlan rfkill)
 779  */
 780 static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
 781 {
 782         int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 783
 784         if (result < 0)
 785                 return false;
 786         return !result;
 787 }
 788
 789 static void asus_rfkill_hotplug(struct asus_wmi *asus)
 790 {
 791         struct pci_dev *dev;
 792         struct pci_bus *bus;
 793         bool blocked;
 794         bool absent;
 795         u32 l;
 796
 797         mutex_lock(&asus->wmi_lock);
 798         blocked = asus_wlan_rfkill_blocked(asus);
 799         mutex_unlock(&asus->wmi_lock);
 800
 801         mutex_lock(&asus->hotplug_lock);
 802         pci_lock_rescan_remove();
 803
 804         if (asus->wlan.rfkill)
 805                 rfkill_set_sw_state(asus->wlan.rfkill, blocked);
 806
 807         if (asus->hotplug_slot.ops) {
 808                 bus = pci_find_bus(0, 1);
 809                 if (!bus) {
 810                         pr_warn("Unable to find PCI bus 1?\n");
 811                         goto out_unlock;
 812                 }
 813
 814                 if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
 815                         pr_err("Unable to read PCI config space?\n");
 816                         goto out_unlock;
 817                 }
 818                 absent = (l == 0xffffffff);
 819
 820                 if (blocked != absent) {
 821                         pr_warn("BIOS says wireless lan is %s, "
 822                                 "but the pci device is %s\n",
 823                                 blocked ? "blocked" : "unblocked",
 824                                 absent ? "absent" : "present");
 825                         pr_warn("skipped wireless hotplug as probably "
 826                                 "inappropriate for this model\n");
 827                         goto out_unlock;
 828                 }
 829
 830                 if (!blocked) {
 831                         dev = pci_get_slot(bus, 0);
 832                         if (dev) {
 833                                 /* Device already present */
 834                                 pci_dev_put(dev);
 835                                 goto out_unlock;
 836                         }
 837                         dev = pci_scan_single_device(bus, 0);
 838                         if (dev) {
 839                                 pci_bus_assign_resources(bus);
 840                                 pci_bus_add_device(dev);
 841                         }
 842                 } else {
 843                         dev = pci_get_slot(bus, 0);
 844                         if (dev) {
 845                                 pci_stop_and_remove_bus_device(dev);
 846                                 pci_dev_put(dev);
 847                         }
 848                 }
 849         }
 850
 851 out_unlock:
 852         pci_unlock_rescan_remove();
 853         mutex_unlock(&asus->hotplug_lock);
 854 }
 855
 856 static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
 857 {
 858         struct asus_wmi *asus = data;
 859
 860         if (event != ACPI_NOTIFY_BUS_CHECK)
 861                 return;
 862
 863         /*
 864          * We can't call directly asus_rfkill_hotplug because most
 865          * of the time WMBC is still being executed and not reetrant.
 866          * There is currently no way to tell ACPICA that  we want this
 867          * method to be serialized, we schedule a asus_rfkill_hotplug
 868          * call later, in a safer context.
 869          */
 870         queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
 871 }
 872
 873 static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
 874 {
 875         acpi_status status;
 876         acpi_handle handle;
 877
 878         status = acpi_get_handle(NULL, node, &handle);
 879         if (ACPI_FAILURE(status))
 880                 return -ENODEV;
 881
 882         status = acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
 883                                              asus_rfkill_notify, asus);
 884         if (ACPI_FAILURE(status))
 885                 pr_warn("Failed to register notify on %s\n", node);
 886
 887         return 0;
 888 }
 889
 890 static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
 891 {
 892         acpi_status status = AE_OK;
 893         acpi_handle handle;
 894
 895         status = acpi_get_handle(NULL, node, &handle);
 896         if (ACPI_FAILURE(status))
 897                 return;
 898
 899         status = acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
 900                                             asus_rfkill_notify);
 901         if (ACPI_FAILURE(status))
 902                 pr_err("Error removing rfkill notify handler %s\n", node);
 903 }
 904
 905 static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
 906                                    u8 *value)
 907 {
 908         struct asus_wmi *asus = container_of(hotplug_slot,
 909                                              struct asus_wmi, hotplug_slot);
 910         int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 911
 912         if (result < 0)
 913                 return result;
 914
 915         *value = !!result;
 916         return 0;
 917 }
 918
 919 static const struct hotplug_slot_ops asus_hotplug_slot_ops = {
 920         .get_adapter_status = asus_get_adapter_status,
 921         .get_power_status = asus_get_adapter_status,
 922 };
 923
 924 static void asus_hotplug_work(struct work_struct *work)
 925 {
 926         struct asus_wmi *asus;
 927
 928         asus = container_of(work, struct asus_wmi, hotplug_work);
 929         asus_rfkill_hotplug(asus);
 930 }
 931
 932 static int asus_setup_pci_hotplug(struct asus_wmi *asus)
 933 {
 934         int ret = -ENOMEM;
 935         struct pci_bus *bus = pci_find_bus(0, 1);
 936
 937         if (!bus) {
 938                 pr_err("Unable to find wifi PCI bus\n");
 939                 return -ENODEV;
 940         }
 941
 942         asus->hotplug_workqueue =
 943             create_singlethread_workqueue("hotplug_workqueue");
 944         if (!asus->hotplug_workqueue)
 945                 goto error_workqueue;
 946
 947         INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
 948
 949         asus->hotplug_slot.ops = &asus_hotplug_slot_ops;
 950
 951         ret = pci_hp_register(&asus->hotplug_slot, bus, 0, "asus-wifi");
 952         if (ret) {
 953                 pr_err("Unable to register hotplug slot - %d\n", ret);
 954                 goto error_register;
 955         }
 956
 957         return 0;
 958
 959 error_register:
 960         asus->hotplug_slot.ops = NULL;
 961         destroy_workqueue(asus->hotplug_workqueue);
 962 error_workqueue:
 963         return ret;
 964 }
 965
 966 /*
 967  * Rfkill devices
 968  */
 969 static int asus_rfkill_set(void *data, bool blocked)
 970 {
 971         struct asus_rfkill *priv = data;
 972         u32 ctrl_param = !blocked;
 973         u32 dev_id = priv->dev_id;
 974
 975         /*
 976          * If the user bit is set, BIOS can't set and record the wlan status,
 977          * it will report the value read from id ASUS_WMI_DEVID_WLAN_LED
 978          * while we query the wlan status through WMI(ASUS_WMI_DEVID_WLAN).
 979          * So, we have to record wlan status in id ASUS_WMI_DEVID_WLAN_LED
 980          * while setting the wlan status through WMI.
 981          * This is also the behavior that windows app will do.
 982          */
 983         if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
 984              priv->asus->driver->wlan_ctrl_by_user)
 985                 dev_id = ASUS_WMI_DEVID_WLAN_LED;
 986
 987         return asus_wmi_set_devstate(dev_id, ctrl_param, NULL);
 988 }
 989
 990 static void asus_rfkill_query(struct rfkill *rfkill, void *data)
 991 {
 992         struct asus_rfkill *priv = data;
 993         int result;
 994
 995         result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
 996
 997         if (result < 0)
 998                 return;
 999
1000         rfkill_set_sw_state(priv->rfkill, !result);
1001 }
1002
1003 static int asus_rfkill_wlan_set(void *data, bool blocked)
1004 {
1005         struct asus_rfkill *priv = data;
1006         struct asus_wmi *asus = priv->asus;
1007         int ret;
1008
1009         /*
1010          * This handler is enabled only if hotplug is enabled.
1011          * In this case, the asus_wmi_set_devstate() will
1012          * trigger a wmi notification and we need to wait
1013          * this call to finish before being able to call
1014          * any wmi method
1015          */
1016         mutex_lock(&asus->wmi_lock);
1017         ret = asus_rfkill_set(data, blocked);
1018         mutex_unlock(&asus->wmi_lock);
1019         return ret;
1020 }
1021
1022 static const struct rfkill_ops asus_rfkill_wlan_ops = {
1023         .set_block = asus_rfkill_wlan_set,
1024         .query = asus_rfkill_query,
1025 };
1026
1027 static const struct rfkill_ops asus_rfkill_ops = {
1028         .set_block = asus_rfkill_set,
1029         .query = asus_rfkill_query,
1030 };
1031
1032 static int asus_new_rfkill(struct asus_wmi *asus,
1033                            struct asus_rfkill *arfkill,
1034                            const char *name, enum rfkill_type type, int dev_id)
1035 {
1036         int result = asus_wmi_get_devstate_simple(asus, dev_id);
1037         struct rfkill **rfkill = &arfkill->rfkill;
1038
1039         if (result < 0)
1040                 return result;
1041
1042         arfkill->dev_id = dev_id;
1043         arfkill->asus = asus;
1044
1045         if (dev_id == ASUS_WMI_DEVID_WLAN &&
1046             asus->driver->quirks->hotplug_wireless)
1047                 *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
1048                                        &asus_rfkill_wlan_ops, arfkill);
1049         else
1050                 *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
1051                                        &asus_rfkill_ops, arfkill);
1052
1053         if (!*rfkill)
1054                 return -EINVAL;
1055
1056         if ((dev_id == ASUS_WMI_DEVID_WLAN) &&
1057                         (asus->driver->quirks->wapf > 0))
1058                 rfkill_set_led_trigger_name(*rfkill, "asus-wlan");
1059
1060         rfkill_init_sw_state(*rfkill, !result);
1061         result = rfkill_register(*rfkill);
1062         if (result) {
1063                 rfkill_destroy(*rfkill);
1064                 *rfkill = NULL;
1065                 return result;
1066         }
1067         return 0;
1068 }
1069
1070 static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
1071 {
1072         if (asus->driver->wlan_ctrl_by_user && ashs_present())
1073                 return;
1074
1075         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
1076         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
1077         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1078         if (asus->wlan.rfkill) {
1079                 rfkill_unregister(asus->wlan.rfkill);
1080                 rfkill_destroy(asus->wlan.rfkill);
1081                 asus->wlan.rfkill = NULL;
1082         }
1083         /*
1084          * Refresh pci hotplug in case the rfkill state was changed after
1085          * asus_unregister_rfkill_notifier()
1086          */
1087         asus_rfkill_hotplug(asus);
1088         if (asus->hotplug_slot.ops)
1089                 pci_hp_deregister(&asus->hotplug_slot);
1090         if (asus->hotplug_workqueue)
1091                 destroy_workqueue(asus->hotplug_workqueue);
1092
1093         if (asus->bluetooth.rfkill) {
1094                 rfkill_unregister(asus->bluetooth.rfkill);
1095                 rfkill_destroy(asus->bluetooth.rfkill);
1096                 asus->bluetooth.rfkill = NULL;
1097         }
1098         if (asus->wimax.rfkill) {
1099                 rfkill_unregister(asus->wimax.rfkill);
1100                 rfkill_destroy(asus->wimax.rfkill);
1101                 asus->wimax.rfkill = NULL;
1102         }
1103         if (asus->wwan3g.rfkill) {
1104                 rfkill_unregister(asus->wwan3g.rfkill);
1105                 rfkill_destroy(asus->wwan3g.rfkill);
1106                 asus->wwan3g.rfkill = NULL;
1107         }
1108         if (asus->gps.rfkill) {
1109                 rfkill_unregister(asus->gps.rfkill);
1110                 rfkill_destroy(asus->gps.rfkill);
1111                 asus->gps.rfkill = NULL;
1112         }
1113         if (asus->uwb.rfkill) {
1114                 rfkill_unregister(asus->uwb.rfkill);
1115                 rfkill_destroy(asus->uwb.rfkill);
1116                 asus->uwb.rfkill = NULL;
1117         }
1118 }
1119
1120 static int asus_wmi_rfkill_init(struct asus_wmi *asus)
1121 {
1122         int result = 0;
1123
1124         mutex_init(&asus->hotplug_lock);
1125         mutex_init(&asus->wmi_lock);
1126
1127         result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
1128                                  RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
1129
1130         if (result && result != -ENODEV)
1131                 goto exit;
1132
1133         result = asus_new_rfkill(asus, &asus->bluetooth,
1134                                  "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
1135                                  ASUS_WMI_DEVID_BLUETOOTH);
1136
1137         if (result && result != -ENODEV)
1138                 goto exit;
1139
1140         result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
1141                                  RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
1142
1143         if (result && result != -ENODEV)
1144                 goto exit;
1145
1146         result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
1147                                  RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
1148
1149         if (result && result != -ENODEV)
1150                 goto exit;
1151
1152         result = asus_new_rfkill(asus, &asus->gps, "asus-gps",
1153                                  RFKILL_TYPE_GPS, ASUS_WMI_DEVID_GPS);
1154
1155         if (result && result != -ENODEV)
1156                 goto exit;
1157
1158         result = asus_new_rfkill(asus, &asus->uwb, "asus-uwb",
1159                                  RFKILL_TYPE_UWB, ASUS_WMI_DEVID_UWB);
1160
1161         if (result && result != -ENODEV)
1162                 goto exit;
1163
1164         if (!asus->driver->quirks->hotplug_wireless)
1165                 goto exit;
1166
1167         result = asus_setup_pci_hotplug(asus);
1168         /*
1169          * If we get -EBUSY then something else is handling the PCI hotplug -
1170          * don't fail in this case
1171          */
1172         if (result == -EBUSY)
1173                 result = 0;
1174
1175         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
1176         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
1177         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
1178         /*
1179          * Refresh pci hotplug in case the rfkill state was changed during
1180          * setup.
1181          */
1182         asus_rfkill_hotplug(asus);
1183
1184 exit:
1185         if (result && result != -ENODEV)
1186                 asus_wmi_rfkill_exit(asus);
1187
1188         if (result == -ENODEV)
1189                 result = 0;
1190
1191         return result;
1192 }
1193
1194 /* Quirks *********************************************************************/
1195
1196 static void asus_wmi_set_xusb2pr(struct asus_wmi *asus)
1197 {
1198         struct pci_dev *xhci_pdev;
1199         u32 orig_ports_available;
1200         u32 ports_available = asus->driver->quirks->xusb2pr;
1201
1202         xhci_pdev = pci_get_device(PCI_VENDOR_ID_INTEL,
1203                         PCI_DEVICE_ID_INTEL_LYNXPOINT_LP_XHCI,
1204                         NULL);
1205
1206         if (!xhci_pdev)
1207                 return;
1208
1209         pci_read_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1210                                 &orig_ports_available);
1211
1212         pci_write_config_dword(xhci_pdev, USB_INTEL_XUSB2PR,
1213                                 cpu_to_le32(ports_available));
1214
1215         pr_info("set USB_INTEL_XUSB2PR old: 0x%04x, new: 0x%04x\n",
1216                         orig_ports_available, ports_available);
1217 }
1218
1219 /*
1220  * Some devices dont support or have borcken get_als method
1221  * but still support set method.
1222  */
1223 static void asus_wmi_set_als(void)
1224 {
1225         asus_wmi_set_devstate(ASUS_WMI_DEVID_ALS_ENABLE, 1, NULL);
1226 }
1227
1228 /* Hwmon device ***************************************************************/
1229
1230 static int asus_agfn_fan_speed_read(struct asus_wmi *asus, int fan,
1231                                           int *speed)
1232 {
1233         struct agfn_fan_args args = {
1234                 .agfn.len = sizeof(args),
1235                 .agfn.mfun = ASUS_FAN_MFUN,
1236                 .agfn.sfun = ASUS_FAN_SFUN_READ,
1237                 .fan = fan,
1238                 .speed = 0,
1239         };
1240         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1241         int status;
1242
1243         if (fan != 1)
1244                 return -EINVAL;
1245
1246         status = asus_wmi_evaluate_method_agfn(input);
1247
1248         if (status || args.agfn.err)
1249                 return -ENXIO;
1250
1251         if (speed)
1252                 *speed = args.speed;
1253
1254         return 0;
1255 }
1256
1257 static int asus_agfn_fan_speed_write(struct asus_wmi *asus, int fan,
1258                                      int *speed)
1259 {
1260         struct agfn_fan_args args = {
1261                 .agfn.len = sizeof(args),
1262                 .agfn.mfun = ASUS_FAN_MFUN,
1263                 .agfn.sfun = ASUS_FAN_SFUN_WRITE,
1264                 .fan = fan,
1265                 .speed = speed ?  *speed : 0,
1266         };
1267         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1268         int status;
1269
1270         /* 1: for setting 1st fan's speed 0: setting auto mode */
1271         if (fan != 1 && fan != 0)
1272                 return -EINVAL;
1273
1274         status = asus_wmi_evaluate_method_agfn(input);
1275
1276         if (status || args.agfn.err)
1277                 return -ENXIO;
1278
1279         if (speed && fan == 1)
1280                 asus->agfn_pwm = *speed;
1281
1282         return 0;
1283 }
1284
1285 /*
1286  * Check if we can read the speed of one fan. If true we assume we can also
1287  * control it.
1288  */
1289 static bool asus_wmi_has_agfn_fan(struct asus_wmi *asus)
1290 {
1291         int status;
1292         int speed;
1293         u32 value;
1294
1295         status = asus_agfn_fan_speed_read(asus, 1, &speed);
1296         if (status != 0)
1297                 return false;
1298
1299         status = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
1300         if (status != 0)
1301                 return false;
1302
1303         /*
1304          * We need to find a better way, probably using sfun,
1305          * bits or spec ...
1306          * Currently we disable it if:
1307          * - ASUS_WMI_UNSUPPORTED_METHOD is returned
1308          * - reverved bits are non-zero
1309          * - sfun and presence bit are not set
1310          */
1311         return !(value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
1312                  || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)));
1313 }
1314
1315 static int asus_fan_set_auto(struct asus_wmi *asus)
1316 {
1317         int status;
1318         u32 retval;
1319
1320         switch (asus->fan_type) {
1321         case FAN_TYPE_SPEC83:
1322                 status = asus_wmi_set_devstate(ASUS_WMI_DEVID_CPU_FAN_CTRL,
1323                                                0, &retval);
1324                 if (status)
1325                         return status;
1326
1327                 if (retval != 1)
1328                         return -EIO;
1329                 break;
1330
1331         case FAN_TYPE_AGFN:
1332                 status = asus_agfn_fan_speed_write(asus, 0, NULL);
1333                 if (status)
1334                         return -ENXIO;
1335                 break;
1336
1337         default:
1338                 return -ENXIO;
1339         }
1340
1341
1342         return 0;
1343 }
1344
1345 static ssize_t pwm1_show(struct device *dev,
1346                                struct device_attribute *attr,
1347                                char *buf)
1348 {
1349         struct asus_wmi *asus = dev_get_drvdata(dev);
1350         int err;
1351         int value;
1352
1353         /* If we already set a value then just return it */
1354         if (asus->agfn_pwm >= 0)
1355                 return sprintf(buf, "%d\n", asus->agfn_pwm);
1356
1357         /*
1358          * If we haven't set already set a value through the AGFN interface,
1359          * we read a current value through the (now-deprecated) FAN_CTRL device.
1360          */
1361         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
1362         if (err < 0)
1363                 return err;
1364
1365         value &= 0xFF;
1366
1367         if (value == 1) /* Low Speed */
1368                 value = 85;
1369         else if (value == 2)
1370                 value = 170;
1371         else if (value == 3)
1372                 value = 255;
1373         else if (value) {
1374                 pr_err("Unknown fan speed %#x\n", value);
1375                 value = -1;
1376         }
1377
1378         return sprintf(buf, "%d\n", value);
1379 }
1380
1381 static ssize_t pwm1_store(struct device *dev,
1382                                      struct device_attribute *attr,
1383                                      const char *buf, size_t count) {
1384         struct asus_wmi *asus = dev_get_drvdata(dev);
1385         int value;
1386         int state;
1387         int ret;
1388
1389         ret = kstrtouint(buf, 10, &value);
1390         if (ret)
1391                 return ret;
1392
1393         value = clamp(value, 0, 255);
1394
1395         state = asus_agfn_fan_speed_write(asus, 1, &value);
1396         if (state)
1397                 pr_warn("Setting fan speed failed: %d\n", state);
1398         else
1399                 asus->fan_pwm_mode = ASUS_FAN_CTRL_MANUAL;
1400
1401         return count;
1402 }
1403
1404 static ssize_t fan1_input_show(struct device *dev,
1405                                         struct device_attribute *attr,
1406                                         char *buf)
1407 {
1408         struct asus_wmi *asus = dev_get_drvdata(dev);
1409         int value;
1410         int ret;
1411
1412         switch (asus->fan_type) {
1413         case FAN_TYPE_SPEC83:
1414                 ret = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_CPU_FAN_CTRL,
1415                                             &value);
1416                 if (ret < 0)
1417                         return ret;
1418
1419                 value &= 0xffff;
1420                 break;
1421
1422         case FAN_TYPE_AGFN:
1423                 /* no speed readable on manual mode */
1424                 if (asus->fan_pwm_mode == ASUS_FAN_CTRL_MANUAL)
1425                         return -ENXIO;
1426
1427                 ret = asus_agfn_fan_speed_read(asus, 1, &value);
1428                 if (ret) {
1429                         pr_warn("reading fan speed failed: %d\n", ret);
1430                         return -ENXIO;
1431                 }
1432                 break;
1433
1434         default:
1435                 return -ENXIO;
1436         }
1437
1438         return sprintf(buf, "%d\n", value < 0 ? -1 : value*100);
1439 }
1440
1441 static ssize_t pwm1_enable_show(struct device *dev,
1442                                                  struct device_attribute *attr,
1443                                                  char *buf)
1444 {
1445         struct asus_wmi *asus = dev_get_drvdata(dev);
1446
1447         /*
1448          * Just read back the cached pwm mode.
1449          *
1450          * For the CPU_FAN device, the spec indicates that we should be
1451          * able to read the device status and consult bit 19 to see if we
1452          * are in Full On or Automatic mode. However, this does not work
1453          * in practice on X532FL at least (the bit is always 0) and there's
1454          * also nothing in the DSDT to indicate that this behaviour exists.
1455          */
1456         return sprintf(buf, "%d\n", asus->fan_pwm_mode);
1457 }
1458
1459 static ssize_t pwm1_enable_store(struct device *dev,
1460                                                   struct device_attribute *attr,
1461                                                   const char *buf, size_t count)
1462 {
1463         struct asus_wmi *asus = dev_get_drvdata(dev);
1464         int status = 0;
1465         int state;
1466         int value;
1467         int ret;
1468         u32 retval;
1469
1470         ret = kstrtouint(buf, 10, &state);
1471         if (ret)
1472                 return ret;
1473
1474         if (asus->fan_type == FAN_TYPE_SPEC83) {
1475                 switch (state) { /* standard documented hwmon values */
1476                 case ASUS_FAN_CTRL_FULLSPEED:
1477                         value = 1;
1478                         break;
1479                 case ASUS_FAN_CTRL_AUTO:
1480                         value = 0;
1481                         break;
1482                 default:
1483                         return -EINVAL;
1484                 }
1485
1486                 ret = asus_wmi_set_devstate(ASUS_WMI_DEVID_CPU_FAN_CTRL,
1487                                             value, &retval);
1488                 if (ret)
1489                         return ret;
1490
1491                 if (retval != 1)
1492                         return -EIO;
1493         } else if (asus->fan_type == FAN_TYPE_AGFN) {
1494                 switch (state) {
1495                 case ASUS_FAN_CTRL_MANUAL:
1496                         break;
1497
1498                 case ASUS_FAN_CTRL_AUTO:
1499                         status = asus_fan_set_auto(asus);
1500                         if (status)
1501                                 return status;
1502                         break;
1503
1504                 default:
1505                         return -EINVAL;
1506                 }
1507         }
1508
1509         asus->fan_pwm_mode = state;
1510         return count;
1511 }
1512
1513 static ssize_t fan1_label_show(struct device *dev,
1514                                           struct device_attribute *attr,
1515                                           char *buf)
1516 {
1517         return sprintf(buf, "%s\n", ASUS_FAN_DESC);
1518 }
1519
1520 static ssize_t asus_hwmon_temp1(struct device *dev,
1521                                 struct device_attribute *attr,
1522                                 char *buf)
1523 {
1524         struct asus_wmi *asus = dev_get_drvdata(dev);
1525         u32 value;
1526         int err;
1527
1528         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_THERMAL_CTRL, &value);
1529         if (err < 0)
1530                 return err;
1531
1532         return sprintf(buf, "%ld\n",
1533                        deci_kelvin_to_millicelsius(value & 0xFFFF));
1534 }
1535
1536 /* Fan1 */
1537 static DEVICE_ATTR_RW(pwm1);
1538 static DEVICE_ATTR_RW(pwm1_enable);
1539 static DEVICE_ATTR_RO(fan1_input);
1540 static DEVICE_ATTR_RO(fan1_label);
1541
1542 /* Temperature */
1543 static DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL);
1544
1545 static struct attribute *hwmon_attributes[] = {
1546         &dev_attr_pwm1.attr,
1547         &dev_attr_pwm1_enable.attr,
1548         &dev_attr_fan1_input.attr,
1549         &dev_attr_fan1_label.attr,
1550
1551         &dev_attr_temp1_input.attr,
1552         NULL
1553 };
1554
1555 static umode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
1556                                           struct attribute *attr, int idx)
1557 {
1558         struct device *dev = container_of(kobj, struct device, kobj);
1559         struct asus_wmi *asus = dev_get_drvdata(dev->parent);
1560         u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
1561
1562         if (attr == &dev_attr_pwm1.attr) {
1563                 if (asus->fan_type != FAN_TYPE_AGFN)
1564                         return 0;
1565         } else if (attr == &dev_attr_fan1_input.attr
1566             || attr == &dev_attr_fan1_label.attr
1567             || attr == &dev_attr_pwm1_enable.attr) {
1568                 if (asus->fan_type == FAN_TYPE_NONE)
1569                         return 0;
1570         } else if (attr == &dev_attr_temp1_input.attr) {
1571                 int err = asus_wmi_get_devstate(asus,
1572                                                 ASUS_WMI_DEVID_THERMAL_CTRL,
1573                                                 &value);
1574
1575                 if (err < 0)
1576                         return 0; /* can't return negative here */
1577
1578                 /*
1579                  * If the temperature value in deci-Kelvin is near the absolute
1580                  * zero temperature, something is clearly wrong
1581                  */
1582                 if (value == 0 || value == 1)
1583                         return 0;
1584         }
1585
1586         return attr->mode;
1587 }
1588
1589 static const struct attribute_group hwmon_attribute_group = {
1590         .is_visible = asus_hwmon_sysfs_is_visible,
1591         .attrs = hwmon_attributes
1592 };
1593 __ATTRIBUTE_GROUPS(hwmon_attribute);
1594
1595 static int asus_wmi_hwmon_init(struct asus_wmi *asus)
1596 {
1597         struct device *dev = &asus->platform_device->dev;
1598         struct device *hwmon;
1599
1600         hwmon = devm_hwmon_device_register_with_groups(dev, "asus", asus,
1601                         hwmon_attribute_groups);
1602
1603         if (IS_ERR(hwmon)) {
1604                 pr_err("Could not register asus hwmon device\n");
1605                 return PTR_ERR(hwmon);
1606         }
1607         return 0;
1608 }
1609
1610 static int asus_wmi_fan_init(struct asus_wmi *asus)
1611 {
1612         asus->fan_type = FAN_TYPE_NONE;
1613         asus->agfn_pwm = -1;
1614
1615         if (asus_wmi_dev_is_present(asus, ASUS_WMI_DEVID_CPU_FAN_CTRL))
1616                 asus->fan_type = FAN_TYPE_SPEC83;
1617         else if (asus_wmi_has_agfn_fan(asus))
1618                 asus->fan_type = FAN_TYPE_AGFN;
1619
1620         if (asus->fan_type == FAN_TYPE_NONE)
1621                 return -ENODEV;
1622
1623         asus_fan_set_auto(asus);
1624         asus->fan_pwm_mode = ASUS_FAN_CTRL_AUTO;
1625         return 0;
1626 }
1627
1628 /* Fan mode *******************************************************************/
1629
1630 static int fan_boost_mode_check_present(struct asus_wmi *asus)
1631 {
1632         u32 result;
1633         int err;
1634
1635         asus->fan_boost_mode_available = false;
1636
1637         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_BOOST_MODE,
1638                                     &result);
1639         if (err) {
1640                 if (err == -ENODEV)
1641                         return 0;
1642                 else
1643                         return err;
1644         }
1645
1646         if ((result & ASUS_WMI_DSTS_PRESENCE_BIT) &&
1647                         (result & ASUS_FAN_BOOST_MODES_MASK)) {
1648                 asus->fan_boost_mode_available = true;
1649                 asus->fan_boost_mode_mask = result & ASUS_FAN_BOOST_MODES_MASK;
1650         }
1651
1652         return 0;
1653 }
1654
1655 static int fan_boost_mode_write(struct asus_wmi *asus)
1656 {
1657         int err;
1658         u8 value;
1659         u32 retval;
1660
1661         value = asus->fan_boost_mode;
1662
1663         pr_info("Set fan boost mode: %u\n", value);
1664         err = asus_wmi_set_devstate(ASUS_WMI_DEVID_FAN_BOOST_MODE, value,
1665                                     &retval);
1666         if (err) {
1667                 pr_warn("Failed to set fan boost mode: %d\n", err);
1668                 return err;
1669         }
1670
1671         if (retval != 1) {
1672                 pr_warn("Failed to set fan boost mode (retval): 0x%x\n",
1673                         retval);
1674                 return -EIO;
1675         }
1676
1677         return 0;
1678 }
1679
1680 static int fan_boost_mode_switch_next(struct asus_wmi *asus)
1681 {
1682         u8 mask = asus->fan_boost_mode_mask;
1683
1684         if (asus->fan_boost_mode == ASUS_FAN_BOOST_MODE_NORMAL) {
1685                 if (mask & ASUS_FAN_BOOST_MODE_OVERBOOST_MASK)
1686                         asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_OVERBOOST;
1687                 else if (mask & ASUS_FAN_BOOST_MODE_SILENT_MASK)
1688                         asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_SILENT;
1689         } else if (asus->fan_boost_mode == ASUS_FAN_BOOST_MODE_OVERBOOST) {
1690                 if (mask & ASUS_FAN_BOOST_MODE_SILENT_MASK)
1691                         asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_SILENT;
1692                 else
1693                         asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_NORMAL;
1694         } else {
1695                 asus->fan_boost_mode = ASUS_FAN_BOOST_MODE_NORMAL;
1696         }
1697
1698         return fan_boost_mode_write(asus);
1699 }
1700
1701 static ssize_t fan_boost_mode_show(struct device *dev,
1702                                    struct device_attribute *attr, char *buf)
1703 {
1704         struct asus_wmi *asus = dev_get_drvdata(dev);
1705
1706         return scnprintf(buf, PAGE_SIZE, "%d\n", asus->fan_boost_mode);
1707 }
1708
1709 static ssize_t fan_boost_mode_store(struct device *dev,
1710                                     struct device_attribute *attr,
1711                                     const char *buf, size_t count)
1712 {
1713         int result;
1714         u8 new_mode;
1715         struct asus_wmi *asus = dev_get_drvdata(dev);
1716         u8 mask = asus->fan_boost_mode_mask;
1717
1718         result = kstrtou8(buf, 10, &new_mode);
1719         if (result < 0) {
1720                 pr_warn("Trying to store invalid value\n");
1721                 return result;
1722         }
1723
1724         if (new_mode == ASUS_FAN_BOOST_MODE_OVERBOOST) {
1725                 if (!(mask & ASUS_FAN_BOOST_MODE_OVERBOOST_MASK))
1726                         return -EINVAL;
1727         } else if (new_mode == ASUS_FAN_BOOST_MODE_SILENT) {
1728                 if (!(mask & ASUS_FAN_BOOST_MODE_SILENT_MASK))
1729                         return -EINVAL;
1730         } else if (new_mode != ASUS_FAN_BOOST_MODE_NORMAL) {
1731                 return -EINVAL;
1732         }
1733
1734         asus->fan_boost_mode = new_mode;
1735         fan_boost_mode_write(asus);
1736
1737         return count;
1738 }
1739
1740 // Fan boost mode: 0 - normal, 1 - overboost, 2 - silent
1741 static DEVICE_ATTR_RW(fan_boost_mode);
1742
1743 /* Throttle thermal policy ****************************************************/
1744
1745 static int throttle_thermal_policy_check_present(struct asus_wmi *asus)
1746 {
1747         u32 result;
1748         int err;
1749
1750         asus->throttle_thermal_policy_available = false;
1751
1752         err = asus_wmi_get_devstate(asus,
1753                                     ASUS_WMI_DEVID_THROTTLE_THERMAL_POLICY,
1754                                     &result);
1755         if (err) {
1756                 if (err == -ENODEV)
1757                         return 0;
1758                 return err;
1759         }
1760
1761         if (result & ASUS_WMI_DSTS_PRESENCE_BIT)
1762                 asus->throttle_thermal_policy_available = true;
1763
1764         return 0;
1765 }
1766
1767 static int throttle_thermal_policy_write(struct asus_wmi *asus)
1768 {
1769         int err;
1770         u8 value;
1771         u32 retval;
1772
1773         value = asus->throttle_thermal_policy_mode;
1774
1775         err = asus_wmi_set_devstate(ASUS_WMI_DEVID_THROTTLE_THERMAL_POLICY,
1776                                     value, &retval);
1777         if (err) {
1778                 pr_warn("Failed to set throttle thermal policy: %d\n", err);
1779                 return err;
1780         }
1781
1782         if (retval != 1) {
1783                 pr_warn("Failed to set throttle thermal policy (retval): 0x%x\n",
1784                         retval);
1785                 return -EIO;
1786         }
1787
1788         return 0;
1789 }
1790
1791 static int throttle_thermal_policy_set_default(struct asus_wmi *asus)
1792 {
1793         if (!asus->throttle_thermal_policy_available)
1794                 return 0;
1795
1796         asus->throttle_thermal_policy_mode = ASUS_THROTTLE_THERMAL_POLICY_DEFAULT;
1797         return throttle_thermal_policy_write(asus);
1798 }
1799
1800 static int throttle_thermal_policy_switch_next(struct asus_wmi *asus)
1801 {
1802         u8 new_mode = asus->throttle_thermal_policy_mode + 1;
1803
1804         if (new_mode > ASUS_THROTTLE_THERMAL_POLICY_SILENT)
1805                 new_mode = ASUS_THROTTLE_THERMAL_POLICY_DEFAULT;
1806
1807         asus->throttle_thermal_policy_mode = new_mode;
1808         return throttle_thermal_policy_write(asus);
1809 }
1810
1811 static ssize_t throttle_thermal_policy_show(struct device *dev,
1812                                    struct device_attribute *attr, char *buf)
1813 {
1814         struct asus_wmi *asus = dev_get_drvdata(dev);
1815         u8 mode = asus->throttle_thermal_policy_mode;
1816
1817         return scnprintf(buf, PAGE_SIZE, "%d\n", mode);
1818 }
1819
1820 static ssize_t throttle_thermal_policy_store(struct device *dev,
1821                                     struct device_attribute *attr,
1822                                     const char *buf, size_t count)
1823 {
1824         int result;
1825         u8 new_mode;
1826         struct asus_wmi *asus = dev_get_drvdata(dev);
1827
1828         result = kstrtou8(buf, 10, &new_mode);
1829         if (result < 0)
1830                 return result;
1831
1832         if (new_mode > ASUS_THROTTLE_THERMAL_POLICY_SILENT)
1833                 return -EINVAL;
1834
1835         asus->throttle_thermal_policy_mode = new_mode;
1836         throttle_thermal_policy_write(asus);
1837
1838         return count;
1839 }
1840
1841 // Throttle thermal policy: 0 - default, 1 - overboost, 2 - silent
1842 static DEVICE_ATTR_RW(throttle_thermal_policy);
1843
1844 /* Backlight ******************************************************************/
1845
1846 static int read_backlight_power(struct asus_wmi *asus)
1847 {
1848         int ret;
1849
1850         if (asus->driver->quirks->store_backlight_power)
1851                 ret = !asus->driver->panel_power;
1852         else
1853                 ret = asus_wmi_get_devstate_simple(asus,
1854                                                    ASUS_WMI_DEVID_BACKLIGHT);
1855
1856         if (ret < 0)
1857                 return ret;
1858
1859         return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
1860 }
1861
1862 static int read_brightness_max(struct asus_wmi *asus)
1863 {
1864         u32 retval;
1865         int err;
1866
1867         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1868         if (err < 0)
1869                 return err;
1870
1871         retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
1872         retval >>= 8;
1873
1874         if (!retval)
1875                 return -ENODEV;
1876
1877         return retval;
1878 }
1879
1880 static int read_brightness(struct backlight_device *bd)
1881 {
1882         struct asus_wmi *asus = bl_get_data(bd);
1883         u32 retval;
1884         int err;
1885
1886         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
1887         if (err < 0)
1888                 return err;
1889
1890         return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
1891 }
1892
1893 static u32 get_scalar_command(struct backlight_device *bd)
1894 {
1895         struct asus_wmi *asus = bl_get_data(bd);
1896         u32 ctrl_param = 0;
1897
1898         if ((asus->driver->brightness < bd->props.brightness) ||
1899             bd->props.brightness == bd->props.max_brightness)
1900                 ctrl_param = 0x00008001;
1901         else if ((asus->driver->brightness > bd->props.brightness) ||
1902                  bd->props.brightness == 0)
1903                 ctrl_param = 0x00008000;
1904
1905         asus->driver->brightness = bd->props.brightness;
1906
1907         return ctrl_param;
1908 }
1909
1910 static int update_bl_status(struct backlight_device *bd)
1911 {
1912         struct asus_wmi *asus = bl_get_data(bd);
1913         u32 ctrl_param;
1914         int power, err = 0;
1915
1916         power = read_backlight_power(asus);
1917         if (power != -ENODEV && bd->props.power != power) {
1918                 ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
1919                 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
1920                                             ctrl_param, NULL);
1921                 if (asus->driver->quirks->store_backlight_power)
1922                         asus->driver->panel_power = bd->props.power;
1923
1924                 /* When using scalar brightness, updating the brightness
1925                  * will mess with the backlight power */
1926                 if (asus->driver->quirks->scalar_panel_brightness)
1927                         return err;
1928         }
1929
1930         if (asus->driver->quirks->scalar_panel_brightness)
1931                 ctrl_param = get_scalar_command(bd);
1932         else
1933                 ctrl_param = bd->props.brightness;
1934
1935         err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
1936                                     ctrl_param, NULL);
1937
1938         return err;
1939 }
1940
1941 static const struct backlight_ops asus_wmi_bl_ops = {
1942         .get_brightness = read_brightness,
1943         .update_status = update_bl_status,
1944 };
1945
1946 static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
1947 {
1948         struct backlight_device *bd = asus->backlight_device;
1949         int old = bd->props.brightness;
1950         int new = old;
1951
1952         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1953                 new = code - NOTIFY_BRNUP_MIN + 1;
1954         else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
1955                 new = code - NOTIFY_BRNDOWN_MIN;
1956
1957         bd->props.brightness = new;
1958         backlight_update_status(bd);
1959         backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1960
1961         return old;
1962 }
1963
1964 static int asus_wmi_backlight_init(struct asus_wmi *asus)
1965 {
1966         struct backlight_device *bd;
1967         struct backlight_properties props;
1968         int max;
1969         int power;
1970
1971         max = read_brightness_max(asus);
1972         if (max < 0)
1973                 return max;
1974
1975         power = read_backlight_power(asus);
1976         if (power == -ENODEV)
1977                 power = FB_BLANK_UNBLANK;
1978         else if (power < 0)
1979                 return power;
1980
1981         memset(&props, 0, sizeof(struct backlight_properties));
1982         props.type = BACKLIGHT_PLATFORM;
1983         props.max_brightness = max;
1984         bd = backlight_device_register(asus->driver->name,
1985                                        &asus->platform_device->dev, asus,
1986                                        &asus_wmi_bl_ops, &props);
1987         if (IS_ERR(bd)) {
1988                 pr_err("Could not register backlight device\n");
1989                 return PTR_ERR(bd);
1990         }
1991
1992         asus->backlight_device = bd;
1993
1994         if (asus->driver->quirks->store_backlight_power)
1995                 asus->driver->panel_power = power;
1996
1997         bd->props.brightness = read_brightness(bd);
1998         bd->props.power = power;
1999         backlight_update_status(bd);
2000
2001         asus->driver->brightness = bd->props.brightness;
2002
2003         return 0;
2004 }
2005
2006 static void asus_wmi_backlight_exit(struct asus_wmi *asus)
2007 {
2008         backlight_device_unregister(asus->backlight_device);
2009
2010         asus->backlight_device = NULL;
2011 }
2012
2013 static int is_display_toggle(int code)
2014 {
2015         /* display toggle keys */
2016         if ((code >= 0x61 && code <= 0x67) ||
2017             (code >= 0x8c && code <= 0x93) ||
2018             (code >= 0xa0 && code <= 0xa7) ||
2019             (code >= 0xd0 && code <= 0xd5))
2020                 return 1;
2021
2022         return 0;
2023 }
2024
2025 /* Fn-lock ********************************************************************/
2026
2027 static bool asus_wmi_has_fnlock_key(struct asus_wmi *asus)
2028 {
2029         u32 result;
2030
2031         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FNLOCK, &result);
2032
2033         return (result & ASUS_WMI_DSTS_PRESENCE_BIT) &&
2034                 !(result & ASUS_WMI_FNLOCK_BIOS_DISABLED);
2035 }
2036
2037 static void asus_wmi_fnlock_update(struct asus_wmi *asus)
2038 {
2039         int mode = asus->fnlock_locked;
2040
2041         asus_wmi_set_devstate(ASUS_WMI_DEVID_FNLOCK, mode, NULL);
2042 }
2043
2044 /* WMI events *****************************************************************/
2045
2046 static int asus_wmi_get_event_code(u32 value)
2047 {
2048         struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
2049         union acpi_object *obj;
2050         acpi_status status;
2051         int code;
2052
2053         status = wmi_get_event_data(value, &response);
2054         if (ACPI_FAILURE(status)) {
2055                 pr_warn("Failed to get WMI notify code: %s\n",
2056                                 acpi_format_exception(status));
2057                 return -EIO;
2058         }
2059
2060         obj = (union acpi_object *)response.pointer;
2061
2062         if (obj && obj->type == ACPI_TYPE_INTEGER)
2063                 code = (int)(obj->integer.value & WMI_EVENT_MASK);
2064         else
2065                 code = -EIO;
2066
2067         kfree(obj);
2068         return code;
2069 }
2070
2071 static void asus_wmi_handle_event_code(int code, struct asus_wmi *asus)
2072 {
2073         unsigned int key_value = 1;
2074         bool autorelease = 1;
2075         int result, orig_code;
2076
2077         orig_code = code;
2078
2079         if (asus->driver->key_filter) {
2080                 asus->driver->key_filter(asus->driver, &code, &key_value,
2081                                          &autorelease);
2082                 if (code == ASUS_WMI_KEY_IGNORE)
2083                         return;
2084         }
2085
2086         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
2087                 code = ASUS_WMI_BRN_UP;
2088         else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
2089                 code = ASUS_WMI_BRN_DOWN;
2090
2091         if (code == ASUS_WMI_BRN_DOWN || code == ASUS_WMI_BRN_UP) {
2092                 if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2093                         asus_wmi_backlight_notify(asus, orig_code);
2094                         return;
2095                 }
2096         }
2097
2098         if (code == NOTIFY_KBD_BRTUP) {
2099                 kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
2100                 return;
2101         }
2102         if (code == NOTIFY_KBD_BRTDWN) {
2103                 kbd_led_set_by_kbd(asus, asus->kbd_led_wk - 1);
2104                 return;
2105         }
2106         if (code == NOTIFY_KBD_BRTTOGGLE) {
2107                 if (asus->kbd_led_wk == asus->kbd_led.max_brightness)
2108                         kbd_led_set_by_kbd(asus, 0);
2109                 else
2110                         kbd_led_set_by_kbd(asus, asus->kbd_led_wk + 1);
2111                 return;
2112         }
2113
2114         if (code == NOTIFY_FNLOCK_TOGGLE) {
2115                 asus->fnlock_locked = !asus->fnlock_locked;
2116                 asus_wmi_fnlock_update(asus);
2117                 return;
2118         }
2119
2120         if (asus->driver->quirks->use_kbd_dock_devid && code == NOTIFY_KBD_DOCK_CHANGE) {
2121                 result = asus_wmi_get_devstate_simple(asus,
2122                                                       ASUS_WMI_DEVID_KBD_DOCK);
2123                 if (result >= 0) {
2124                         input_report_switch(asus->inputdev, SW_TABLET_MODE,
2125                                             !result);
2126                         input_sync(asus->inputdev);
2127                 }
2128                 return;
2129         }
2130
2131         if (asus->fan_boost_mode_available && code == NOTIFY_KBD_FBM) {
2132                 fan_boost_mode_switch_next(asus);
2133                 return;
2134         }
2135
2136         if (asus->throttle_thermal_policy_available && code == NOTIFY_KBD_TTP) {
2137                 throttle_thermal_policy_switch_next(asus);
2138                 return;
2139         }
2140
2141         if (is_display_toggle(code) && asus->driver->quirks->no_display_toggle)
2142                 return;
2143
2144         if (!sparse_keymap_report_event(asus->inputdev, code,
2145                                         key_value, autorelease))
2146                 pr_info("Unknown key %x pressed\n", code);
2147 }
2148
2149 static void asus_wmi_notify(u32 value, void *context)
2150 {
2151         struct asus_wmi *asus = context;
2152         int code;
2153         int i;
2154
2155         for (i = 0; i < WMI_EVENT_QUEUE_SIZE + 1; i++) {
2156                 code = asus_wmi_get_event_code(value);
2157                 if (code < 0) {
2158                         pr_warn("Failed to get notify code: %d\n", code);
2159                         return;
2160                 }
2161
2162                 if (code == WMI_EVENT_QUEUE_END || code == WMI_EVENT_MASK)
2163                         return;
2164
2165                 asus_wmi_handle_event_code(code, asus);
2166
2167                 /*
2168                  * Double check that queue is present:
2169                  * ATK (with queue) uses 0xff, ASUSWMI (without) 0xd2.
2170                  */
2171                 if (!asus->wmi_event_queue || value != WMI_EVENT_VALUE_ATK)
2172                         return;
2173         }
2174
2175         pr_warn("Failed to process event queue, last code: 0x%x\n", code);
2176 }
2177
2178 static int asus_wmi_notify_queue_flush(struct asus_wmi *asus)
2179 {
2180         int code;
2181         int i;
2182
2183         for (i = 0; i < WMI_EVENT_QUEUE_SIZE + 1; i++) {
2184                 code = asus_wmi_get_event_code(WMI_EVENT_VALUE_ATK);
2185                 if (code < 0) {
2186                         pr_warn("Failed to get event during flush: %d\n", code);
2187                         return code;
2188                 }
2189
2190                 if (code == WMI_EVENT_QUEUE_END || code == WMI_EVENT_MASK)
2191                         return 0;
2192         }
2193
2194         pr_warn("Failed to flush event queue\n");
2195         return -EIO;
2196 }
2197
2198 /* Sysfs **********************************************************************/
2199
2200 static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
2201                              const char *buf, size_t count)
2202 {
2203         u32 retval;
2204         int err, value;
2205
2206         value = asus_wmi_get_devstate_simple(asus, devid);
2207         if (value < 0)
2208                 return value;
2209
2210         err = kstrtoint(buf, 0, &value);
2211         if (err)
2212                 return err;
2213
2214         err = asus_wmi_set_devstate(devid, value, &retval);
2215         if (err < 0)
2216                 return err;
2217
2218         return count;
2219 }
2220
2221 static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
2222 {
2223         int value = asus_wmi_get_devstate_simple(asus, devid);
2224
2225         if (value < 0)
2226                 return value;
2227
2228         return sprintf(buf, "%d\n", value);
2229 }
2230
2231 #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)                  \
2232         static ssize_t show_##_name(struct device *dev,                 \
2233                                     struct device_attribute *attr,      \
2234                                     char *buf)                          \
2235         {                                                               \
2236                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
2237                                                                         \
2238                 return show_sys_wmi(asus, _cm, buf);                    \
2239         }                                                               \
2240         static ssize_t store_##_name(struct device *dev,                \
2241                                      struct device_attribute *attr,     \
2242                                      const char *buf, size_t count)     \
2243         {                                                               \
2244                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
2245                                                                         \
2246                 return store_sys_wmi(asus, _cm, buf, count);            \
2247         }                                                               \
2248         static struct device_attribute dev_attr_##_name = {             \
2249                 .attr = {                                               \
2250                         .name = __stringify(_name),                     \
2251                         .mode = _mode },                                \
2252                 .show   = show_##_name,                                 \
2253                 .store  = store_##_name,                                \
2254         }
2255
2256 ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
2257 ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
2258 ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
2259 ASUS_WMI_CREATE_DEVICE_ATTR(lid_resume, 0644, ASUS_WMI_DEVID_LID_RESUME);
2260 ASUS_WMI_CREATE_DEVICE_ATTR(als_enable, 0644, ASUS_WMI_DEVID_ALS_ENABLE);
2261
2262 static ssize_t cpufv_store(struct device *dev, struct device_attribute *attr,
2263                            const char *buf, size_t count)
2264 {
2265         int value, rv;
2266
2267         rv = kstrtoint(buf, 0, &value);
2268         if (rv)
2269                 return rv;
2270
2271         if (value < 0 || value > 2)
2272                 return -EINVAL;
2273
2274         rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
2275         if (rv < 0)
2276                 return rv;
2277
2278         return count;
2279 }
2280
2281 static DEVICE_ATTR_WO(cpufv);
2282
2283 static struct attribute *platform_attributes[] = {
2284         &dev_attr_cpufv.attr,
2285         &dev_attr_camera.attr,
2286         &dev_attr_cardr.attr,
2287         &dev_attr_touchpad.attr,
2288         &dev_attr_lid_resume.attr,
2289         &dev_attr_als_enable.attr,
2290         &dev_attr_fan_boost_mode.attr,
2291         &dev_attr_throttle_thermal_policy.attr,
2292         NULL
2293 };
2294
2295 static umode_t asus_sysfs_is_visible(struct kobject *kobj,
2296                                     struct attribute *attr, int idx)
2297 {
2298         struct device *dev = container_of(kobj, struct device, kobj);
2299         struct asus_wmi *asus = dev_get_drvdata(dev);
2300         bool ok = true;
2301         int devid = -1;
2302
2303         if (attr == &dev_attr_camera.attr)
2304                 devid = ASUS_WMI_DEVID_CAMERA;
2305         else if (attr == &dev_attr_cardr.attr)
2306                 devid = ASUS_WMI_DEVID_CARDREADER;
2307         else if (attr == &dev_attr_touchpad.attr)
2308                 devid = ASUS_WMI_DEVID_TOUCHPAD;
2309         else if (attr == &dev_attr_lid_resume.attr)
2310                 devid = ASUS_WMI_DEVID_LID_RESUME;
2311         else if (attr == &dev_attr_als_enable.attr)
2312                 devid = ASUS_WMI_DEVID_ALS_ENABLE;
2313         else if (attr == &dev_attr_fan_boost_mode.attr)
2314                 ok = asus->fan_boost_mode_available;
2315         else if (attr == &dev_attr_throttle_thermal_policy.attr)
2316                 ok = asus->throttle_thermal_policy_available;
2317
2318         if (devid != -1)
2319                 ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
2320
2321         return ok ? attr->mode : 0;
2322 }
2323
2324 static const struct attribute_group platform_attribute_group = {
2325         .is_visible = asus_sysfs_is_visible,
2326         .attrs = platform_attributes
2327 };
2328
2329 static void asus_wmi_sysfs_exit(struct platform_device *device)
2330 {
2331         sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
2332 }
2333
2334 static int asus_wmi_sysfs_init(struct platform_device *device)
2335 {
2336         return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
2337 }
2338
2339 /* Platform device ************************************************************/
2340
2341 static int asus_wmi_platform_init(struct asus_wmi *asus)
2342 {
2343         struct device *dev = &asus->platform_device->dev;
2344         char *wmi_uid;
2345         int rv;
2346
2347         /* INIT enable hotkeys on some models */
2348         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
2349                 pr_info("Initialization: %#x\n", rv);
2350
2351         /* We don't know yet what to do with this version... */
2352         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
2353                 pr_info("BIOS WMI version: %d.%d\n", rv >> 16, rv & 0xFF);
2354                 asus->spec = rv;
2355         }
2356
2357         /*
2358          * The SFUN method probably allows the original driver to get the list
2359          * of features supported by a given model. For now, 0x0100 or 0x0800
2360          * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
2361          * The significance of others is yet to be found.
2362          */
2363         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
2364                 pr_info("SFUN value: %#x\n", rv);
2365                 asus->sfun = rv;
2366         }
2367
2368         /*
2369          * Eee PC and Notebooks seems to have different method_id for DSTS,
2370          * but it may also be related to the BIOS's SPEC.
2371          * Note, on most Eeepc, there is no way to check if a method exist
2372          * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
2373          * but once again, SPEC may probably be used for that kind of things.
2374          *
2375          * Additionally at least TUF Gaming series laptops return nothing for
2376          * unknown methods, so the detection in this way is not possible.
2377          *
2378          * There is strong indication that only ACPI WMI devices that have _UID
2379          * equal to "ASUSWMI" use DCTS whereas those with "ATK" use DSTS.
2380          */
2381         wmi_uid = wmi_get_acpi_device_uid(ASUS_WMI_MGMT_GUID);
2382         if (!wmi_uid)
2383                 return -ENODEV;
2384
2385         if (!strcmp(wmi_uid, ASUS_ACPI_UID_ASUSWMI)) {
2386                 dev_info(dev, "Detected ASUSWMI, use DCTS\n");
2387                 asus->dsts_id = ASUS_WMI_METHODID_DCTS;
2388         } else {
2389                 dev_info(dev, "Detected %s, not ASUSWMI, use DSTS\n", wmi_uid);
2390                 asus->dsts_id = ASUS_WMI_METHODID_DSTS;
2391         }
2392
2393         /*
2394          * Some devices can have multiple event codes stored in a queue before
2395          * the module load if it was unloaded intermittently after calling
2396          * the INIT method (enables event handling). The WMI notify handler is
2397          * expected to retrieve all event codes until a retrieved code equals
2398          * queue end marker (One or Ones). Old codes are flushed from the queue
2399          * upon module load. Not enabling this when it should be has minimal
2400          * visible impact so fall back if anything goes wrong.
2401          */
2402         wmi_uid = wmi_get_acpi_device_uid(asus->driver->event_guid);
2403         if (wmi_uid && !strcmp(wmi_uid, ASUS_ACPI_UID_ATK)) {
2404                 dev_info(dev, "Detected ATK, enable event queue\n");
2405
2406                 if (!asus_wmi_notify_queue_flush(asus))
2407                         asus->wmi_event_queue = true;
2408         }
2409
2410         /* CWAP allow to define the behavior of the Fn+F2 key,
2411          * this method doesn't seems to be present on Eee PCs */
2412         if (asus->driver->quirks->wapf >= 0)
2413                 asus_wmi_set_devstate(ASUS_WMI_DEVID_CWAP,
2414                                       asus->driver->quirks->wapf, NULL);
2415
2416         return 0;
2417 }
2418
2419 /* debugfs ********************************************************************/
2420
2421 struct asus_wmi_debugfs_node {
2422         struct asus_wmi *asus;
2423         char *name;
2424         int (*show) (struct seq_file *m, void *data);
2425 };
2426
2427 static int show_dsts(struct seq_file *m, void *data)
2428 {
2429         struct asus_wmi *asus = m->private;
2430         int err;
2431         u32 retval = -1;
2432
2433         err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
2434         if (err < 0)
2435                 return err;
2436
2437         seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
2438
2439         return 0;
2440 }
2441
2442 static int show_devs(struct seq_file *m, void *data)
2443 {
2444         struct asus_wmi *asus = m->private;
2445         int err;
2446         u32 retval = -1;
2447
2448         err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
2449                                     &retval);
2450         if (err < 0)
2451                 return err;
2452
2453         seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
2454                    asus->debug.ctrl_param, retval);
2455
2456         return 0;
2457 }
2458
2459 static int show_call(struct seq_file *m, void *data)
2460 {
2461         struct asus_wmi *asus = m->private;
2462         struct bios_args args = {
2463                 .arg0 = asus->debug.dev_id,
2464                 .arg1 = asus->debug.ctrl_param,
2465         };
2466         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
2467         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
2468         union acpi_object *obj;
2469         acpi_status status;
2470
2471         status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
2472                                      0, asus->debug.method_id,
2473                                      &input, &output);
2474
2475         if (ACPI_FAILURE(status))
2476                 return -EIO;
2477
2478         obj = (union acpi_object *)output.pointer;
2479         if (obj && obj->type == ACPI_TYPE_INTEGER)
2480                 seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
2481                            asus->debug.dev_id, asus->debug.ctrl_param,
2482                            (u32) obj->integer.value);
2483         else
2484                 seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
2485                            asus->debug.dev_id, asus->debug.ctrl_param,
2486                            obj ? obj->type : -1);
2487
2488         kfree(obj);
2489
2490         return 0;
2491 }
2492
2493 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
2494         {NULL, "devs", show_devs},
2495         {NULL, "dsts", show_dsts},
2496         {NULL, "call", show_call},
2497 };
2498
2499 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
2500 {
2501         struct asus_wmi_debugfs_node *node = inode->i_private;
2502
2503         return single_open(file, node->show, node->asus);
2504 }
2505
2506 static const struct file_operations asus_wmi_debugfs_io_ops = {
2507         .owner = THIS_MODULE,
2508         .open = asus_wmi_debugfs_open,
2509         .read = seq_read,
2510         .llseek = seq_lseek,
2511         .release = single_release,
2512 };
2513
2514 static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
2515 {
2516         debugfs_remove_recursive(asus->debug.root);
2517 }
2518
2519 static void asus_wmi_debugfs_init(struct asus_wmi *asus)
2520 {
2521         int i;
2522
2523         asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
2524
2525         debugfs_create_x32("method_id", S_IRUGO | S_IWUSR, asus->debug.root,
2526                            &asus->debug.method_id);
2527
2528         debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR, asus->debug.root,
2529                            &asus->debug.dev_id);
2530
2531         debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR, asus->debug.root,
2532                            &asus->debug.ctrl_param);
2533
2534         for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
2535                 struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
2536
2537                 node->asus = asus;
2538                 debugfs_create_file(node->name, S_IFREG | S_IRUGO,
2539                                     asus->debug.root, node,
2540                                     &asus_wmi_debugfs_io_ops);
2541         }
2542 }
2543
2544 /* Init / exit ****************************************************************/
2545
2546 static int asus_wmi_add(struct platform_device *pdev)
2547 {
2548         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2549         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2550         struct asus_wmi *asus;
2551         const char *chassis_type;
2552         acpi_status status;
2553         int err;
2554         u32 result;
2555
2556         asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
2557         if (!asus)
2558                 return -ENOMEM;
2559
2560         asus->driver = wdrv;
2561         asus->platform_device = pdev;
2562         wdrv->platform_device = pdev;
2563         platform_set_drvdata(asus->platform_device, asus);
2564
2565         if (wdrv->detect_quirks)
2566                 wdrv->detect_quirks(asus->driver);
2567
2568         err = asus_wmi_platform_init(asus);
2569         if (err)
2570                 goto fail_platform;
2571
2572         err = fan_boost_mode_check_present(asus);
2573         if (err)
2574                 goto fail_fan_boost_mode;
2575
2576         err = throttle_thermal_policy_check_present(asus);
2577         if (err)
2578                 goto fail_throttle_thermal_policy;
2579         else
2580                 throttle_thermal_policy_set_default(asus);
2581
2582         err = asus_wmi_sysfs_init(asus->platform_device);
2583         if (err)
2584                 goto fail_sysfs;
2585
2586         err = asus_wmi_input_init(asus);
2587         if (err)
2588                 goto fail_input;
2589
2590         err = asus_wmi_fan_init(asus); /* probably no problems on error */
2591
2592         err = asus_wmi_hwmon_init(asus);
2593         if (err)
2594                 goto fail_hwmon;
2595
2596         err = asus_wmi_led_init(asus);
2597         if (err)
2598                 goto fail_leds;
2599
2600         asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_WLAN, &result);
2601         if (result & (ASUS_WMI_DSTS_PRESENCE_BIT | ASUS_WMI_DSTS_USER_BIT))
2602                 asus->driver->wlan_ctrl_by_user = 1;
2603
2604         if (!(asus->driver->wlan_ctrl_by_user && ashs_present())) {
2605                 err = asus_wmi_rfkill_init(asus);
2606                 if (err)
2607                         goto fail_rfkill;
2608         }
2609
2610         if (asus->driver->quirks->wmi_force_als_set)
2611                 asus_wmi_set_als();
2612
2613         /* Some Asus desktop boards export an acpi-video backlight interface,
2614            stop this from showing up */
2615         chassis_type = dmi_get_system_info(DMI_CHASSIS_TYPE);
2616         if (chassis_type && !strcmp(chassis_type, "3"))
2617                 acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2618
2619         if (asus->driver->quirks->wmi_backlight_power)
2620                 acpi_video_set_dmi_backlight_type(acpi_backlight_vendor);
2621
2622         if (asus->driver->quirks->wmi_backlight_native)
2623                 acpi_video_set_dmi_backlight_type(acpi_backlight_native);
2624
2625         if (asus->driver->quirks->xusb2pr)
2626                 asus_wmi_set_xusb2pr(asus);
2627
2628         if (acpi_video_get_backlight_type() == acpi_backlight_vendor) {
2629                 err = asus_wmi_backlight_init(asus);
2630                 if (err && err != -ENODEV)
2631                         goto fail_backlight;
2632         } else if (asus->driver->quirks->wmi_backlight_set_devstate)
2633                 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT, 2, NULL);
2634
2635         if (asus_wmi_has_fnlock_key(asus)) {
2636                 asus->fnlock_locked = true;
2637                 asus_wmi_fnlock_update(asus);
2638         }
2639
2640         status = wmi_install_notify_handler(asus->driver->event_guid,
2641                                             asus_wmi_notify, asus);
2642         if (ACPI_FAILURE(status)) {
2643                 pr_err("Unable to register notify handler - %d\n", status);
2644                 err = -ENODEV;
2645                 goto fail_wmi_handler;
2646         }
2647
2648         asus_wmi_battery_init(asus);
2649
2650         asus_wmi_debugfs_init(asus);
2651
2652         return 0;
2653
2654 fail_wmi_handler:
2655         asus_wmi_backlight_exit(asus);
2656 fail_backlight:
2657         asus_wmi_rfkill_exit(asus);
2658 fail_rfkill:
2659         asus_wmi_led_exit(asus);
2660 fail_leds:
2661 fail_hwmon:
2662         asus_wmi_input_exit(asus);
2663 fail_input:
2664         asus_wmi_sysfs_exit(asus->platform_device);
2665 fail_sysfs:
2666 fail_throttle_thermal_policy:
2667 fail_fan_boost_mode:
2668 fail_platform:
2669         kfree(asus);
2670         return err;
2671 }
2672
2673 static int asus_wmi_remove(struct platform_device *device)
2674 {
2675         struct asus_wmi *asus;
2676
2677         asus = platform_get_drvdata(device);
2678         wmi_remove_notify_handler(asus->driver->event_guid);
2679         asus_wmi_backlight_exit(asus);
2680         asus_wmi_input_exit(asus);
2681         asus_wmi_led_exit(asus);
2682         asus_wmi_rfkill_exit(asus);
2683         asus_wmi_debugfs_exit(asus);
2684         asus_wmi_sysfs_exit(asus->platform_device);
2685         asus_fan_set_auto(asus);
2686         asus_wmi_battery_exit(asus);
2687
2688         kfree(asus);
2689         return 0;
2690 }
2691
2692 /* Platform driver - hibernate/resume callbacks *******************************/
2693
2694 static int asus_hotk_thaw(struct device *device)
2695 {
2696         struct asus_wmi *asus = dev_get_drvdata(device);
2697
2698         if (asus->wlan.rfkill) {
2699                 bool wlan;
2700
2701                 /*
2702                  * Work around bios bug - acpi _PTS turns off the wireless led
2703                  * during suspend.  Normally it restores it on resume, but
2704                  * we should kick it ourselves in case hibernation is aborted.
2705                  */
2706                 wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
2707                 asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
2708         }
2709
2710         return 0;
2711 }
2712
2713 static int asus_hotk_resume(struct device *device)
2714 {
2715         struct asus_wmi *asus = dev_get_drvdata(device);
2716
2717         if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2718                 kbd_led_update(asus);
2719
2720         if (asus_wmi_has_fnlock_key(asus))
2721                 asus_wmi_fnlock_update(asus);
2722         return 0;
2723 }
2724
2725 static int asus_hotk_restore(struct device *device)
2726 {
2727         struct asus_wmi *asus = dev_get_drvdata(device);
2728         int bl;
2729
2730         /* Refresh both wlan rfkill state and pci hotplug */
2731         if (asus->wlan.rfkill)
2732                 asus_rfkill_hotplug(asus);
2733
2734         if (asus->bluetooth.rfkill) {
2735                 bl = !asus_wmi_get_devstate_simple(asus,
2736                                                    ASUS_WMI_DEVID_BLUETOOTH);
2737                 rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
2738         }
2739         if (asus->wimax.rfkill) {
2740                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
2741                 rfkill_set_sw_state(asus->wimax.rfkill, bl);
2742         }
2743         if (asus->wwan3g.rfkill) {
2744                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
2745                 rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
2746         }
2747         if (asus->gps.rfkill) {
2748                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_GPS);
2749                 rfkill_set_sw_state(asus->gps.rfkill, bl);
2750         }
2751         if (asus->uwb.rfkill) {
2752                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_UWB);
2753                 rfkill_set_sw_state(asus->uwb.rfkill, bl);
2754         }
2755         if (!IS_ERR_OR_NULL(asus->kbd_led.dev))
2756                 kbd_led_update(asus);
2757
2758         if (asus_wmi_has_fnlock_key(asus))
2759                 asus_wmi_fnlock_update(asus);
2760         return 0;
2761 }
2762
2763 static const struct dev_pm_ops asus_pm_ops = {
2764         .thaw = asus_hotk_thaw,
2765         .restore = asus_hotk_restore,
2766         .resume = asus_hotk_resume,
2767 };
2768
2769 /* Registration ***************************************************************/
2770
2771 static int asus_wmi_probe(struct platform_device *pdev)
2772 {
2773         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
2774         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
2775         int ret;
2776
2777         if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
2778                 pr_warn("ASUS Management GUID not found\n");
2779                 return -ENODEV;
2780         }
2781
2782         if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
2783                 pr_warn("ASUS Event GUID not found\n");
2784                 return -ENODEV;
2785         }
2786
2787         if (wdrv->probe) {
2788                 ret = wdrv->probe(pdev);
2789                 if (ret)
2790                         return ret;
2791         }
2792
2793         return asus_wmi_add(pdev);
2794 }
2795
2796 static bool used;
2797
2798 int __init_or_module asus_wmi_register_driver(struct asus_wmi_driver *driver)
2799 {
2800         struct platform_driver *platform_driver;
2801         struct platform_device *platform_device;
2802
2803         if (used)
2804                 return -EBUSY;
2805
2806         platform_driver = &driver->platform_driver;
2807         platform_driver->remove = asus_wmi_remove;
2808         platform_driver->driver.owner = driver->owner;
2809         platform_driver->driver.name = driver->name;
2810         platform_driver->driver.pm = &asus_pm_ops;
2811
2812         platform_device = platform_create_bundle(platform_driver,
2813                                                  asus_wmi_probe,
2814                                                  NULL, 0, NULL, 0);
2815         if (IS_ERR(platform_device))
2816                 return PTR_ERR(platform_device);
2817
2818         used = true;
2819         return 0;
2820 }
2821 EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
2822
2823 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
2824 {
2825         platform_device_unregister(driver->platform_device);
2826         platform_driver_unregister(&driver->platform_driver);
2827         used = false;
2828 }
2829 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
2830
2831 static int __init asus_wmi_init(void)
2832 {
2833         pr_info("ASUS WMI generic driver loaded\n");
2834         return 0;
2835 }
2836
2837 static void __exit asus_wmi_exit(void)
2838 {
2839         pr_info("ASUS WMI generic driver unloaded\n");
2840 }
2841
2842 module_init(asus_wmi_init);
2843 module_exit(asus_wmi_exit);