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