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