linux/drivers/platform/x86/asus-wmi.c
<<
>>
Prefs
   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
  45MODULE_AUTHOR("Corentin Chary <corentin.chary@gmail.com>, "
  46              "Yong Wang <yong.y.wang@intel.com>");
  47MODULE_DESCRIPTION("Asus Generic WMI Driver");
  48MODULE_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
 104static const char * const ashs_ids[] = { "ATK4001", "ATK4002", NULL };
 105
 106static 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
 116struct 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 */
 128struct 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 */
 137struct 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 */
 152struct asus_wmi_debug {
 153        struct dentry *root;
 154        u32 method_id;
 155        u32 dev_id;
 156        u32 ctrl_param;
 157};
 158
 159struct asus_rfkill {
 160        struct asus_wmi *asus;
 161        struct rfkill *rfkill;
 162        u32 dev_id;
 163};
 164
 165enum 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
 171struct 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
 230static 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
 265int 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}
 269EXPORT_SYMBOL_GPL(asus_wmi_evaluate_method);
 270
 271static 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
 300static 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
 305static 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 */
 313static 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
 334static 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
 340static 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
 350static 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
 384err_free_dev:
 385        input_free_device(asus->inputdev);
 386        return err;
 387}
 388
 389static 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 */
 400static int charge_end_threshold;
 401
 402static 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
 429static 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
 436static DEVICE_ATTR_RW(charge_control_end_threshold);
 437
 438static 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
 465static 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
 472static 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
 478static 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
 487static 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 */
 501static 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
 512static 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
 523static 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
 528static 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
 537static 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
 545static 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
 572static 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
 584static 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
 594static 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
 602static 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
 616static 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
 625static 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
 636static 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
 647static 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
 658static 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
 669static 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
 680static 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
 691static 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
 702static 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
 768error:
 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 */
 780static 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
 789static 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
 851out_unlock:
 852        pci_unlock_rescan_remove();
 853        mutex_unlock(&asus->hotplug_lock);
 854}
 855
 856static 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
 873static 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
 890static 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
 905static 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
 919static 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
 924static 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
 932static 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
 959error_register:
 960        asus->hotplug_slot.ops = NULL;
 961        destroy_workqueue(asus->hotplug_workqueue);
 962error_workqueue:
 963        return ret;
 964}
 965
 966/*
 967 * Rfkill devices
 968 */
 969static 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
 990static 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
1003static 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
1022static const struct rfkill_ops asus_rfkill_wlan_ops = {
1023        .set_block = asus_rfkill_wlan_set,
1024        .query = asus_rfkill_query,
1025};
1026
1027static const struct rfkill_ops asus_rfkill_ops = {
1028        .set_block = asus_rfkill_set,
1029        .query = asus_rfkill_query,
1030};
1031
1032static 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
1070static 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
1120static 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
1184exit:
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
1196static 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 */
1223static 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
1230static 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
1257static 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 */
1289static 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
1315static 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
1345static 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
1381static 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
1404static 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
1441static 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
1459static 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
1513static 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
1520static 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 */
1537static DEVICE_ATTR_RW(pwm1);
1538static DEVICE_ATTR_RW(pwm1_enable);
1539static DEVICE_ATTR_RO(fan1_input);
1540static DEVICE_ATTR_RO(fan1_label);
1541
1542/* Temperature */
1543static DEVICE_ATTR(temp1_input, S_IRUGO, asus_hwmon_temp1, NULL);
1544
1545static 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
1555static 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
1589static 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
1595static 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
1610static 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
1630static 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
1655static 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
1680static 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
1701static 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
1709static 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
1741static DEVICE_ATTR_RW(fan_boost_mode);
1742
1743/* Throttle thermal policy ****************************************************/
1744
1745static 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
1767static 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
1791static 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
1800static 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
1811static 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
1820static 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
1842static DEVICE_ATTR_RW(throttle_thermal_policy);
1843
1844/* Backlight ******************************************************************/
1845
1846static 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
1862static 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
1880static 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
1893static 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
1910static 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
1941static const struct backlight_ops asus_wmi_bl_ops = {
1942        .get_brightness = read_brightness,
1943        .update_status = update_bl_status,
1944};
1945
1946static 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
1964static 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
2006static 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
2013static 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
2027static 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
2037static 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
2046static 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
2071static 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
2149static 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
2178static 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
2200static 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
2221static 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
2256ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
2257ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
2258ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
2259ASUS_WMI_CREATE_DEVICE_ATTR(lid_resume, 0644, ASUS_WMI_DEVID_LID_RESUME);
2260ASUS_WMI_CREATE_DEVICE_ATTR(als_enable, 0644, ASUS_WMI_DEVID_ALS_ENABLE);
2261
2262static 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
2281static DEVICE_ATTR_WO(cpufv);
2282
2283static 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
2295static 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
2324static const struct attribute_group platform_attribute_group = {
2325        .is_visible = asus_sysfs_is_visible,
2326        .attrs = platform_attributes
2327};
2328
2329static void asus_wmi_sysfs_exit(struct platform_device *device)
2330{
2331        sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
2332}
2333
2334static 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
2341static 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
2421struct asus_wmi_debugfs_node {
2422        struct asus_wmi *asus;
2423        char *name;
2424        int (*show) (struct seq_file *m, void *data);
2425};
2426
2427static 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
2442static 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
2459static 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
2493static 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
2499static 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
2506static 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
2514static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
2515{
2516        debugfs_remove_recursive(asus->debug.root);
2517}
2518
2519static 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
2546static 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
2654fail_wmi_handler:
2655        asus_wmi_backlight_exit(asus);
2656fail_backlight:
2657        asus_wmi_rfkill_exit(asus);
2658fail_rfkill:
2659        asus_wmi_led_exit(asus);
2660fail_leds:
2661fail_hwmon:
2662        asus_wmi_input_exit(asus);
2663fail_input:
2664        asus_wmi_sysfs_exit(asus->platform_device);
2665fail_sysfs:
2666fail_throttle_thermal_policy:
2667fail_fan_boost_mode:
2668fail_platform:
2669        kfree(asus);
2670        return err;
2671}
2672
2673static 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
2694static 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
2713static 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
2725static 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
2763static 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
2771static 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
2796static bool used;
2797
2798int __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}
2821EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
2822
2823void 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}
2829EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
2830
2831static int __init asus_wmi_init(void)
2832{
2833        pr_info("ASUS WMI generic driver loaded\n");
2834        return 0;
2835}
2836
2837static void __exit asus_wmi_exit(void)
2838{
2839        pr_info("ASUS WMI generic driver unloaded\n");
2840}
2841
2842module_init(asus_wmi_init);
2843module_exit(asus_wmi_exit);
2844