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