drivers/platform/x86/asus-wmi.c

   1 /*
   2  * Asus PC WMI hotkey driver
   3  *
   4  * Copyright(C) 2010 Intel Corporation.
   5  * Copyright(C) 2010-2011 Corentin Chary <corentin.chary@gmail.com>
   6  *
   7  * Portions based on wistron_btns.c:
   8  * Copyright (C) 2005 Miloslav Trmac <mitr@volny.cz>
   9  * Copyright (C) 2005 Bernhard Rosenkraenzer <bero@arklinux.org>
  10  * Copyright (C) 2005 Dmitry Torokhov <dtor@mail.ru>
  11  *
  12  *  This program is free software; you can redistribute it and/or modify
  13  *  it under the terms of the GNU General Public License as published by
  14  *  the Free Software Foundation; either version 2 of the License, or
  15  *  (at your option) any later version.
  16  *
  17  *  This program is distributed in the hope that it will be useful,
  18  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20  *  GNU General Public License for more details.
  21  *
  22  *  You should have received a copy of the GNU General Public License
  23  *  along with this program; if not, write to the Free Software
  24  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  25  */
  26
  27 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  28
  29 #include <linux/kernel.h>
  30 #include <linux/module.h>
  31 #include <linux/init.h>
  32 #include <linux/types.h>
  33 #include <linux/slab.h>
  34 #include <linux/input.h>
  35 #include <linux/input/sparse-keymap.h>
  36 #include <linux/fb.h>
  37 #include <linux/backlight.h>
  38 #include <linux/leds.h>
  39 #include <linux/rfkill.h>
  40 #include <linux/pci.h>
  41 #include <linux/pci_hotplug.h>
  42 #include <linux/hwmon.h>
  43 #include <linux/hwmon-sysfs.h>
  44 #include <linux/debugfs.h>
  45 #include <linux/seq_file.h>
  46 #include <linux/platform_device.h>
  47 #include <acpi/acpi_bus.h>
  48 #include <acpi/acpi_drivers.h>
  49
  50 #include "asus-wmi.h"
  51
  52 MODULE_AUTHOR("Corentin Chary <corentincj@iksaif.net>, "
  53               "Yong Wang <yong.y.wang@intel.com>");
  54 MODULE_DESCRIPTION("Asus Generic WMI Driver");
  55 MODULE_LICENSE("GPL");
  56
  57 #define to_platform_driver(drv)                                 \
  58         (container_of((drv), struct platform_driver, driver))
  59
  60 #define to_asus_wmi_driver(pdrv)                                        \
  61         (container_of((pdrv), struct asus_wmi_driver, platform_driver))
  62
  63 #define ASUS_WMI_MGMT_GUID      "97845ED0-4E6D-11DE-8A39-0800200C9A66"
  64
  65 #define NOTIFY_BRNUP_MIN                0x11
  66 #define NOTIFY_BRNUP_MAX                0x1f
  67 #define NOTIFY_BRNDOWN_MIN              0x20
  68 #define NOTIFY_BRNDOWN_MAX              0x2e
  69
  70 /* WMI Methods */
  71 #define ASUS_WMI_METHODID_SPEC          0x43455053 /* BIOS SPECification */
  72 #define ASUS_WMI_METHODID_SFBD          0x44424653 /* Set First Boot Device */
  73 #define ASUS_WMI_METHODID_GLCD          0x44434C47 /* Get LCD status */
  74 #define ASUS_WMI_METHODID_GPID          0x44495047 /* Get Panel ID?? (Resol) */
  75 #define ASUS_WMI_METHODID_QMOD          0x444F4D51 /* Quiet MODe */
  76 #define ASUS_WMI_METHODID_SPLV          0x4C425053 /* Set Panel Light Value */
  77 #define ASUS_WMI_METHODID_SFUN          0x4E554653 /* FUNCtionalities */
  78 #define ASUS_WMI_METHODID_SDSP          0x50534453 /* Set DiSPlay output */
  79 #define ASUS_WMI_METHODID_GDSP          0x50534447 /* Get DiSPlay output */
  80 #define ASUS_WMI_METHODID_DEVP          0x50564544 /* DEVice Policy */
  81 #define ASUS_WMI_METHODID_OSVR          0x5256534F /* OS VeRsion */
  82 #define ASUS_WMI_METHODID_DSTS          0x53544344 /* Device STatuS */
  83 #define ASUS_WMI_METHODID_DSTS2         0x53545344 /* Device STatuS #2*/
  84 #define ASUS_WMI_METHODID_BSTS          0x53545342 /* Bios STatuS ? */
  85 #define ASUS_WMI_METHODID_DEVS          0x53564544 /* DEVice Set */
  86 #define ASUS_WMI_METHODID_CFVS          0x53564643 /* CPU Frequency Volt Set */
  87 #define ASUS_WMI_METHODID_KBFT          0x5446424B /* KeyBoard FilTer */
  88 #define ASUS_WMI_METHODID_INIT          0x54494E49 /* INITialize */
  89 #define ASUS_WMI_METHODID_HKEY          0x59454B48 /* Hot KEY ?? */
  90
  91 #define ASUS_WMI_UNSUPPORTED_METHOD     0xFFFFFFFE
  92
  93 /* Wireless */
  94 #define ASUS_WMI_DEVID_HW_SWITCH        0x00010001
  95 #define ASUS_WMI_DEVID_WIRELESS_LED     0x00010002
  96 #define ASUS_WMI_DEVID_WLAN             0x00010011
  97 #define ASUS_WMI_DEVID_BLUETOOTH        0x00010013
  98 #define ASUS_WMI_DEVID_GPS              0x00010015
  99 #define ASUS_WMI_DEVID_WIMAX            0x00010017
 100 #define ASUS_WMI_DEVID_WWAN3G           0x00010019
 101 #define ASUS_WMI_DEVID_UWB              0x00010021
 102
 103 /* Leds */
 104 /* 0x000200XX and 0x000400XX */
 105
 106 /* Backlight and Brightness */
 107 #define ASUS_WMI_DEVID_BACKLIGHT        0x00050011
 108 #define ASUS_WMI_DEVID_BRIGHTNESS       0x00050012
 109 #define ASUS_WMI_DEVID_KBD_BACKLIGHT    0x00050021
 110 #define ASUS_WMI_DEVID_LIGHT_SENSOR     0x00050022 /* ?? */
 111
 112 /* Misc */
 113 #define ASUS_WMI_DEVID_CAMERA           0x00060013
 114
 115 /* Storage */
 116 #define ASUS_WMI_DEVID_CARDREADER       0x00080013
 117
 118 /* Input */
 119 #define ASUS_WMI_DEVID_TOUCHPAD         0x00100011
 120 #define ASUS_WMI_DEVID_TOUCHPAD_LED     0x00100012
 121
 122 /* Fan, Thermal */
 123 #define ASUS_WMI_DEVID_THERMAL_CTRL     0x00110011
 124 #define ASUS_WMI_DEVID_FAN_CTRL         0x00110012
 125
 126 /* Power */
 127 #define ASUS_WMI_DEVID_PROCESSOR_STATE  0x00120012
 128
 129 /* DSTS masks */
 130 #define ASUS_WMI_DSTS_STATUS_BIT        0x00000001
 131 #define ASUS_WMI_DSTS_UNKNOWN_BIT       0x00000002
 132 #define ASUS_WMI_DSTS_PRESENCE_BIT      0x00010000
 133 #define ASUS_WMI_DSTS_USER_BIT          0x00020000
 134 #define ASUS_WMI_DSTS_BIOS_BIT          0x00040000
 135 #define ASUS_WMI_DSTS_BRIGHTNESS_MASK   0x000000FF
 136 #define ASUS_WMI_DSTS_MAX_BRIGTH_MASK   0x0000FF00
 137
 138 struct bios_args {
 139         u32 arg0;
 140         u32 arg1;
 141 } __packed;
 142
 143 /*
 144  * <platform>/    - debugfs root directory
 145  *   dev_id      - current dev_id
 146  *   ctrl_param  - current ctrl_param
 147  *   method_id   - current method_id
 148  *   devs        - call DEVS(dev_id, ctrl_param) and print result
 149  *   dsts        - call DSTS(dev_id)  and print result
 150  *   call        - call method_id(dev_id, ctrl_param) and print result
 151  */
 152 struct asus_wmi_debug {
 153         struct dentry *root;
 154         u32 method_id;
 155         u32 dev_id;
 156         u32 ctrl_param;
 157 };
 158
 159 struct asus_rfkill {
 160         struct asus_wmi *asus;
 161         struct rfkill *rfkill;
 162         u32 dev_id;
 163 };
 164
 165 struct asus_wmi {
 166         int dsts_id;
 167         int spec;
 168         int sfun;
 169
 170         struct input_dev *inputdev;
 171         struct backlight_device *backlight_device;
 172         struct device *hwmon_device;
 173         struct platform_device *platform_device;
 174
 175         struct led_classdev tpd_led;
 176         int tpd_led_wk;
 177         struct workqueue_struct *led_workqueue;
 178         struct work_struct tpd_led_work;
 179
 180         struct asus_rfkill wlan;
 181         struct asus_rfkill bluetooth;
 182         struct asus_rfkill wimax;
 183         struct asus_rfkill wwan3g;
 184
 185         struct hotplug_slot *hotplug_slot;
 186         struct mutex hotplug_lock;
 187         struct mutex wmi_lock;
 188         struct workqueue_struct *hotplug_workqueue;
 189         struct work_struct hotplug_work;
 190
 191         struct asus_wmi_debug debug;
 192
 193         struct asus_wmi_driver *driver;
 194 };
 195
 196 static int asus_wmi_input_init(struct asus_wmi *asus)
 197 {
 198         int err;
 199
 200         asus->inputdev = input_allocate_device();
 201         if (!asus->inputdev)
 202                 return -ENOMEM;
 203
 204         asus->inputdev->name = asus->driver->input_name;
 205         asus->inputdev->phys = asus->driver->input_phys;
 206         asus->inputdev->id.bustype = BUS_HOST;
 207         asus->inputdev->dev.parent = &asus->platform_device->dev;
 208
 209         err = sparse_keymap_setup(asus->inputdev, asus->driver->keymap, NULL);
 210         if (err)
 211                 goto err_free_dev;
 212
 213         err = input_register_device(asus->inputdev);
 214         if (err)
 215                 goto err_free_keymap;
 216
 217         return 0;
 218
 219 err_free_keymap:
 220         sparse_keymap_free(asus->inputdev);
 221 err_free_dev:
 222         input_free_device(asus->inputdev);
 223         return err;
 224 }
 225
 226 static void asus_wmi_input_exit(struct asus_wmi *asus)
 227 {
 228         if (asus->inputdev) {
 229                 sparse_keymap_free(asus->inputdev);
 230                 input_unregister_device(asus->inputdev);
 231         }
 232
 233         asus->inputdev = NULL;
 234 }
 235
 236 static int asus_wmi_evaluate_method(u32 method_id, u32 arg0, u32 arg1,
 237                                     u32 *retval)
 238 {
 239         struct bios_args args = {
 240                 .arg0 = arg0,
 241                 .arg1 = arg1,
 242         };
 243         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
 244         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
 245         acpi_status status;
 246         union acpi_object *obj;
 247         u32 tmp;
 248
 249         status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID, 1, method_id,
 250                                      &input, &output);
 251
 252         if (ACPI_FAILURE(status))
 253                 goto exit;
 254
 255         obj = (union acpi_object *)output.pointer;
 256         if (obj && obj->type == ACPI_TYPE_INTEGER)
 257                 tmp = (u32) obj->integer.value;
 258         else
 259                 tmp = 0;
 260
 261         if (retval)
 262                 *retval = tmp;
 263
 264         kfree(obj);
 265
 266 exit:
 267         if (ACPI_FAILURE(status))
 268                 return -EIO;
 269
 270         if (tmp == ASUS_WMI_UNSUPPORTED_METHOD)
 271                 return -ENODEV;
 272
 273         return 0;
 274 }
 275
 276 static int asus_wmi_get_devstate(struct asus_wmi *asus, u32 dev_id, u32 *retval)
 277 {
 278         return asus_wmi_evaluate_method(asus->dsts_id, dev_id, 0, retval);
 279 }
 280
 281 static int asus_wmi_set_devstate(u32 dev_id, u32 ctrl_param,
 282                                  u32 *retval)
 283 {
 284         return asus_wmi_evaluate_method(ASUS_WMI_METHODID_DEVS, dev_id,
 285                                         ctrl_param, retval);
 286 }
 287
 288 /* Helper for special devices with magic return codes */
 289 static int asus_wmi_get_devstate_bits(struct asus_wmi *asus,
 290                                       u32 dev_id, u32 mask)
 291 {
 292         u32 retval = 0;
 293         int err;
 294
 295         err = asus_wmi_get_devstate(asus, dev_id, &retval);
 296
 297         if (err < 0)
 298                 return err;
 299
 300         if (!(retval & ASUS_WMI_DSTS_PRESENCE_BIT))
 301                 return -ENODEV;
 302
 303         if (mask == ASUS_WMI_DSTS_STATUS_BIT) {
 304                 if (retval & ASUS_WMI_DSTS_UNKNOWN_BIT)
 305                         return -ENODEV;
 306         }
 307
 308         return retval & mask;
 309 }
 310
 311 static int asus_wmi_get_devstate_simple(struct asus_wmi *asus, u32 dev_id)
 312 {
 313         return asus_wmi_get_devstate_bits(asus, dev_id,
 314                                           ASUS_WMI_DSTS_STATUS_BIT);
 315 }
 316
 317 /*
 318  * LEDs
 319  */
 320 /*
 321  * These functions actually update the LED's, and are called from a
 322  * workqueue. By doing this as separate work rather than when the LED
 323  * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 324  * potentially bad time, such as a timer interrupt.
 325  */
 326 static void tpd_led_update(struct work_struct *work)
 327 {
 328         int ctrl_param;
 329         struct asus_wmi *asus;
 330
 331         asus = container_of(work, struct asus_wmi, tpd_led_work);
 332
 333         ctrl_param = asus->tpd_led_wk;
 334         asus_wmi_set_devstate(ASUS_WMI_DEVID_TOUCHPAD_LED, ctrl_param, NULL);
 335 }
 336
 337 static void tpd_led_set(struct led_classdev *led_cdev,
 338                         enum led_brightness value)
 339 {
 340         struct asus_wmi *asus;
 341
 342         asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 343
 344         asus->tpd_led_wk = !!value;
 345         queue_work(asus->led_workqueue, &asus->tpd_led_work);
 346 }
 347
 348 static int read_tpd_led_state(struct asus_wmi *asus)
 349 {
 350         return asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_TOUCHPAD_LED);
 351 }
 352
 353 static enum led_brightness tpd_led_get(struct led_classdev *led_cdev)
 354 {
 355         struct asus_wmi *asus;
 356
 357         asus = container_of(led_cdev, struct asus_wmi, tpd_led);
 358
 359         return read_tpd_led_state(asus);
 360 }
 361
 362 static int asus_wmi_led_init(struct asus_wmi *asus)
 363 {
 364         int rv;
 365
 366         if (read_tpd_led_state(asus) < 0)
 367                 return 0;
 368
 369         asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
 370         if (!asus->led_workqueue)
 371                 return -ENOMEM;
 372         INIT_WORK(&asus->tpd_led_work, tpd_led_update);
 373
 374         asus->tpd_led.name = "asus::touchpad";
 375         asus->tpd_led.brightness_set = tpd_led_set;
 376         asus->tpd_led.brightness_get = tpd_led_get;
 377         asus->tpd_led.max_brightness = 1;
 378
 379         rv = led_classdev_register(&asus->platform_device->dev, &asus->tpd_led);
 380         if (rv) {
 381                 destroy_workqueue(asus->led_workqueue);
 382                 return rv;
 383         }
 384
 385         return 0;
 386 }
 387
 388 static void asus_wmi_led_exit(struct asus_wmi *asus)
 389 {
 390         if (asus->tpd_led.dev)
 391                 led_classdev_unregister(&asus->tpd_led);
 392         if (asus->led_workqueue)
 393                 destroy_workqueue(asus->led_workqueue);
 394 }
 395
 396 /*
 397  * PCI hotplug (for wlan rfkill)
 398  */
 399 static bool asus_wlan_rfkill_blocked(struct asus_wmi *asus)
 400 {
 401         int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 402
 403         if (result < 0)
 404                 return false;
 405         return !result;
 406 }
 407
 408 static void asus_rfkill_hotplug(struct asus_wmi *asus)
 409 {
 410         struct pci_dev *dev;
 411         struct pci_bus *bus;
 412         bool blocked;
 413         bool absent;
 414         u32 l;
 415
 416         mutex_lock(&asus->wmi_lock);
 417         blocked = asus_wlan_rfkill_blocked(asus);
 418         mutex_unlock(&asus->wmi_lock);
 419
 420         mutex_lock(&asus->hotplug_lock);
 421
 422         if (asus->wlan.rfkill)
 423                 rfkill_set_sw_state(asus->wlan.rfkill, blocked);
 424
 425         if (asus->hotplug_slot) {
 426                 bus = pci_find_bus(0, 1);
 427                 if (!bus) {
 428                         pr_warn("Unable to find PCI bus 1?\n");
 429                         goto out_unlock;
 430                 }
 431
 432                 if (pci_bus_read_config_dword(bus, 0, PCI_VENDOR_ID, &l)) {
 433                         pr_err("Unable to read PCI config space?\n");
 434                         goto out_unlock;
 435                 }
 436                 absent = (l == 0xffffffff);
 437
 438                 if (blocked != absent) {
 439                         pr_warn("BIOS says wireless lan is %s, "
 440                                 "but the pci device is %s\n",
 441                                 blocked ? "blocked" : "unblocked",
 442                                 absent ? "absent" : "present");
 443                         pr_warn("skipped wireless hotplug as probably "
 444                                 "inappropriate for this model\n");
 445                         goto out_unlock;
 446                 }
 447
 448                 if (!blocked) {
 449                         dev = pci_get_slot(bus, 0);
 450                         if (dev) {
 451                                 /* Device already present */
 452                                 pci_dev_put(dev);
 453                                 goto out_unlock;
 454                         }
 455                         dev = pci_scan_single_device(bus, 0);
 456                         if (dev) {
 457                                 pci_bus_assign_resources(bus);
 458                                 if (pci_bus_add_device(dev))
 459                                         pr_err("Unable to hotplug wifi\n");
 460                         }
 461                 } else {
 462                         dev = pci_get_slot(bus, 0);
 463                         if (dev) {
 464                                 pci_remove_bus_device(dev);
 465                                 pci_dev_put(dev);
 466                         }
 467                 }
 468         }
 469
 470 out_unlock:
 471         mutex_unlock(&asus->hotplug_lock);
 472 }
 473
 474 static void asus_rfkill_notify(acpi_handle handle, u32 event, void *data)
 475 {
 476         struct asus_wmi *asus = data;
 477
 478         if (event != ACPI_NOTIFY_BUS_CHECK)
 479                 return;
 480
 481         /*
 482          * We can't call directly asus_rfkill_hotplug because most
 483          * of the time WMBC is still being executed and not reetrant.
 484          * There is currently no way to tell ACPICA that  we want this
 485          * method to be serialized, we schedule a asus_rfkill_hotplug
 486          * call later, in a safer context.
 487          */
 488         queue_work(asus->hotplug_workqueue, &asus->hotplug_work);
 489 }
 490
 491 static int asus_register_rfkill_notifier(struct asus_wmi *asus, char *node)
 492 {
 493         acpi_status status;
 494         acpi_handle handle;
 495
 496         status = acpi_get_handle(NULL, node, &handle);
 497
 498         if (ACPI_SUCCESS(status)) {
 499                 status = acpi_install_notify_handler(handle,
 500                                                      ACPI_SYSTEM_NOTIFY,
 501                                                      asus_rfkill_notify, asus);
 502                 if (ACPI_FAILURE(status))
 503                         pr_warn("Failed to register notify on %s\n", node);
 504         } else
 505                 return -ENODEV;
 506
 507         return 0;
 508 }
 509
 510 static void asus_unregister_rfkill_notifier(struct asus_wmi *asus, char *node)
 511 {
 512         acpi_status status = AE_OK;
 513         acpi_handle handle;
 514
 515         status = acpi_get_handle(NULL, node, &handle);
 516
 517         if (ACPI_SUCCESS(status)) {
 518                 status = acpi_remove_notify_handler(handle,
 519                                                     ACPI_SYSTEM_NOTIFY,
 520                                                     asus_rfkill_notify);
 521                 if (ACPI_FAILURE(status))
 522                         pr_err("Error removing rfkill notify handler %s\n",
 523                                node);
 524         }
 525 }
 526
 527 static int asus_get_adapter_status(struct hotplug_slot *hotplug_slot,
 528                                    u8 *value)
 529 {
 530         struct asus_wmi *asus = hotplug_slot->private;
 531         int result = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
 532
 533         if (result < 0)
 534                 return result;
 535
 536         *value = !!result;
 537         return 0;
 538 }
 539
 540 static void asus_cleanup_pci_hotplug(struct hotplug_slot *hotplug_slot)
 541 {
 542         kfree(hotplug_slot->info);
 543         kfree(hotplug_slot);
 544 }
 545
 546 static struct hotplug_slot_ops asus_hotplug_slot_ops = {
 547         .owner = THIS_MODULE,
 548         .get_adapter_status = asus_get_adapter_status,
 549         .get_power_status = asus_get_adapter_status,
 550 };
 551
 552 static void asus_hotplug_work(struct work_struct *work)
 553 {
 554         struct asus_wmi *asus;
 555
 556         asus = container_of(work, struct asus_wmi, hotplug_work);
 557         asus_rfkill_hotplug(asus);
 558 }
 559
 560 static int asus_setup_pci_hotplug(struct asus_wmi *asus)
 561 {
 562         int ret = -ENOMEM;
 563         struct pci_bus *bus = pci_find_bus(0, 1);
 564
 565         if (!bus) {
 566                 pr_err("Unable to find wifi PCI bus\n");
 567                 return -ENODEV;
 568         }
 569
 570         asus->hotplug_workqueue =
 571             create_singlethread_workqueue("hotplug_workqueue");
 572         if (!asus->hotplug_workqueue)
 573                 goto error_workqueue;
 574
 575         INIT_WORK(&asus->hotplug_work, asus_hotplug_work);
 576
 577         asus->hotplug_slot = kzalloc(sizeof(struct hotplug_slot), GFP_KERNEL);
 578         if (!asus->hotplug_slot)
 579                 goto error_slot;
 580
 581         asus->hotplug_slot->info = kzalloc(sizeof(struct hotplug_slot_info),
 582                                            GFP_KERNEL);
 583         if (!asus->hotplug_slot->info)
 584                 goto error_info;
 585
 586         asus->hotplug_slot->private = asus;
 587         asus->hotplug_slot->release = &asus_cleanup_pci_hotplug;
 588         asus->hotplug_slot->ops = &asus_hotplug_slot_ops;
 589         asus_get_adapter_status(asus->hotplug_slot,
 590                                 &asus->hotplug_slot->info->adapter_status);
 591
 592         ret = pci_hp_register(asus->hotplug_slot, bus, 0, "asus-wifi");
 593         if (ret) {
 594                 pr_err("Unable to register hotplug slot - %d\n", ret);
 595                 goto error_register;
 596         }
 597
 598         return 0;
 599
 600 error_register:
 601         kfree(asus->hotplug_slot->info);
 602 error_info:
 603         kfree(asus->hotplug_slot);
 604         asus->hotplug_slot = NULL;
 605 error_slot:
 606         destroy_workqueue(asus->hotplug_workqueue);
 607 error_workqueue:
 608         return ret;
 609 }
 610
 611 /*
 612  * Rfkill devices
 613  */
 614 static int asus_rfkill_set(void *data, bool blocked)
 615 {
 616         struct asus_rfkill *priv = data;
 617         u32 ctrl_param = !blocked;
 618
 619         return asus_wmi_set_devstate(priv->dev_id, ctrl_param, NULL);
 620 }
 621
 622 static void asus_rfkill_query(struct rfkill *rfkill, void *data)
 623 {
 624         struct asus_rfkill *priv = data;
 625         int result;
 626
 627         result = asus_wmi_get_devstate_simple(priv->asus, priv->dev_id);
 628
 629         if (result < 0)
 630                 return;
 631
 632         rfkill_set_sw_state(priv->rfkill, !result);
 633 }
 634
 635 static int asus_rfkill_wlan_set(void *data, bool blocked)
 636 {
 637         struct asus_rfkill *priv = data;
 638         struct asus_wmi *asus = priv->asus;
 639         int ret;
 640
 641         /*
 642          * This handler is enabled only if hotplug is enabled.
 643          * In this case, the asus_wmi_set_devstate() will
 644          * trigger a wmi notification and we need to wait
 645          * this call to finish before being able to call
 646          * any wmi method
 647          */
 648         mutex_lock(&asus->wmi_lock);
 649         ret = asus_rfkill_set(data, blocked);
 650         mutex_unlock(&asus->wmi_lock);
 651         return ret;
 652 }
 653
 654 static const struct rfkill_ops asus_rfkill_wlan_ops = {
 655         .set_block = asus_rfkill_wlan_set,
 656         .query = asus_rfkill_query,
 657 };
 658
 659 static const struct rfkill_ops asus_rfkill_ops = {
 660         .set_block = asus_rfkill_set,
 661         .query = asus_rfkill_query,
 662 };
 663
 664 static int asus_new_rfkill(struct asus_wmi *asus,
 665                            struct asus_rfkill *arfkill,
 666                            const char *name, enum rfkill_type type, int dev_id)
 667 {
 668         int result = asus_wmi_get_devstate_simple(asus, dev_id);
 669         struct rfkill **rfkill = &arfkill->rfkill;
 670
 671         if (result < 0)
 672                 return result;
 673
 674         arfkill->dev_id = dev_id;
 675         arfkill->asus = asus;
 676
 677         if (dev_id == ASUS_WMI_DEVID_WLAN && asus->driver->hotplug_wireless)
 678                 *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
 679                                        &asus_rfkill_wlan_ops, arfkill);
 680         else
 681                 *rfkill = rfkill_alloc(name, &asus->platform_device->dev, type,
 682                                        &asus_rfkill_ops, arfkill);
 683
 684         if (!*rfkill)
 685                 return -EINVAL;
 686
 687         rfkill_init_sw_state(*rfkill, !result);
 688         result = rfkill_register(*rfkill);
 689         if (result) {
 690                 rfkill_destroy(*rfkill);
 691                 *rfkill = NULL;
 692                 return result;
 693         }
 694         return 0;
 695 }
 696
 697 static void asus_wmi_rfkill_exit(struct asus_wmi *asus)
 698 {
 699         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
 700         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
 701         asus_unregister_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
 702         if (asus->wlan.rfkill) {
 703                 rfkill_unregister(asus->wlan.rfkill);
 704                 rfkill_destroy(asus->wlan.rfkill);
 705                 asus->wlan.rfkill = NULL;
 706         }
 707         /*
 708          * Refresh pci hotplug in case the rfkill state was changed after
 709          * asus_unregister_rfkill_notifier()
 710          */
 711         asus_rfkill_hotplug(asus);
 712         if (asus->hotplug_slot)
 713                 pci_hp_deregister(asus->hotplug_slot);
 714         if (asus->hotplug_workqueue)
 715                 destroy_workqueue(asus->hotplug_workqueue);
 716
 717         if (asus->bluetooth.rfkill) {
 718                 rfkill_unregister(asus->bluetooth.rfkill);
 719                 rfkill_destroy(asus->bluetooth.rfkill);
 720                 asus->bluetooth.rfkill = NULL;
 721         }
 722         if (asus->wimax.rfkill) {
 723                 rfkill_unregister(asus->wimax.rfkill);
 724                 rfkill_destroy(asus->wimax.rfkill);
 725                 asus->wimax.rfkill = NULL;
 726         }
 727         if (asus->wwan3g.rfkill) {
 728                 rfkill_unregister(asus->wwan3g.rfkill);
 729                 rfkill_destroy(asus->wwan3g.rfkill);
 730                 asus->wwan3g.rfkill = NULL;
 731         }
 732 }
 733
 734 static int asus_wmi_rfkill_init(struct asus_wmi *asus)
 735 {
 736         int result = 0;
 737
 738         mutex_init(&asus->hotplug_lock);
 739         mutex_init(&asus->wmi_lock);
 740
 741         result = asus_new_rfkill(asus, &asus->wlan, "asus-wlan",
 742                                  RFKILL_TYPE_WLAN, ASUS_WMI_DEVID_WLAN);
 743
 744         if (result && result != -ENODEV)
 745                 goto exit;
 746
 747         result = asus_new_rfkill(asus, &asus->bluetooth,
 748                                  "asus-bluetooth", RFKILL_TYPE_BLUETOOTH,
 749                                  ASUS_WMI_DEVID_BLUETOOTH);
 750
 751         if (result && result != -ENODEV)
 752                 goto exit;
 753
 754         result = asus_new_rfkill(asus, &asus->wimax, "asus-wimax",
 755                                  RFKILL_TYPE_WIMAX, ASUS_WMI_DEVID_WIMAX);
 756
 757         if (result && result != -ENODEV)
 758                 goto exit;
 759
 760         result = asus_new_rfkill(asus, &asus->wwan3g, "asus-wwan3g",
 761                                  RFKILL_TYPE_WWAN, ASUS_WMI_DEVID_WWAN3G);
 762
 763         if (result && result != -ENODEV)
 764                 goto exit;
 765
 766         if (!asus->driver->hotplug_wireless)
 767                 goto exit;
 768
 769         result = asus_setup_pci_hotplug(asus);
 770         /*
 771          * If we get -EBUSY then something else is handling the PCI hotplug -
 772          * don't fail in this case
 773          */
 774         if (result == -EBUSY)
 775                 result = 0;
 776
 777         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P5");
 778         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P6");
 779         asus_register_rfkill_notifier(asus, "\\_SB.PCI0.P0P7");
 780         /*
 781          * Refresh pci hotplug in case the rfkill state was changed during
 782          * setup.
 783          */
 784         asus_rfkill_hotplug(asus);
 785
 786 exit:
 787         if (result && result != -ENODEV)
 788                 asus_wmi_rfkill_exit(asus);
 789
 790         if (result == -ENODEV)
 791                 result = 0;
 792
 793         return result;
 794 }
 795
 796 /*
 797  * Hwmon device
 798  */
 799 static ssize_t asus_hwmon_pwm1(struct device *dev,
 800                                struct device_attribute *attr,
 801                                char *buf)
 802 {
 803         struct asus_wmi *asus = dev_get_drvdata(dev);
 804         u32 value;
 805         int err;
 806
 807         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_FAN_CTRL, &value);
 808
 809         if (err < 0)
 810                 return err;
 811
 812         value &= 0xFF;
 813
 814         if (value == 1) /* Low Speed */
 815                 value = 85;
 816         else if (value == 2)
 817                 value = 170;
 818         else if (value == 3)
 819                 value = 255;
 820         else if (value != 0) {
 821                 pr_err("Unknown fan speed %#x", value);
 822                 value = -1;
 823         }
 824
 825         return sprintf(buf, "%d\n", value);
 826 }
 827
 828 static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO, asus_hwmon_pwm1, NULL, 0);
 829
 830 static ssize_t
 831 show_name(struct device *dev, struct device_attribute *attr, char *buf)
 832 {
 833         return sprintf(buf, "asus\n");
 834 }
 835 static SENSOR_DEVICE_ATTR(name, S_IRUGO, show_name, NULL, 0);
 836
 837 static struct attribute *hwmon_attributes[] = {
 838         &sensor_dev_attr_pwm1.dev_attr.attr,
 839         &sensor_dev_attr_name.dev_attr.attr,
 840         NULL
 841 };
 842
 843 static mode_t asus_hwmon_sysfs_is_visible(struct kobject *kobj,
 844                                     struct attribute *attr, int idx)
 845 {
 846         struct device *dev = container_of(kobj, struct device, kobj);
 847         struct platform_device *pdev = to_platform_device(dev->parent);
 848         struct asus_wmi *asus = platform_get_drvdata(pdev);
 849         bool ok = true;
 850         int dev_id = -1;
 851         u32 value = ASUS_WMI_UNSUPPORTED_METHOD;
 852
 853         if (attr == &sensor_dev_attr_pwm1.dev_attr.attr)
 854                 dev_id = ASUS_WMI_DEVID_FAN_CTRL;
 855
 856         if (dev_id != -1) {
 857                 int err = asus_wmi_get_devstate(asus, dev_id, &value);
 858
 859                 if (err < 0)
 860                         return err;
 861         }
 862
 863         if (dev_id == ASUS_WMI_DEVID_FAN_CTRL) {
 864                 /*
 865                  * We need to find a better way, probably using sfun,
 866                  * bits or spec ...
 867                  * Currently we disable it if:
 868                  * - ASUS_WMI_UNSUPPORTED_METHOD is returned
 869                  * - reverved bits are non-zero
 870                  * - sfun and presence bit are not set
 871                  */
 872                 if (value == ASUS_WMI_UNSUPPORTED_METHOD || value & 0xFFF80000
 873                     || (!asus->sfun && !(value & ASUS_WMI_DSTS_PRESENCE_BIT)))
 874                         ok = false;
 875         }
 876
 877         return ok ? attr->mode : 0;
 878 }
 879
 880 static struct attribute_group hwmon_attribute_group = {
 881         .is_visible = asus_hwmon_sysfs_is_visible,
 882         .attrs = hwmon_attributes
 883 };
 884
 885 static void asus_wmi_hwmon_exit(struct asus_wmi *asus)
 886 {
 887         struct device *hwmon;
 888
 889         hwmon = asus->hwmon_device;
 890         if (!hwmon)
 891                 return;
 892         sysfs_remove_group(&hwmon->kobj, &hwmon_attribute_group);
 893         hwmon_device_unregister(hwmon);
 894         asus->hwmon_device = NULL;
 895 }
 896
 897 static int asus_wmi_hwmon_init(struct asus_wmi *asus)
 898 {
 899         struct device *hwmon;
 900         int result;
 901
 902         hwmon = hwmon_device_register(&asus->platform_device->dev);
 903         if (IS_ERR(hwmon)) {
 904                 pr_err("Could not register asus hwmon device\n");
 905                 return PTR_ERR(hwmon);
 906         }
 907         dev_set_drvdata(hwmon, asus);
 908         asus->hwmon_device = hwmon;
 909         result = sysfs_create_group(&hwmon->kobj, &hwmon_attribute_group);
 910         if (result)
 911                 asus_wmi_hwmon_exit(asus);
 912         return result;
 913 }
 914
 915 /*
 916  * Backlight
 917  */
 918 static int read_backlight_power(struct asus_wmi *asus)
 919 {
 920         int ret = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_BACKLIGHT);
 921
 922         if (ret < 0)
 923                 return ret;
 924
 925         return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
 926 }
 927
 928 static int read_brightness_max(struct asus_wmi *asus)
 929 {
 930         u32 retval;
 931         int err;
 932
 933         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
 934
 935         if (err < 0)
 936                 return err;
 937
 938         retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
 939         retval >>= 8;
 940
 941         if (!retval)
 942                 return -ENODEV;
 943
 944         return retval;
 945 }
 946
 947 static int read_brightness(struct backlight_device *bd)
 948 {
 949         struct asus_wmi *asus = bl_get_data(bd);
 950         u32 retval;
 951         int err;
 952
 953         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
 954
 955         if (err < 0)
 956                 return err;
 957
 958         return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
 959 }
 960
 961 static int update_bl_status(struct backlight_device *bd)
 962 {
 963         struct asus_wmi *asus = bl_get_data(bd);
 964         u32 ctrl_param;
 965         int power, err;
 966
 967         ctrl_param = bd->props.brightness;
 968
 969         err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
 970                                     ctrl_param, NULL);
 971
 972         if (err < 0)
 973                 return err;
 974
 975         power = read_backlight_power(asus);
 976         if (power != -ENODEV && bd->props.power != power) {
 977                 ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
 978                 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
 979                                             ctrl_param, NULL);
 980         }
 981         return err;
 982 }
 983
 984 static const struct backlight_ops asus_wmi_bl_ops = {
 985         .get_brightness = read_brightness,
 986         .update_status = update_bl_status,
 987 };
 988
 989 static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
 990 {
 991         struct backlight_device *bd = asus->backlight_device;
 992         int old = bd->props.brightness;
 993         int new = old;
 994
 995         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
 996                 new = code - NOTIFY_BRNUP_MIN + 1;
 997         else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
 998                 new = code - NOTIFY_BRNDOWN_MIN;
 999
1000         bd->props.brightness = new;
1001         backlight_update_status(bd);
1002         backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1003
1004         return old;
1005 }
1006
1007 static int asus_wmi_backlight_init(struct asus_wmi *asus)
1008 {
1009         struct backlight_device *bd;
1010         struct backlight_properties props;
1011         int max;
1012         int power;
1013
1014         max = read_brightness_max(asus);
1015
1016         if (max == -ENODEV)
1017                 max = 0;
1018         else if (max < 0)
1019                 return max;
1020
1021         power = read_backlight_power(asus);
1022
1023         if (power == -ENODEV)
1024                 power = FB_BLANK_UNBLANK;
1025         else if (power < 0)
1026                 return power;
1027
1028         memset(&props, 0, sizeof(struct backlight_properties));
1029         props.type = BACKLIGHT_PLATFORM;
1030         props.max_brightness = max;
1031         bd = backlight_device_register(asus->driver->name,
1032                                        &asus->platform_device->dev, asus,
1033                                        &asus_wmi_bl_ops, &props);
1034         if (IS_ERR(bd)) {
1035                 pr_err("Could not register backlight device\n");
1036                 return PTR_ERR(bd);
1037         }
1038
1039         asus->backlight_device = bd;
1040
1041         bd->props.brightness = read_brightness(bd);
1042         bd->props.power = power;
1043         backlight_update_status(bd);
1044
1045         return 0;
1046 }
1047
1048 static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1049 {
1050         if (asus->backlight_device)
1051                 backlight_device_unregister(asus->backlight_device);
1052
1053         asus->backlight_device = NULL;
1054 }
1055
1056 static void asus_wmi_notify(u32 value, void *context)
1057 {
1058         struct asus_wmi *asus = context;
1059         struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1060         union acpi_object *obj;
1061         acpi_status status;
1062         int code;
1063         int orig_code;
1064
1065         status = wmi_get_event_data(value, &response);
1066         if (status != AE_OK) {
1067                 pr_err("bad event status 0x%x\n", status);
1068                 return;
1069         }
1070
1071         obj = (union acpi_object *)response.pointer;
1072
1073         if (!obj || obj->type != ACPI_TYPE_INTEGER)
1074                 goto exit;
1075
1076         code = obj->integer.value;
1077         orig_code = code;
1078
1079         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1080                 code = NOTIFY_BRNUP_MIN;
1081         else if (code >= NOTIFY_BRNDOWN_MIN &&
1082                  code <= NOTIFY_BRNDOWN_MAX)
1083                 code = NOTIFY_BRNDOWN_MIN;
1084
1085         if (code == NOTIFY_BRNUP_MIN || code == NOTIFY_BRNDOWN_MIN) {
1086                 if (!acpi_video_backlight_support())
1087                         asus_wmi_backlight_notify(asus, orig_code);
1088         } else if (!sparse_keymap_report_event(asus->inputdev, code, 1, true))
1089                 pr_info("Unknown key %x pressed\n", code);
1090
1091 exit:
1092         kfree(obj);
1093 }
1094
1095 /*
1096  * Sys helpers
1097  */
1098 static int parse_arg(const char *buf, unsigned long count, int *val)
1099 {
1100         if (!count)
1101                 return 0;
1102         if (sscanf(buf, "%i", val) != 1)
1103                 return -EINVAL;
1104         return count;
1105 }
1106
1107 static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1108                              const char *buf, size_t count)
1109 {
1110         u32 retval;
1111         int rv, err, value;
1112
1113         value = asus_wmi_get_devstate_simple(asus, devid);
1114         if (value == -ENODEV)   /* Check device presence */
1115                 return value;
1116
1117         rv = parse_arg(buf, count, &value);
1118         err = asus_wmi_set_devstate(devid, value, &retval);
1119
1120         if (err < 0)
1121                 return err;
1122
1123         return rv;
1124 }
1125
1126 static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1127 {
1128         int value = asus_wmi_get_devstate_simple(asus, devid);
1129
1130         if (value < 0)
1131                 return value;
1132
1133         return sprintf(buf, "%d\n", value);
1134 }
1135
1136 #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)                  \
1137         static ssize_t show_##_name(struct device *dev,                 \
1138                                     struct device_attribute *attr,      \
1139                                     char *buf)                          \
1140         {                                                               \
1141                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
1142                                                                         \
1143                 return show_sys_wmi(asus, _cm, buf);                    \
1144         }                                                               \
1145         static ssize_t store_##_name(struct device *dev,                \
1146                                      struct device_attribute *attr,     \
1147                                      const char *buf, size_t count)     \
1148         {                                                               \
1149                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
1150                                                                         \
1151                 return store_sys_wmi(asus, _cm, buf, count);            \
1152         }                                                               \
1153         static struct device_attribute dev_attr_##_name = {             \
1154                 .attr = {                                               \
1155                         .name = __stringify(_name),                     \
1156                         .mode = _mode },                                \
1157                 .show   = show_##_name,                                 \
1158                 .store  = store_##_name,                                \
1159         }
1160
1161 ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1162 ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1163 ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
1164
1165 static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr,
1166                            const char *buf, size_t count)
1167 {
1168         int value, rv;
1169
1170         if (!count || sscanf(buf, "%i", &value) != 1)
1171                 return -EINVAL;
1172         if (value < 0 || value > 2)
1173                 return -EINVAL;
1174
1175         rv = asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1176         if (rv < 0)
1177                 return rv;
1178
1179         return count;
1180 }
1181
1182 static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv);
1183
1184 static struct attribute *platform_attributes[] = {
1185         &dev_attr_cpufv.attr,
1186         &dev_attr_camera.attr,
1187         &dev_attr_cardr.attr,
1188         &dev_attr_touchpad.attr,
1189         NULL
1190 };
1191
1192 static mode_t asus_sysfs_is_visible(struct kobject *kobj,
1193                                     struct attribute *attr, int idx)
1194 {
1195         struct device *dev = container_of(kobj, struct device, kobj);
1196         struct platform_device *pdev = to_platform_device(dev);
1197         struct asus_wmi *asus = platform_get_drvdata(pdev);
1198         bool ok = true;
1199         int devid = -1;
1200
1201         if (attr == &dev_attr_camera.attr)
1202                 devid = ASUS_WMI_DEVID_CAMERA;
1203         else if (attr == &dev_attr_cardr.attr)
1204                 devid = ASUS_WMI_DEVID_CARDREADER;
1205         else if (attr == &dev_attr_touchpad.attr)
1206                 devid = ASUS_WMI_DEVID_TOUCHPAD;
1207
1208         if (devid != -1)
1209                 ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1210
1211         return ok ? attr->mode : 0;
1212 }
1213
1214 static struct attribute_group platform_attribute_group = {
1215         .is_visible = asus_sysfs_is_visible,
1216         .attrs = platform_attributes
1217 };
1218
1219 static void asus_wmi_sysfs_exit(struct platform_device *device)
1220 {
1221         sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1222 }
1223
1224 static int asus_wmi_sysfs_init(struct platform_device *device)
1225 {
1226         return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1227 }
1228
1229 /*
1230  * Platform device
1231  */
1232 static int asus_wmi_platform_init(struct asus_wmi *asus)
1233 {
1234         int rv;
1235
1236         /* INIT enable hotkeys on some models */
1237         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1238                 pr_info("Initialization: %#x", rv);
1239
1240         /* We don't know yet what to do with this version... */
1241         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1242                 pr_info("BIOS WMI version: %d.%d", rv >> 8, rv & 0xFF);
1243                 asus->spec = rv;
1244         }
1245
1246         /*
1247          * The SFUN method probably allows the original driver to get the list
1248          * of features supported by a given model. For now, 0x0100 or 0x0800
1249          * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1250          * The significance of others is yet to be found.
1251          */
1252         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1253                 pr_info("SFUN value: %#x", rv);
1254                 asus->sfun = rv;
1255         }
1256
1257         /*
1258          * Eee PC and Notebooks seems to have different method_id for DSTS,
1259          * but it may also be related to the BIOS's SPEC.
1260          * Note, on most Eeepc, there is no way to check if a method exist
1261          * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1262          * but once again, SPEC may probably be used for that kind of things.
1263          */
1264         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
1265                 asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1266         else if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS2, 0, 0, NULL))
1267                 asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1268
1269         if (!asus->dsts_id) {
1270                 pr_err("Can't find DSTS");
1271                 return -ENODEV;
1272         }
1273
1274         return asus_wmi_sysfs_init(asus->platform_device);
1275 }
1276
1277 static void asus_wmi_platform_exit(struct asus_wmi *asus)
1278 {
1279         asus_wmi_sysfs_exit(asus->platform_device);
1280 }
1281
1282 /*
1283  * debugfs
1284  */
1285 struct asus_wmi_debugfs_node {
1286         struct asus_wmi *asus;
1287         char *name;
1288         int (*show) (struct seq_file *m, void *data);
1289 };
1290
1291 static int show_dsts(struct seq_file *m, void *data)
1292 {
1293         struct asus_wmi *asus = m->private;
1294         int err;
1295         u32 retval = -1;
1296
1297         err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1298
1299         if (err < 0)
1300                 return err;
1301
1302         seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1303
1304         return 0;
1305 }
1306
1307 static int show_devs(struct seq_file *m, void *data)
1308 {
1309         struct asus_wmi *asus = m->private;
1310         int err;
1311         u32 retval = -1;
1312
1313         err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
1314                                     &retval);
1315
1316         if (err < 0)
1317                 return err;
1318
1319         seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1320                    asus->debug.ctrl_param, retval);
1321
1322         return 0;
1323 }
1324
1325 static int show_call(struct seq_file *m, void *data)
1326 {
1327         struct asus_wmi *asus = m->private;
1328         struct bios_args args = {
1329                 .arg0 = asus->debug.dev_id,
1330                 .arg1 = asus->debug.ctrl_param,
1331         };
1332         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1333         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
1334         union acpi_object *obj;
1335         acpi_status status;
1336
1337         status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
1338                                      1, asus->debug.method_id,
1339                                      &input, &output);
1340
1341         if (ACPI_FAILURE(status))
1342                 return -EIO;
1343
1344         obj = (union acpi_object *)output.pointer;
1345         if (obj && obj->type == ACPI_TYPE_INTEGER)
1346                 seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
1347                            asus->debug.dev_id, asus->debug.ctrl_param,
1348                            (u32) obj->integer.value);
1349         else
1350                 seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
1351                            asus->debug.dev_id, asus->debug.ctrl_param,
1352                            obj ? obj->type : -1);
1353
1354         kfree(obj);
1355
1356         return 0;
1357 }
1358
1359 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
1360         {NULL, "devs", show_devs},
1361         {NULL, "dsts", show_dsts},
1362         {NULL, "call", show_call},
1363 };
1364
1365 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
1366 {
1367         struct asus_wmi_debugfs_node *node = inode->i_private;
1368
1369         return single_open(file, node->show, node->asus);
1370 }
1371
1372 static const struct file_operations asus_wmi_debugfs_io_ops = {
1373         .owner = THIS_MODULE,
1374         .open = asus_wmi_debugfs_open,
1375         .read = seq_read,
1376         .llseek = seq_lseek,
1377         .release = single_release,
1378 };
1379
1380 static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
1381 {
1382         debugfs_remove_recursive(asus->debug.root);
1383 }
1384
1385 static int asus_wmi_debugfs_init(struct asus_wmi *asus)
1386 {
1387         struct dentry *dent;
1388         int i;
1389
1390         asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
1391         if (!asus->debug.root) {
1392                 pr_err("failed to create debugfs directory");
1393                 goto error_debugfs;
1394         }
1395
1396         dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
1397                                   asus->debug.root, &asus->debug.method_id);
1398         if (!dent)
1399                 goto error_debugfs;
1400
1401         dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
1402                                   asus->debug.root, &asus->debug.dev_id);
1403         if (!dent)
1404                 goto error_debugfs;
1405
1406         dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
1407                                   asus->debug.root, &asus->debug.ctrl_param);
1408         if (!dent)
1409                 goto error_debugfs;
1410
1411         for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
1412                 struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
1413
1414                 node->asus = asus;
1415                 dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
1416                                            asus->debug.root, node,
1417                                            &asus_wmi_debugfs_io_ops);
1418                 if (!dent) {
1419                         pr_err("failed to create debug file: %s\n", node->name);
1420                         goto error_debugfs;
1421                 }
1422         }
1423
1424         return 0;
1425
1426 error_debugfs:
1427         asus_wmi_debugfs_exit(asus);
1428         return -ENOMEM;
1429 }
1430
1431 /*
1432  * WMI Driver
1433  */
1434 static int asus_wmi_add(struct platform_device *pdev)
1435 {
1436         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1437         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1438         struct asus_wmi *asus;
1439         acpi_status status;
1440         int err;
1441
1442         asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
1443         if (!asus)
1444                 return -ENOMEM;
1445
1446         asus->driver = wdrv;
1447         asus->platform_device = pdev;
1448         wdrv->platform_device = pdev;
1449         platform_set_drvdata(asus->platform_device, asus);
1450
1451         if (wdrv->quirks)
1452                 wdrv->quirks(asus->driver);
1453
1454         err = asus_wmi_platform_init(asus);
1455         if (err)
1456                 goto fail_platform;
1457
1458         err = asus_wmi_input_init(asus);
1459         if (err)
1460                 goto fail_input;
1461
1462         err = asus_wmi_hwmon_init(asus);
1463         if (err)
1464                 goto fail_hwmon;
1465
1466         err = asus_wmi_led_init(asus);
1467         if (err)
1468                 goto fail_leds;
1469
1470         err = asus_wmi_rfkill_init(asus);
1471         if (err)
1472                 goto fail_rfkill;
1473
1474         if (!acpi_video_backlight_support()) {
1475                 err = asus_wmi_backlight_init(asus);
1476                 if (err && err != -ENODEV)
1477                         goto fail_backlight;
1478         } else
1479                 pr_info("Backlight controlled by ACPI video driver\n");
1480
1481         status = wmi_install_notify_handler(asus->driver->event_guid,
1482                                             asus_wmi_notify, asus);
1483         if (ACPI_FAILURE(status)) {
1484                 pr_err("Unable to register notify handler - %d\n", status);
1485                 err = -ENODEV;
1486                 goto fail_wmi_handler;
1487         }
1488
1489         err = asus_wmi_debugfs_init(asus);
1490         if (err)
1491                 goto fail_debugfs;
1492
1493         return 0;
1494
1495 fail_debugfs:
1496         wmi_remove_notify_handler(asus->driver->event_guid);
1497 fail_wmi_handler:
1498         asus_wmi_backlight_exit(asus);
1499 fail_backlight:
1500         asus_wmi_rfkill_exit(asus);
1501 fail_rfkill:
1502         asus_wmi_led_exit(asus);
1503 fail_leds:
1504         asus_wmi_hwmon_exit(asus);
1505 fail_hwmon:
1506         asus_wmi_input_exit(asus);
1507 fail_input:
1508         asus_wmi_platform_exit(asus);
1509 fail_platform:
1510         kfree(asus);
1511         return err;
1512 }
1513
1514 static int asus_wmi_remove(struct platform_device *device)
1515 {
1516         struct asus_wmi *asus;
1517
1518         asus = platform_get_drvdata(device);
1519         wmi_remove_notify_handler(asus->driver->event_guid);
1520         asus_wmi_backlight_exit(asus);
1521         asus_wmi_input_exit(asus);
1522         asus_wmi_hwmon_exit(asus);
1523         asus_wmi_led_exit(asus);
1524         asus_wmi_rfkill_exit(asus);
1525         asus_wmi_debugfs_exit(asus);
1526         asus_wmi_platform_exit(asus);
1527
1528         kfree(asus);
1529         return 0;
1530 }
1531
1532 /*
1533  * Platform driver - hibernate/resume callbacks
1534  */
1535 static int asus_hotk_thaw(struct device *device)
1536 {
1537         struct asus_wmi *asus = dev_get_drvdata(device);
1538
1539         if (asus->wlan.rfkill) {
1540                 bool wlan;
1541
1542                 /*
1543                  * Work around bios bug - acpi _PTS turns off the wireless led
1544                  * during suspend.  Normally it restores it on resume, but
1545                  * we should kick it ourselves in case hibernation is aborted.
1546                  */
1547                 wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
1548                 asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
1549         }
1550
1551         return 0;
1552 }
1553
1554 static int asus_hotk_restore(struct device *device)
1555 {
1556         struct asus_wmi *asus = dev_get_drvdata(device);
1557         int bl;
1558
1559         /* Refresh both wlan rfkill state and pci hotplug */
1560         if (asus->wlan.rfkill)
1561                 asus_rfkill_hotplug(asus);
1562
1563         if (asus->bluetooth.rfkill) {
1564                 bl = !asus_wmi_get_devstate_simple(asus,
1565                                                    ASUS_WMI_DEVID_BLUETOOTH);
1566                 rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
1567         }
1568         if (asus->wimax.rfkill) {
1569                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
1570                 rfkill_set_sw_state(asus->wimax.rfkill, bl);
1571         }
1572         if (asus->wwan3g.rfkill) {
1573                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
1574                 rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
1575         }
1576
1577         return 0;
1578 }
1579
1580 static const struct dev_pm_ops asus_pm_ops = {
1581         .thaw = asus_hotk_thaw,
1582         .restore = asus_hotk_restore,
1583 };
1584
1585 static int asus_wmi_probe(struct platform_device *pdev)
1586 {
1587         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1588         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1589         int ret;
1590
1591         if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1592                 pr_warn("Management GUID not found\n");
1593                 return -ENODEV;
1594         }
1595
1596         if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
1597                 pr_warn("Event GUID not found\n");
1598                 return -ENODEV;
1599         }
1600
1601         if (wdrv->probe) {
1602                 ret = wdrv->probe(pdev);
1603                 if (ret)
1604                         return ret;
1605         }
1606
1607         return asus_wmi_add(pdev);
1608 }
1609
1610 static bool used;
1611
1612 int asus_wmi_register_driver(struct asus_wmi_driver *driver)
1613 {
1614         struct platform_driver *platform_driver;
1615         struct platform_device *platform_device;
1616
1617         if (used)
1618                 return -EBUSY;
1619
1620         platform_driver = &driver->platform_driver;
1621         platform_driver->remove = asus_wmi_remove;
1622         platform_driver->driver.owner = driver->owner;
1623         platform_driver->driver.name = driver->name;
1624         platform_driver->driver.pm = &asus_pm_ops;
1625
1626         platform_device = platform_create_bundle(platform_driver,
1627                                                  asus_wmi_probe,
1628                                                  NULL, 0, NULL, 0);
1629         if (IS_ERR(platform_device))
1630                 return PTR_ERR(platform_device);
1631
1632         used = true;
1633         return 0;
1634 }
1635 EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
1636
1637 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
1638 {
1639         platform_device_unregister(driver->platform_device);
1640         platform_driver_unregister(&driver->platform_driver);
1641         used = false;
1642 }
1643 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
1644
1645 static int __init asus_wmi_init(void)
1646 {
1647         if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1648                 pr_info("Asus Management GUID not found");
1649                 return -ENODEV;
1650         }
1651
1652         pr_info("ASUS WMI generic driver loaded");
1653         return 0;
1654 }
1655
1656 static void __exit asus_wmi_exit(void)
1657 {
1658         pr_info("ASUS WMI generic driver unloaded");
1659 }
1660
1661 module_init(asus_wmi_init);
1662 module_exit(asus_wmi_exit);