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         asus->hwmon_device = hwmon;
 908         result = sysfs_create_group(&hwmon->kobj, &hwmon_attribute_group);
 909         if (result)
 910                 asus_wmi_hwmon_exit(asus);
 911         return result;
 912 }
 913
 914 /*
 915  * Backlight
 916  */
 917 static int read_backlight_power(struct asus_wmi *asus)
 918 {
 919         int ret = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_BACKLIGHT);
 920
 921         if (ret < 0)
 922                 return ret;
 923
 924         return ret ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
 925 }
 926
 927 static int read_brightness_max(struct asus_wmi *asus)
 928 {
 929         u32 retval;
 930         int err;
 931
 932         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
 933
 934         if (err < 0)
 935                 return err;
 936
 937         retval = retval & ASUS_WMI_DSTS_MAX_BRIGTH_MASK;
 938         retval >>= 8;
 939
 940         if (!retval)
 941                 return -ENODEV;
 942
 943         return retval;
 944 }
 945
 946 static int read_brightness(struct backlight_device *bd)
 947 {
 948         struct asus_wmi *asus = bl_get_data(bd);
 949         u32 retval;
 950         int err;
 951
 952         err = asus_wmi_get_devstate(asus, ASUS_WMI_DEVID_BRIGHTNESS, &retval);
 953
 954         if (err < 0)
 955                 return err;
 956
 957         return retval & ASUS_WMI_DSTS_BRIGHTNESS_MASK;
 958 }
 959
 960 static int update_bl_status(struct backlight_device *bd)
 961 {
 962         struct asus_wmi *asus = bl_get_data(bd);
 963         u32 ctrl_param;
 964         int power, err;
 965
 966         ctrl_param = bd->props.brightness;
 967
 968         err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BRIGHTNESS,
 969                                     ctrl_param, NULL);
 970
 971         if (err < 0)
 972                 return err;
 973
 974         power = read_backlight_power(asus);
 975         if (power != -ENODEV && bd->props.power != power) {
 976                 ctrl_param = !!(bd->props.power == FB_BLANK_UNBLANK);
 977                 err = asus_wmi_set_devstate(ASUS_WMI_DEVID_BACKLIGHT,
 978                                             ctrl_param, NULL);
 979         }
 980         return err;
 981 }
 982
 983 static const struct backlight_ops asus_wmi_bl_ops = {
 984         .get_brightness = read_brightness,
 985         .update_status = update_bl_status,
 986 };
 987
 988 static int asus_wmi_backlight_notify(struct asus_wmi *asus, int code)
 989 {
 990         struct backlight_device *bd = asus->backlight_device;
 991         int old = bd->props.brightness;
 992         int new = old;
 993
 994         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
 995                 new = code - NOTIFY_BRNUP_MIN + 1;
 996         else if (code >= NOTIFY_BRNDOWN_MIN && code <= NOTIFY_BRNDOWN_MAX)
 997                 new = code - NOTIFY_BRNDOWN_MIN;
 998
 999         bd->props.brightness = new;
1000         backlight_update_status(bd);
1001         backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
1002
1003         return old;
1004 }
1005
1006 static int asus_wmi_backlight_init(struct asus_wmi *asus)
1007 {
1008         struct backlight_device *bd;
1009         struct backlight_properties props;
1010         int max;
1011         int power;
1012
1013         max = read_brightness_max(asus);
1014
1015         if (max == -ENODEV)
1016                 max = 0;
1017         else if (max < 0)
1018                 return max;
1019
1020         power = read_backlight_power(asus);
1021
1022         if (power == -ENODEV)
1023                 power = FB_BLANK_UNBLANK;
1024         else if (power < 0)
1025                 return power;
1026
1027         memset(&props, 0, sizeof(struct backlight_properties));
1028         props.type = BACKLIGHT_PLATFORM;
1029         props.max_brightness = max;
1030         bd = backlight_device_register(asus->driver->name,
1031                                        &asus->platform_device->dev, asus,
1032                                        &asus_wmi_bl_ops, &props);
1033         if (IS_ERR(bd)) {
1034                 pr_err("Could not register backlight device\n");
1035                 return PTR_ERR(bd);
1036         }
1037
1038         asus->backlight_device = bd;
1039
1040         bd->props.brightness = read_brightness(bd);
1041         bd->props.power = power;
1042         backlight_update_status(bd);
1043
1044         return 0;
1045 }
1046
1047 static void asus_wmi_backlight_exit(struct asus_wmi *asus)
1048 {
1049         if (asus->backlight_device)
1050                 backlight_device_unregister(asus->backlight_device);
1051
1052         asus->backlight_device = NULL;
1053 }
1054
1055 static void asus_wmi_notify(u32 value, void *context)
1056 {
1057         struct asus_wmi *asus = context;
1058         struct acpi_buffer response = { ACPI_ALLOCATE_BUFFER, NULL };
1059         union acpi_object *obj;
1060         acpi_status status;
1061         int code;
1062         int orig_code;
1063
1064         status = wmi_get_event_data(value, &response);
1065         if (status != AE_OK) {
1066                 pr_err("bad event status 0x%x\n", status);
1067                 return;
1068         }
1069
1070         obj = (union acpi_object *)response.pointer;
1071
1072         if (!obj || obj->type != ACPI_TYPE_INTEGER)
1073                 goto exit;
1074
1075         code = obj->integer.value;
1076         orig_code = code;
1077
1078         if (code >= NOTIFY_BRNUP_MIN && code <= NOTIFY_BRNUP_MAX)
1079                 code = NOTIFY_BRNUP_MIN;
1080         else if (code >= NOTIFY_BRNDOWN_MIN &&
1081                  code <= NOTIFY_BRNDOWN_MAX)
1082                 code = NOTIFY_BRNDOWN_MIN;
1083
1084         if (code == NOTIFY_BRNUP_MIN || code == NOTIFY_BRNDOWN_MIN) {
1085                 if (!acpi_video_backlight_support())
1086                         asus_wmi_backlight_notify(asus, orig_code);
1087         } else if (!sparse_keymap_report_event(asus->inputdev, code, 1, true))
1088                 pr_info("Unknown key %x pressed\n", code);
1089
1090 exit:
1091         kfree(obj);
1092 }
1093
1094 /*
1095  * Sys helpers
1096  */
1097 static int parse_arg(const char *buf, unsigned long count, int *val)
1098 {
1099         if (!count)
1100                 return 0;
1101         if (sscanf(buf, "%i", val) != 1)
1102                 return -EINVAL;
1103         return count;
1104 }
1105
1106 static ssize_t store_sys_wmi(struct asus_wmi *asus, int devid,
1107                              const char *buf, size_t count)
1108 {
1109         u32 retval;
1110         int rv, err, value;
1111
1112         value = asus_wmi_get_devstate_simple(asus, devid);
1113         if (value == -ENODEV)   /* Check device presence */
1114                 return value;
1115
1116         rv = parse_arg(buf, count, &value);
1117         err = asus_wmi_set_devstate(devid, value, &retval);
1118
1119         if (err < 0)
1120                 return err;
1121
1122         return rv;
1123 }
1124
1125 static ssize_t show_sys_wmi(struct asus_wmi *asus, int devid, char *buf)
1126 {
1127         int value = asus_wmi_get_devstate_simple(asus, devid);
1128
1129         if (value < 0)
1130                 return value;
1131
1132         return sprintf(buf, "%d\n", value);
1133 }
1134
1135 #define ASUS_WMI_CREATE_DEVICE_ATTR(_name, _mode, _cm)                  \
1136         static ssize_t show_##_name(struct device *dev,                 \
1137                                     struct device_attribute *attr,      \
1138                                     char *buf)                          \
1139         {                                                               \
1140                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
1141                                                                         \
1142                 return show_sys_wmi(asus, _cm, buf);                    \
1143         }                                                               \
1144         static ssize_t store_##_name(struct device *dev,                \
1145                                      struct device_attribute *attr,     \
1146                                      const char *buf, size_t count)     \
1147         {                                                               \
1148                 struct asus_wmi *asus = dev_get_drvdata(dev);           \
1149                                                                         \
1150                 return store_sys_wmi(asus, _cm, buf, count);            \
1151         }                                                               \
1152         static struct device_attribute dev_attr_##_name = {             \
1153                 .attr = {                                               \
1154                         .name = __stringify(_name),                     \
1155                         .mode = _mode },                                \
1156                 .show   = show_##_name,                                 \
1157                 .store  = store_##_name,                                \
1158         }
1159
1160 ASUS_WMI_CREATE_DEVICE_ATTR(touchpad, 0644, ASUS_WMI_DEVID_TOUCHPAD);
1161 ASUS_WMI_CREATE_DEVICE_ATTR(camera, 0644, ASUS_WMI_DEVID_CAMERA);
1162 ASUS_WMI_CREATE_DEVICE_ATTR(cardr, 0644, ASUS_WMI_DEVID_CARDREADER);
1163
1164 static ssize_t store_cpufv(struct device *dev, struct device_attribute *attr,
1165                            const char *buf, size_t count)
1166 {
1167         int value;
1168
1169         if (!count || sscanf(buf, "%i", &value) != 1)
1170                 return -EINVAL;
1171         if (value < 0 || value > 2)
1172                 return -EINVAL;
1173
1174         return asus_wmi_evaluate_method(ASUS_WMI_METHODID_CFVS, value, 0, NULL);
1175 }
1176
1177 static DEVICE_ATTR(cpufv, S_IRUGO | S_IWUSR, NULL, store_cpufv);
1178
1179 static struct attribute *platform_attributes[] = {
1180         &dev_attr_cpufv.attr,
1181         &dev_attr_camera.attr,
1182         &dev_attr_cardr.attr,
1183         &dev_attr_touchpad.attr,
1184         NULL
1185 };
1186
1187 static mode_t asus_sysfs_is_visible(struct kobject *kobj,
1188                                     struct attribute *attr, int idx)
1189 {
1190         struct device *dev = container_of(kobj, struct device, kobj);
1191         struct platform_device *pdev = to_platform_device(dev);
1192         struct asus_wmi *asus = platform_get_drvdata(pdev);
1193         bool ok = true;
1194         int devid = -1;
1195
1196         if (attr == &dev_attr_camera.attr)
1197                 devid = ASUS_WMI_DEVID_CAMERA;
1198         else if (attr == &dev_attr_cardr.attr)
1199                 devid = ASUS_WMI_DEVID_CARDREADER;
1200         else if (attr == &dev_attr_touchpad.attr)
1201                 devid = ASUS_WMI_DEVID_TOUCHPAD;
1202
1203         if (devid != -1)
1204                 ok = !(asus_wmi_get_devstate_simple(asus, devid) < 0);
1205
1206         return ok ? attr->mode : 0;
1207 }
1208
1209 static struct attribute_group platform_attribute_group = {
1210         .is_visible = asus_sysfs_is_visible,
1211         .attrs = platform_attributes
1212 };
1213
1214 static void asus_wmi_sysfs_exit(struct platform_device *device)
1215 {
1216         sysfs_remove_group(&device->dev.kobj, &platform_attribute_group);
1217 }
1218
1219 static int asus_wmi_sysfs_init(struct platform_device *device)
1220 {
1221         return sysfs_create_group(&device->dev.kobj, &platform_attribute_group);
1222 }
1223
1224 /*
1225  * Platform device
1226  */
1227 static int asus_wmi_platform_init(struct asus_wmi *asus)
1228 {
1229         int rv;
1230
1231         /* INIT enable hotkeys on some models */
1232         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_INIT, 0, 0, &rv))
1233                 pr_info("Initialization: %#x", rv);
1234
1235         /* We don't know yet what to do with this version... */
1236         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SPEC, 0, 0x9, &rv)) {
1237                 pr_info("BIOS WMI version: %d.%d", rv >> 8, rv & 0xFF);
1238                 asus->spec = rv;
1239         }
1240
1241         /*
1242          * The SFUN method probably allows the original driver to get the list
1243          * of features supported by a given model. For now, 0x0100 or 0x0800
1244          * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
1245          * The significance of others is yet to be found.
1246          */
1247         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_SFUN, 0, 0, &rv)) {
1248                 pr_info("SFUN value: %#x", rv);
1249                 asus->sfun = rv;
1250         }
1251
1252         /*
1253          * Eee PC and Notebooks seems to have different method_id for DSTS,
1254          * but it may also be related to the BIOS's SPEC.
1255          * Note, on most Eeepc, there is no way to check if a method exist
1256          * or note, while on notebooks, they returns 0xFFFFFFFE on failure,
1257          * but once again, SPEC may probably be used for that kind of things.
1258          */
1259         if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS, 0, 0, NULL))
1260                 asus->dsts_id = ASUS_WMI_METHODID_DSTS;
1261         else if (!asus_wmi_evaluate_method(ASUS_WMI_METHODID_DSTS2, 0, 0, NULL))
1262                 asus->dsts_id = ASUS_WMI_METHODID_DSTS2;
1263
1264         if (!asus->dsts_id) {
1265                 pr_err("Can't find DSTS");
1266                 return -ENODEV;
1267         }
1268
1269         return asus_wmi_sysfs_init(asus->platform_device);
1270 }
1271
1272 static void asus_wmi_platform_exit(struct asus_wmi *asus)
1273 {
1274         asus_wmi_sysfs_exit(asus->platform_device);
1275 }
1276
1277 /*
1278  * debugfs
1279  */
1280 struct asus_wmi_debugfs_node {
1281         struct asus_wmi *asus;
1282         char *name;
1283         int (*show) (struct seq_file *m, void *data);
1284 };
1285
1286 static int show_dsts(struct seq_file *m, void *data)
1287 {
1288         struct asus_wmi *asus = m->private;
1289         int err;
1290         u32 retval = -1;
1291
1292         err = asus_wmi_get_devstate(asus, asus->debug.dev_id, &retval);
1293
1294         if (err < 0)
1295                 return err;
1296
1297         seq_printf(m, "DSTS(%#x) = %#x\n", asus->debug.dev_id, retval);
1298
1299         return 0;
1300 }
1301
1302 static int show_devs(struct seq_file *m, void *data)
1303 {
1304         struct asus_wmi *asus = m->private;
1305         int err;
1306         u32 retval = -1;
1307
1308         err = asus_wmi_set_devstate(asus->debug.dev_id, asus->debug.ctrl_param,
1309                                     &retval);
1310
1311         if (err < 0)
1312                 return err;
1313
1314         seq_printf(m, "DEVS(%#x, %#x) = %#x\n", asus->debug.dev_id,
1315                    asus->debug.ctrl_param, retval);
1316
1317         return 0;
1318 }
1319
1320 static int show_call(struct seq_file *m, void *data)
1321 {
1322         struct asus_wmi *asus = m->private;
1323         struct bios_args args = {
1324                 .arg0 = asus->debug.dev_id,
1325                 .arg1 = asus->debug.ctrl_param,
1326         };
1327         struct acpi_buffer input = { (acpi_size) sizeof(args), &args };
1328         struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
1329         union acpi_object *obj;
1330         acpi_status status;
1331
1332         status = wmi_evaluate_method(ASUS_WMI_MGMT_GUID,
1333                                      1, asus->debug.method_id,
1334                                      &input, &output);
1335
1336         if (ACPI_FAILURE(status))
1337                 return -EIO;
1338
1339         obj = (union acpi_object *)output.pointer;
1340         if (obj && obj->type == ACPI_TYPE_INTEGER)
1341                 seq_printf(m, "%#x(%#x, %#x) = %#x\n", asus->debug.method_id,
1342                            asus->debug.dev_id, asus->debug.ctrl_param,
1343                            (u32) obj->integer.value);
1344         else
1345                 seq_printf(m, "%#x(%#x, %#x) = t:%d\n", asus->debug.method_id,
1346                            asus->debug.dev_id, asus->debug.ctrl_param,
1347                            obj ? obj->type : -1);
1348
1349         kfree(obj);
1350
1351         return 0;
1352 }
1353
1354 static struct asus_wmi_debugfs_node asus_wmi_debug_files[] = {
1355         {NULL, "devs", show_devs},
1356         {NULL, "dsts", show_dsts},
1357         {NULL, "call", show_call},
1358 };
1359
1360 static int asus_wmi_debugfs_open(struct inode *inode, struct file *file)
1361 {
1362         struct asus_wmi_debugfs_node *node = inode->i_private;
1363
1364         return single_open(file, node->show, node->asus);
1365 }
1366
1367 static const struct file_operations asus_wmi_debugfs_io_ops = {
1368         .owner = THIS_MODULE,
1369         .open = asus_wmi_debugfs_open,
1370         .read = seq_read,
1371         .llseek = seq_lseek,
1372         .release = single_release,
1373 };
1374
1375 static void asus_wmi_debugfs_exit(struct asus_wmi *asus)
1376 {
1377         debugfs_remove_recursive(asus->debug.root);
1378 }
1379
1380 static int asus_wmi_debugfs_init(struct asus_wmi *asus)
1381 {
1382         struct dentry *dent;
1383         int i;
1384
1385         asus->debug.root = debugfs_create_dir(asus->driver->name, NULL);
1386         if (!asus->debug.root) {
1387                 pr_err("failed to create debugfs directory");
1388                 goto error_debugfs;
1389         }
1390
1391         dent = debugfs_create_x32("method_id", S_IRUGO | S_IWUSR,
1392                                   asus->debug.root, &asus->debug.method_id);
1393         if (!dent)
1394                 goto error_debugfs;
1395
1396         dent = debugfs_create_x32("dev_id", S_IRUGO | S_IWUSR,
1397                                   asus->debug.root, &asus->debug.dev_id);
1398         if (!dent)
1399                 goto error_debugfs;
1400
1401         dent = debugfs_create_x32("ctrl_param", S_IRUGO | S_IWUSR,
1402                                   asus->debug.root, &asus->debug.ctrl_param);
1403         if (!dent)
1404                 goto error_debugfs;
1405
1406         for (i = 0; i < ARRAY_SIZE(asus_wmi_debug_files); i++) {
1407                 struct asus_wmi_debugfs_node *node = &asus_wmi_debug_files[i];
1408
1409                 node->asus = asus;
1410                 dent = debugfs_create_file(node->name, S_IFREG | S_IRUGO,
1411                                            asus->debug.root, node,
1412                                            &asus_wmi_debugfs_io_ops);
1413                 if (!dent) {
1414                         pr_err("failed to create debug file: %s\n", node->name);
1415                         goto error_debugfs;
1416                 }
1417         }
1418
1419         return 0;
1420
1421 error_debugfs:
1422         asus_wmi_debugfs_exit(asus);
1423         return -ENOMEM;
1424 }
1425
1426 /*
1427  * WMI Driver
1428  */
1429 static int asus_wmi_add(struct platform_device *pdev)
1430 {
1431         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1432         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1433         struct asus_wmi *asus;
1434         acpi_status status;
1435         int err;
1436
1437         asus = kzalloc(sizeof(struct asus_wmi), GFP_KERNEL);
1438         if (!asus)
1439                 return -ENOMEM;
1440
1441         asus->driver = wdrv;
1442         asus->platform_device = pdev;
1443         wdrv->platform_device = pdev;
1444         platform_set_drvdata(asus->platform_device, asus);
1445
1446         if (wdrv->quirks)
1447                 wdrv->quirks(asus->driver);
1448
1449         err = asus_wmi_platform_init(asus);
1450         if (err)
1451                 goto fail_platform;
1452
1453         err = asus_wmi_input_init(asus);
1454         if (err)
1455                 goto fail_input;
1456
1457         err = asus_wmi_hwmon_init(asus);
1458         if (err)
1459                 goto fail_hwmon;
1460
1461         err = asus_wmi_led_init(asus);
1462         if (err)
1463                 goto fail_leds;
1464
1465         err = asus_wmi_rfkill_init(asus);
1466         if (err)
1467                 goto fail_rfkill;
1468
1469         if (!acpi_video_backlight_support()) {
1470                 err = asus_wmi_backlight_init(asus);
1471                 if (err && err != -ENODEV)
1472                         goto fail_backlight;
1473         } else
1474                 pr_info("Backlight controlled by ACPI video driver\n");
1475
1476         status = wmi_install_notify_handler(asus->driver->event_guid,
1477                                             asus_wmi_notify, asus);
1478         if (ACPI_FAILURE(status)) {
1479                 pr_err("Unable to register notify handler - %d\n", status);
1480                 err = -ENODEV;
1481                 goto fail_wmi_handler;
1482         }
1483
1484         err = asus_wmi_debugfs_init(asus);
1485         if (err)
1486                 goto fail_debugfs;
1487
1488         return 0;
1489
1490 fail_debugfs:
1491         wmi_remove_notify_handler(asus->driver->event_guid);
1492 fail_wmi_handler:
1493         asus_wmi_backlight_exit(asus);
1494 fail_backlight:
1495         asus_wmi_rfkill_exit(asus);
1496 fail_rfkill:
1497         asus_wmi_led_exit(asus);
1498 fail_leds:
1499         asus_wmi_hwmon_exit(asus);
1500 fail_hwmon:
1501         asus_wmi_input_exit(asus);
1502 fail_input:
1503         asus_wmi_platform_exit(asus);
1504 fail_platform:
1505         kfree(asus);
1506         return err;
1507 }
1508
1509 static int asus_wmi_remove(struct platform_device *device)
1510 {
1511         struct asus_wmi *asus;
1512
1513         asus = platform_get_drvdata(device);
1514         wmi_remove_notify_handler(asus->driver->event_guid);
1515         asus_wmi_backlight_exit(asus);
1516         asus_wmi_input_exit(asus);
1517         asus_wmi_hwmon_exit(asus);
1518         asus_wmi_led_exit(asus);
1519         asus_wmi_rfkill_exit(asus);
1520         asus_wmi_debugfs_exit(asus);
1521         asus_wmi_platform_exit(asus);
1522
1523         kfree(asus);
1524         return 0;
1525 }
1526
1527 /*
1528  * Platform driver - hibernate/resume callbacks
1529  */
1530 static int asus_hotk_thaw(struct device *device)
1531 {
1532         struct asus_wmi *asus = dev_get_drvdata(device);
1533
1534         if (asus->wlan.rfkill) {
1535                 bool wlan;
1536
1537                 /*
1538                  * Work around bios bug - acpi _PTS turns off the wireless led
1539                  * during suspend.  Normally it restores it on resume, but
1540                  * we should kick it ourselves in case hibernation is aborted.
1541                  */
1542                 wlan = asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WLAN);
1543                 asus_wmi_set_devstate(ASUS_WMI_DEVID_WLAN, wlan, NULL);
1544         }
1545
1546         return 0;
1547 }
1548
1549 static int asus_hotk_restore(struct device *device)
1550 {
1551         struct asus_wmi *asus = dev_get_drvdata(device);
1552         int bl;
1553
1554         /* Refresh both wlan rfkill state and pci hotplug */
1555         if (asus->wlan.rfkill)
1556                 asus_rfkill_hotplug(asus);
1557
1558         if (asus->bluetooth.rfkill) {
1559                 bl = !asus_wmi_get_devstate_simple(asus,
1560                                                    ASUS_WMI_DEVID_BLUETOOTH);
1561                 rfkill_set_sw_state(asus->bluetooth.rfkill, bl);
1562         }
1563         if (asus->wimax.rfkill) {
1564                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WIMAX);
1565                 rfkill_set_sw_state(asus->wimax.rfkill, bl);
1566         }
1567         if (asus->wwan3g.rfkill) {
1568                 bl = !asus_wmi_get_devstate_simple(asus, ASUS_WMI_DEVID_WWAN3G);
1569                 rfkill_set_sw_state(asus->wwan3g.rfkill, bl);
1570         }
1571
1572         return 0;
1573 }
1574
1575 static const struct dev_pm_ops asus_pm_ops = {
1576         .thaw = asus_hotk_thaw,
1577         .restore = asus_hotk_restore,
1578 };
1579
1580 static int asus_wmi_probe(struct platform_device *pdev)
1581 {
1582         struct platform_driver *pdrv = to_platform_driver(pdev->dev.driver);
1583         struct asus_wmi_driver *wdrv = to_asus_wmi_driver(pdrv);
1584         int ret;
1585
1586         if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1587                 pr_warn("Management GUID not found\n");
1588                 return -ENODEV;
1589         }
1590
1591         if (wdrv->event_guid && !wmi_has_guid(wdrv->event_guid)) {
1592                 pr_warn("Event GUID not found\n");
1593                 return -ENODEV;
1594         }
1595
1596         if (wdrv->probe) {
1597                 ret = wdrv->probe(pdev);
1598                 if (ret)
1599                         return ret;
1600         }
1601
1602         return asus_wmi_add(pdev);
1603 }
1604
1605 static bool used;
1606
1607 int asus_wmi_register_driver(struct asus_wmi_driver *driver)
1608 {
1609         struct platform_driver *platform_driver;
1610         struct platform_device *platform_device;
1611
1612         if (used)
1613                 return -EBUSY;
1614
1615         platform_driver = &driver->platform_driver;
1616         platform_driver->remove = asus_wmi_remove;
1617         platform_driver->driver.owner = driver->owner;
1618         platform_driver->driver.name = driver->name;
1619         platform_driver->driver.pm = &asus_pm_ops;
1620
1621         platform_device = platform_create_bundle(platform_driver,
1622                                                  asus_wmi_probe,
1623                                                  NULL, 0, NULL, 0);
1624         if (IS_ERR(platform_device))
1625                 return PTR_ERR(platform_device);
1626
1627         used = true;
1628         return 0;
1629 }
1630 EXPORT_SYMBOL_GPL(asus_wmi_register_driver);
1631
1632 void asus_wmi_unregister_driver(struct asus_wmi_driver *driver)
1633 {
1634         platform_device_unregister(driver->platform_device);
1635         platform_driver_unregister(&driver->platform_driver);
1636         used = false;
1637 }
1638 EXPORT_SYMBOL_GPL(asus_wmi_unregister_driver);
1639
1640 static int __init asus_wmi_init(void)
1641 {
1642         if (!wmi_has_guid(ASUS_WMI_MGMT_GUID)) {
1643                 pr_info("Asus Management GUID not found");
1644                 return -ENODEV;
1645         }
1646
1647         pr_info("ASUS WMI generic driver loaded");
1648         return 0;
1649 }
1650
1651 static void __exit asus_wmi_exit(void)
1652 {
1653         pr_info("ASUS WMI generic driver unloaded");
1654 }
1655
1656 module_init(asus_wmi_init);
1657 module_exit(asus_wmi_exit);