drivers/platform/x86/asus-laptop.c

   1 /*
   2  *  asus-laptop.c - Asus Laptop Support
   3  *
   4  *
   5  *  Copyright (C) 2002-2005 Julien Lerouge, 2003-2006 Karol Kozimor
   6  *  Copyright (C) 2006-2007 Corentin Chary
   7  *  Copyright (C) 2011 Wind River Systems
   8  *
   9  *  This program is free software; you can redistribute it and/or modify
  10  *  it under the terms of the GNU General Public License as published by
  11  *  the Free Software Foundation; either version 2 of the License, or
  12  *  (at your option) any later version.
  13  *
  14  *  This program is distributed in the hope that it will be useful,
  15  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  *  GNU General Public License for more details.
  18  *
  19  *  You should have received a copy of the GNU General Public License
  20  *  along with this program; if not, write to the Free Software
  21  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  22  *
  23  *
  24  *  The development page for this driver is located at
  25  *  http://sourceforge.net/projects/acpi4asus/
  26  *
  27  *  Credits:
  28  *  Pontus Fuchs   - Helper functions, cleanup
  29  *  Johann Wiesner - Small compile fixes
  30  *  John Belmonte  - ACPI code for Toshiba laptop was a good starting point.
  31  *  Eric Burghard  - LED display support for W1N
  32  *  Josh Green     - Light Sens support
  33  *  Thomas Tuttle  - His first patch for led support was very helpful
  34  *  Sam Lin        - GPS support
  35  */
  36
  37 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  38
  39 #include <linux/kernel.h>
  40 #include <linux/module.h>
  41 #include <linux/init.h>
  42 #include <linux/types.h>
  43 #include <linux/err.h>
  44 #include <linux/proc_fs.h>
  45 #include <linux/backlight.h>
  46 #include <linux/fb.h>
  47 #include <linux/leds.h>
  48 #include <linux/platform_device.h>
  49 #include <linux/uaccess.h>
  50 #include <linux/input.h>
  51 #include <linux/input/sparse-keymap.h>
  52 #include <linux/input-polldev.h>
  53 #include <linux/rfkill.h>
  54 #include <linux/slab.h>
  55 #include <linux/dmi.h>
  56 #include <acpi/acpi_drivers.h>
  57 #include <acpi/acpi_bus.h>
  58
  59 #define ASUS_LAPTOP_VERSION     "0.42"
  60
  61 #define ASUS_LAPTOP_NAME        "Asus Laptop Support"
  62 #define ASUS_LAPTOP_CLASS       "hotkey"
  63 #define ASUS_LAPTOP_DEVICE_NAME "Hotkey"
  64 #define ASUS_LAPTOP_FILE        KBUILD_MODNAME
  65 #define ASUS_LAPTOP_PREFIX      "\\_SB.ATKD."
  66
  67 MODULE_AUTHOR("Julien Lerouge, Karol Kozimor, Corentin Chary");
  68 MODULE_DESCRIPTION(ASUS_LAPTOP_NAME);
  69 MODULE_LICENSE("GPL");
  70
  71 /*
  72  * WAPF defines the behavior of the Fn+Fx wlan key
  73  * The significance of values is yet to be found, but
  74  * most of the time:
  75  * Bit | Bluetooth | WLAN
  76  *  0  | Hardware  | Hardware
  77  *  1  | Hardware  | Software
  78  *  4  | Software  | Software
  79  */
  80 static uint wapf = 1;
  81 module_param(wapf, uint, 0444);
  82 MODULE_PARM_DESC(wapf, "WAPF value");
  83
  84 static char *wled_type = "unknown";
  85 static char *bled_type = "unknown";
  86
  87 module_param(wled_type, charp, 0444);
  88 MODULE_PARM_DESC(wlan_status, "Set the wled type on boot "
  89                  "(unknown, led or rfkill). "
  90                  "default is unknown");
  91
  92 module_param(bled_type, charp, 0444);
  93 MODULE_PARM_DESC(bled_type, "Set the bled type on boot "
  94                  "(unknown, led or rfkill). "
  95                  "default is unknown");
  96
  97 static int wlan_status = 1;
  98 static int bluetooth_status = 1;
  99 static int wimax_status = -1;
 100 static int wwan_status = -1;
 101 static int als_status;
 102
 103 module_param(wlan_status, int, 0444);
 104 MODULE_PARM_DESC(wlan_status, "Set the wireless status on boot "
 105                  "(0 = disabled, 1 = enabled, -1 = don't do anything). "
 106                  "default is -1");
 107
 108 module_param(bluetooth_status, int, 0444);
 109 MODULE_PARM_DESC(bluetooth_status, "Set the wireless status on boot "
 110                  "(0 = disabled, 1 = enabled, -1 = don't do anything). "
 111                  "default is -1");
 112
 113 module_param(wimax_status, int, 0444);
 114 MODULE_PARM_DESC(wimax_status, "Set the wireless status on boot "
 115                  "(0 = disabled, 1 = enabled, -1 = don't do anything). "
 116                  "default is -1");
 117
 118 module_param(wwan_status, int, 0444);
 119 MODULE_PARM_DESC(wwan_status, "Set the wireless status on boot "
 120                  "(0 = disabled, 1 = enabled, -1 = don't do anything). "
 121                  "default is -1");
 122
 123 module_param(als_status, int, 0444);
 124 MODULE_PARM_DESC(als_status, "Set the ALS status on boot "
 125                  "(0 = disabled, 1 = enabled). "
 126                  "default is 0");
 127
 128 /*
 129  * Some events we use, same for all Asus
 130  */
 131 #define ATKD_BR_UP      0x10    /* (event & ~ATKD_BR_UP) = brightness level */
 132 #define ATKD_BR_DOWN    0x20    /* (event & ~ATKD_BR_DOWN) = britghness level */
 133 #define ATKD_BR_MIN     ATKD_BR_UP
 134 #define ATKD_BR_MAX     (ATKD_BR_DOWN | 0xF)    /* 0x2f */
 135 #define ATKD_LCD_ON     0x33
 136 #define ATKD_LCD_OFF    0x34
 137
 138 /*
 139  * Known bits returned by \_SB.ATKD.HWRS
 140  */
 141 #define WL_HWRS         0x80
 142 #define BT_HWRS         0x100
 143
 144 /*
 145  * Flags for hotk status
 146  * WL_ON and BT_ON are also used for wireless_status()
 147  */
 148 #define WL_RSTS         0x01    /* internal Wifi */
 149 #define BT_RSTS         0x02    /* internal Bluetooth */
 150 #define WM_RSTS         0x08    /* internal wimax */
 151 #define WW_RSTS         0x20    /* internal wwan */
 152
 153 /* WLED and BLED type */
 154 #define TYPE_UNKNOWN    0
 155 #define TYPE_LED        1
 156 #define TYPE_RFKILL     2
 157
 158 /* LED */
 159 #define METHOD_MLED             "MLED"
 160 #define METHOD_TLED             "TLED"
 161 #define METHOD_RLED             "RLED"  /* W1JC */
 162 #define METHOD_PLED             "PLED"  /* A7J */
 163 #define METHOD_GLED             "GLED"  /* G1, G2 (probably) */
 164
 165 /* LEDD */
 166 #define METHOD_LEDD             "SLCM"
 167
 168 /*
 169  * Bluetooth and WLAN
 170  * WLED and BLED are not handled like other XLED, because in some dsdt
 171  * they also control the WLAN/Bluetooth device.
 172  */
 173 #define METHOD_WLAN             "WLED"
 174 #define METHOD_BLUETOOTH        "BLED"
 175
 176 /* WWAN and WIMAX */
 177 #define METHOD_WWAN             "GSMC"
 178 #define METHOD_WIMAX            "WMXC"
 179
 180 #define METHOD_WL_STATUS        "RSTS"
 181
 182 /* Brightness */
 183 #define METHOD_BRIGHTNESS_SET   "SPLV"
 184 #define METHOD_BRIGHTNESS_GET   "GPLV"
 185
 186 /* Display */
 187 #define METHOD_SWITCH_DISPLAY   "SDSP"
 188
 189 #define METHOD_ALS_CONTROL      "ALSC" /* Z71A Z71V */
 190 #define METHOD_ALS_LEVEL        "ALSL" /* Z71A Z71V */
 191
 192 /* GPS */
 193 /* R2H use different handle for GPS on/off */
 194 #define METHOD_GPS_ON           "SDON"
 195 #define METHOD_GPS_OFF          "SDOF"
 196 #define METHOD_GPS_STATUS       "GPST"
 197
 198 /* Keyboard light */
 199 #define METHOD_KBD_LIGHT_SET    "SLKB"
 200 #define METHOD_KBD_LIGHT_GET    "GLKB"
 201
 202 /* For Pegatron Lucid tablet */
 203 #define DEVICE_NAME_PEGA        "Lucid"
 204
 205 #define METHOD_PEGA_ENABLE      "ENPR"
 206 #define METHOD_PEGA_DISABLE     "DAPR"
 207 #define PEGA_WLAN       0x00
 208 #define PEGA_BLUETOOTH  0x01
 209 #define PEGA_WWAN       0x02
 210 #define PEGA_ALS        0x04
 211 #define PEGA_ALS_POWER  0x05
 212
 213 #define METHOD_PEGA_READ        "RDLN"
 214 #define PEGA_READ_ALS_H 0x02
 215 #define PEGA_READ_ALS_L 0x03
 216
 217 #define PEGA_ACCEL_NAME "pega_accel"
 218 #define PEGA_ACCEL_DESC "Pegatron Lucid Tablet Accelerometer"
 219 #define METHOD_XLRX "XLRX"
 220 #define METHOD_XLRY "XLRY"
 221 #define METHOD_XLRZ "XLRZ"
 222 #define PEGA_ACC_CLAMP 512 /* 1G accel is reported as ~256, so clamp to 2G */
 223 #define PEGA_ACC_RETRIES 3
 224
 225 /*
 226  * Define a specific led structure to keep the main structure clean
 227  */
 228 struct asus_led {
 229         int wk;
 230         struct work_struct work;
 231         struct led_classdev led;
 232         struct asus_laptop *asus;
 233         const char *method;
 234 };
 235
 236 /*
 237  * Same thing for rfkill
 238  */
 239 struct asus_rfkill {
 240         /* type of control. Maps to PEGA_* values or *_RSTS  */
 241         int control_id;
 242         struct rfkill *rfkill;
 243         struct asus_laptop *asus;
 244 };
 245
 246 /*
 247  * This is the main structure, we can use it to store anything interesting
 248  * about the hotk device
 249  */
 250 struct asus_laptop {
 251         char *name;             /* laptop name */
 252
 253         struct acpi_table_header *dsdt_info;
 254         struct platform_device *platform_device;
 255         struct acpi_device *device;             /* the device we are in */
 256         struct backlight_device *backlight_device;
 257
 258         struct input_dev *inputdev;
 259         struct key_entry *keymap;
 260         struct input_polled_dev *pega_accel_poll;
 261
 262         struct asus_led wled;
 263         struct asus_led bled;
 264         struct asus_led mled;
 265         struct asus_led tled;
 266         struct asus_led rled;
 267         struct asus_led pled;
 268         struct asus_led gled;
 269         struct asus_led kled;
 270         struct workqueue_struct *led_workqueue;
 271
 272         int wled_type;
 273         int bled_type;
 274         int wireless_status;
 275         bool have_rsts;
 276         bool is_pega_lucid;
 277         bool pega_acc_live;
 278         int pega_acc_x;
 279         int pega_acc_y;
 280         int pega_acc_z;
 281
 282         struct asus_rfkill wlan;
 283         struct asus_rfkill bluetooth;
 284         struct asus_rfkill wwan;
 285         struct asus_rfkill wimax;
 286         struct asus_rfkill gps;
 287
 288         acpi_handle handle;     /* the handle of the hotk device */
 289         u32 ledd_status;        /* status of the LED display */
 290         u8 light_level;         /* light sensor level */
 291         u8 light_switch;        /* light sensor switch value */
 292         u16 event_count[128];   /* count for each event TODO make this better */
 293 };
 294
 295 static const struct key_entry asus_keymap[] = {
 296         /* Lenovo SL Specific keycodes */
 297         {KE_KEY, 0x02, { KEY_SCREENLOCK } },
 298         {KE_KEY, 0x05, { KEY_WLAN } },
 299         {KE_KEY, 0x08, { KEY_F13 } },
 300         {KE_KEY, 0x17, { KEY_ZOOM } },
 301         {KE_KEY, 0x1f, { KEY_BATTERY } },
 302         /* End of Lenovo SL Specific keycodes */
 303         {KE_KEY, 0x30, { KEY_VOLUMEUP } },
 304         {KE_KEY, 0x31, { KEY_VOLUMEDOWN } },
 305         {KE_KEY, 0x32, { KEY_MUTE } },
 306         {KE_KEY, 0x33, { KEY_SWITCHVIDEOMODE } },
 307         {KE_KEY, 0x34, { KEY_SWITCHVIDEOMODE } },
 308         {KE_KEY, 0x40, { KEY_PREVIOUSSONG } },
 309         {KE_KEY, 0x41, { KEY_NEXTSONG } },
 310         {KE_KEY, 0x43, { KEY_STOPCD } },
 311         {KE_KEY, 0x45, { KEY_PLAYPAUSE } },
 312         {KE_KEY, 0x4c, { KEY_MEDIA } },
 313         {KE_KEY, 0x50, { KEY_EMAIL } },
 314         {KE_KEY, 0x51, { KEY_WWW } },
 315         {KE_KEY, 0x55, { KEY_CALC } },
 316         {KE_KEY, 0x5C, { KEY_SCREENLOCK } },  /* Screenlock */
 317         {KE_KEY, 0x5D, { KEY_WLAN } },
 318         {KE_KEY, 0x5E, { KEY_WLAN } },
 319         {KE_KEY, 0x5F, { KEY_WLAN } },
 320         {KE_KEY, 0x60, { KEY_SWITCHVIDEOMODE } },
 321         {KE_KEY, 0x61, { KEY_SWITCHVIDEOMODE } },
 322         {KE_KEY, 0x62, { KEY_SWITCHVIDEOMODE } },
 323         {KE_KEY, 0x63, { KEY_SWITCHVIDEOMODE } },
 324         {KE_KEY, 0x6B, { KEY_F13 } }, /* Lock Touchpad */
 325         {KE_KEY, 0x7E, { KEY_BLUETOOTH } },
 326         {KE_KEY, 0x7D, { KEY_BLUETOOTH } },
 327         {KE_KEY, 0x82, { KEY_CAMERA } },
 328         {KE_KEY, 0x88, { KEY_WLAN  } },
 329         {KE_KEY, 0x8A, { KEY_PROG1 } },
 330         {KE_KEY, 0x95, { KEY_MEDIA } },
 331         {KE_KEY, 0x99, { KEY_PHONE } },
 332         {KE_KEY, 0xc4, { KEY_KBDILLUMUP } },
 333         {KE_KEY, 0xc5, { KEY_KBDILLUMDOWN } },
 334         {KE_KEY, 0xb5, { KEY_CALC } },
 335         {KE_END, 0},
 336 };
 337
 338
 339 /*
 340  * This function evaluates an ACPI method, given an int as parameter, the
 341  * method is searched within the scope of the handle, can be NULL. The output
 342  * of the method is written is output, which can also be NULL
 343  *
 344  * returns 0 if write is successful, -1 else.
 345  */
 346 static int write_acpi_int_ret(acpi_handle handle, const char *method, int val,
 347                               struct acpi_buffer *output)
 348 {
 349         struct acpi_object_list params; /* list of input parameters (an int) */
 350         union acpi_object in_obj;       /* the only param we use */
 351         acpi_status status;
 352
 353         if (!handle)
 354                 return -1;
 355
 356         params.count = 1;
 357         params.pointer = &in_obj;
 358         in_obj.type = ACPI_TYPE_INTEGER;
 359         in_obj.integer.value = val;
 360
 361         status = acpi_evaluate_object(handle, (char *)method, &params, output);
 362         if (status == AE_OK)
 363                 return 0;
 364         else
 365                 return -1;
 366 }
 367
 368 static int write_acpi_int(acpi_handle handle, const char *method, int val)
 369 {
 370         return write_acpi_int_ret(handle, method, val, NULL);
 371 }
 372
 373 static int acpi_check_handle(acpi_handle handle, const char *method,
 374                              acpi_handle *ret)
 375 {
 376         acpi_status status;
 377
 378         if (method == NULL)
 379                 return -ENODEV;
 380
 381         if (ret)
 382                 status = acpi_get_handle(handle, (char *)method,
 383                                          ret);
 384         else {
 385                 acpi_handle dummy;
 386
 387                 status = acpi_get_handle(handle, (char *)method,
 388                                          &dummy);
 389         }
 390
 391         if (status != AE_OK) {
 392                 if (ret)
 393                         pr_warn("Error finding %s\n", method);
 394                 return -ENODEV;
 395         }
 396         return 0;
 397 }
 398
 399 static bool asus_check_pega_lucid(struct asus_laptop *asus)
 400 {
 401         return !strcmp(asus->name, DEVICE_NAME_PEGA) &&
 402            !acpi_check_handle(asus->handle, METHOD_PEGA_ENABLE, NULL) &&
 403            !acpi_check_handle(asus->handle, METHOD_PEGA_DISABLE, NULL) &&
 404            !acpi_check_handle(asus->handle, METHOD_PEGA_READ, NULL);
 405 }
 406
 407 static int asus_pega_lucid_set(struct asus_laptop *asus, int unit, bool enable)
 408 {
 409         char *method = enable ? METHOD_PEGA_ENABLE : METHOD_PEGA_DISABLE;
 410         return write_acpi_int(asus->handle, method, unit);
 411 }
 412
 413 static int pega_acc_axis(struct asus_laptop *asus, int curr, char *method)
 414 {
 415         int i, delta;
 416         unsigned long long val;
 417         for (i = 0; i < PEGA_ACC_RETRIES; i++) {
 418                 acpi_evaluate_integer(asus->handle, method, NULL, &val);
 419
 420                 /* The output is noisy.  From reading the ASL
 421                  * dissassembly, timeout errors are returned with 1's
 422                  * in the high word, and the lack of locking around
 423                  * thei hi/lo byte reads means that a transition
 424                  * between (for example) -1 and 0 could be read as
 425                  * 0xff00 or 0x00ff. */
 426                 delta = abs(curr - (short)val);
 427                 if (delta < 128 && !(val & ~0xffff))
 428                         break;
 429         }
 430         return clamp_val((short)val, -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP);
 431 }
 432
 433 static void pega_accel_poll(struct input_polled_dev *ipd)
 434 {
 435         struct device *parent = ipd->input->dev.parent;
 436         struct asus_laptop *asus = dev_get_drvdata(parent);
 437
 438         /* In some cases, the very first call to poll causes a
 439          * recursive fault under the polldev worker.  This is
 440          * apparently related to very early userspace access to the
 441          * device, and perhaps a firmware bug. Fake the first report. */
 442         if (!asus->pega_acc_live) {
 443                 asus->pega_acc_live = true;
 444                 input_report_abs(ipd->input, ABS_X, 0);
 445                 input_report_abs(ipd->input, ABS_Y, 0);
 446                 input_report_abs(ipd->input, ABS_Z, 0);
 447                 input_sync(ipd->input);
 448                 return;
 449         }
 450
 451         asus->pega_acc_x = pega_acc_axis(asus, asus->pega_acc_x, METHOD_XLRX);
 452         asus->pega_acc_y = pega_acc_axis(asus, asus->pega_acc_y, METHOD_XLRY);
 453         asus->pega_acc_z = pega_acc_axis(asus, asus->pega_acc_z, METHOD_XLRZ);
 454
 455         /* Note transform, convert to "right/up/out" in the native
 456          * landscape orientation (i.e. the vector is the direction of
 457          * "real up" in the device's cartiesian coordinates). */
 458         input_report_abs(ipd->input, ABS_X, -asus->pega_acc_x);
 459         input_report_abs(ipd->input, ABS_Y, -asus->pega_acc_y);
 460         input_report_abs(ipd->input, ABS_Z,  asus->pega_acc_z);
 461         input_sync(ipd->input);
 462 }
 463
 464 static void pega_accel_exit(struct asus_laptop *asus)
 465 {
 466         if (asus->pega_accel_poll) {
 467                 input_unregister_polled_device(asus->pega_accel_poll);
 468                 input_free_polled_device(asus->pega_accel_poll);
 469         }
 470         asus->pega_accel_poll = NULL;
 471 }
 472
 473 static int pega_accel_init(struct asus_laptop *asus)
 474 {
 475         int err;
 476         struct input_polled_dev *ipd;
 477
 478         if (!asus->is_pega_lucid)
 479                 return -ENODEV;
 480
 481         if (acpi_check_handle(asus->handle, METHOD_XLRX, NULL) ||
 482             acpi_check_handle(asus->handle, METHOD_XLRY, NULL) ||
 483             acpi_check_handle(asus->handle, METHOD_XLRZ, NULL))
 484                 return -ENODEV;
 485
 486         ipd = input_allocate_polled_device();
 487         if (!ipd)
 488                 return -ENOMEM;
 489
 490         ipd->poll = pega_accel_poll;
 491         ipd->poll_interval = 125;
 492         ipd->poll_interval_min = 50;
 493         ipd->poll_interval_max = 2000;
 494
 495         ipd->input->name = PEGA_ACCEL_DESC;
 496         ipd->input->phys = PEGA_ACCEL_NAME "/input0";
 497         ipd->input->dev.parent = &asus->platform_device->dev;
 498         ipd->input->id.bustype = BUS_HOST;
 499
 500         set_bit(EV_ABS, ipd->input->evbit);
 501         input_set_abs_params(ipd->input, ABS_X,
 502                              -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP, 0, 0);
 503         input_set_abs_params(ipd->input, ABS_Y,
 504                              -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP, 0, 0);
 505         input_set_abs_params(ipd->input, ABS_Z,
 506                              -PEGA_ACC_CLAMP, PEGA_ACC_CLAMP, 0, 0);
 507
 508         err = input_register_polled_device(ipd);
 509         if (err)
 510                 goto exit;
 511
 512         asus->pega_accel_poll = ipd;
 513         return 0;
 514
 515 exit:
 516         input_free_polled_device(ipd);
 517         return err;
 518 }
 519
 520 /* Generic LED function */
 521 static int asus_led_set(struct asus_laptop *asus, const char *method,
 522                          int value)
 523 {
 524         if (!strcmp(method, METHOD_MLED))
 525                 value = !value;
 526         else if (!strcmp(method, METHOD_GLED))
 527                 value = !value + 1;
 528         else
 529                 value = !!value;
 530
 531         return write_acpi_int(asus->handle, method, value);
 532 }
 533
 534 /*
 535  * LEDs
 536  */
 537 /* /sys/class/led handlers */
 538 static void asus_led_cdev_set(struct led_classdev *led_cdev,
 539                          enum led_brightness value)
 540 {
 541         struct asus_led *led = container_of(led_cdev, struct asus_led, led);
 542         struct asus_laptop *asus = led->asus;
 543
 544         led->wk = !!value;
 545         queue_work(asus->led_workqueue, &led->work);
 546 }
 547
 548 static void asus_led_cdev_update(struct work_struct *work)
 549 {
 550         struct asus_led *led = container_of(work, struct asus_led, work);
 551         struct asus_laptop *asus = led->asus;
 552
 553         asus_led_set(asus, led->method, led->wk);
 554 }
 555
 556 static enum led_brightness asus_led_cdev_get(struct led_classdev *led_cdev)
 557 {
 558         return led_cdev->brightness;
 559 }
 560
 561 /*
 562  * Keyboard backlight (also a LED)
 563  */
 564 static int asus_kled_lvl(struct asus_laptop *asus)
 565 {
 566         unsigned long long kblv;
 567         struct acpi_object_list params;
 568         union acpi_object in_obj;
 569         acpi_status rv;
 570
 571         params.count = 1;
 572         params.pointer = &in_obj;
 573         in_obj.type = ACPI_TYPE_INTEGER;
 574         in_obj.integer.value = 2;
 575
 576         rv = acpi_evaluate_integer(asus->handle, METHOD_KBD_LIGHT_GET,
 577                                    &params, &kblv);
 578         if (ACPI_FAILURE(rv)) {
 579                 pr_warn("Error reading kled level\n");
 580                 return -ENODEV;
 581         }
 582         return kblv;
 583 }
 584
 585 static int asus_kled_set(struct asus_laptop *asus, int kblv)
 586 {
 587         if (kblv > 0)
 588                 kblv = (1 << 7) | (kblv & 0x7F);
 589         else
 590                 kblv = 0;
 591
 592         if (write_acpi_int(asus->handle, METHOD_KBD_LIGHT_SET, kblv)) {
 593                 pr_warn("Keyboard LED display write failed\n");
 594                 return -EINVAL;
 595         }
 596         return 0;
 597 }
 598
 599 static void asus_kled_cdev_set(struct led_classdev *led_cdev,
 600                               enum led_brightness value)
 601 {
 602         struct asus_led *led = container_of(led_cdev, struct asus_led, led);
 603         struct asus_laptop *asus = led->asus;
 604
 605         led->wk = value;
 606         queue_work(asus->led_workqueue, &led->work);
 607 }
 608
 609 static void asus_kled_cdev_update(struct work_struct *work)
 610 {
 611         struct asus_led *led = container_of(work, struct asus_led, work);
 612         struct asus_laptop *asus = led->asus;
 613
 614         asus_kled_set(asus, led->wk);
 615 }
 616
 617 static enum led_brightness asus_kled_cdev_get(struct led_classdev *led_cdev)
 618 {
 619         struct asus_led *led = container_of(led_cdev, struct asus_led, led);
 620         struct asus_laptop *asus = led->asus;
 621
 622         return asus_kled_lvl(asus);
 623 }
 624
 625 static void asus_led_exit(struct asus_laptop *asus)
 626 {
 627         if (!IS_ERR_OR_NULL(asus->wled.led.dev))
 628                 led_classdev_unregister(&asus->wled.led);
 629         if (!IS_ERR_OR_NULL(asus->bled.led.dev))
 630                 led_classdev_unregister(&asus->bled.led);
 631         if (!IS_ERR_OR_NULL(asus->mled.led.dev))
 632                 led_classdev_unregister(&asus->mled.led);
 633         if (!IS_ERR_OR_NULL(asus->tled.led.dev))
 634                 led_classdev_unregister(&asus->tled.led);
 635         if (!IS_ERR_OR_NULL(asus->pled.led.dev))
 636                 led_classdev_unregister(&asus->pled.led);
 637         if (!IS_ERR_OR_NULL(asus->rled.led.dev))
 638                 led_classdev_unregister(&asus->rled.led);
 639         if (!IS_ERR_OR_NULL(asus->gled.led.dev))
 640                 led_classdev_unregister(&asus->gled.led);
 641         if (!IS_ERR_OR_NULL(asus->kled.led.dev))
 642                 led_classdev_unregister(&asus->kled.led);
 643         if (asus->led_workqueue) {
 644                 destroy_workqueue(asus->led_workqueue);
 645                 asus->led_workqueue = NULL;
 646         }
 647 }
 648
 649 /*  Ugly macro, need to fix that later */
 650 static int asus_led_register(struct asus_laptop *asus,
 651                              struct asus_led *led,
 652                              const char *name, const char *method)
 653 {
 654         struct led_classdev *led_cdev = &led->led;
 655
 656         if (!method || acpi_check_handle(asus->handle, method, NULL))
 657                 return 0; /* Led not present */
 658
 659         led->asus = asus;
 660         led->method = method;
 661
 662         INIT_WORK(&led->work, asus_led_cdev_update);
 663         led_cdev->name = name;
 664         led_cdev->brightness_set = asus_led_cdev_set;
 665         led_cdev->brightness_get = asus_led_cdev_get;
 666         led_cdev->max_brightness = 1;
 667         return led_classdev_register(&asus->platform_device->dev, led_cdev);
 668 }
 669
 670 static int asus_led_init(struct asus_laptop *asus)
 671 {
 672         int r = 0;
 673
 674         /*
 675          * The Pegatron Lucid has no physical leds, but all methods are
 676          * available in the DSDT...
 677          */
 678         if (asus->is_pega_lucid)
 679                 return 0;
 680
 681         /*
 682          * Functions that actually update the LED's are called from a
 683          * workqueue. By doing this as separate work rather than when the LED
 684          * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 685          * potentially bad time, such as a timer interrupt.
 686          */
 687         asus->led_workqueue = create_singlethread_workqueue("led_workqueue");
 688         if (!asus->led_workqueue)
 689                 return -ENOMEM;
 690
 691         if (asus->wled_type == TYPE_LED)
 692                 r = asus_led_register(asus, &asus->wled, "asus::wlan",
 693                                       METHOD_WLAN);
 694         if (r)
 695                 goto error;
 696         if (asus->bled_type == TYPE_LED)
 697                 r = asus_led_register(asus, &asus->bled, "asus::bluetooth",
 698                                       METHOD_BLUETOOTH);
 699         if (r)
 700                 goto error;
 701         r = asus_led_register(asus, &asus->mled, "asus::mail", METHOD_MLED);
 702         if (r)
 703                 goto error;
 704         r = asus_led_register(asus, &asus->tled, "asus::touchpad", METHOD_TLED);
 705         if (r)
 706                 goto error;
 707         r = asus_led_register(asus, &asus->rled, "asus::record", METHOD_RLED);
 708         if (r)
 709                 goto error;
 710         r = asus_led_register(asus, &asus->pled, "asus::phone", METHOD_PLED);
 711         if (r)
 712                 goto error;
 713         r = asus_led_register(asus, &asus->gled, "asus::gaming", METHOD_GLED);
 714         if (r)
 715                 goto error;
 716         if (!acpi_check_handle(asus->handle, METHOD_KBD_LIGHT_SET, NULL) &&
 717             !acpi_check_handle(asus->handle, METHOD_KBD_LIGHT_GET, NULL)) {
 718                 struct asus_led *led = &asus->kled;
 719                 struct led_classdev *cdev = &led->led;
 720
 721                 led->asus = asus;
 722
 723                 INIT_WORK(&led->work, asus_kled_cdev_update);
 724                 cdev->name = "asus::kbd_backlight";
 725                 cdev->brightness_set = asus_kled_cdev_set;
 726                 cdev->brightness_get = asus_kled_cdev_get;
 727                 cdev->max_brightness = 3;
 728                 r = led_classdev_register(&asus->platform_device->dev, cdev);
 729         }
 730 error:
 731         if (r)
 732                 asus_led_exit(asus);
 733         return r;
 734 }
 735
 736 /*
 737  * Backlight device
 738  */
 739 static int asus_read_brightness(struct backlight_device *bd)
 740 {
 741         struct asus_laptop *asus = bl_get_data(bd);
 742         unsigned long long value;
 743         acpi_status rv = AE_OK;
 744
 745         rv = acpi_evaluate_integer(asus->handle, METHOD_BRIGHTNESS_GET,
 746                                    NULL, &value);
 747         if (ACPI_FAILURE(rv))
 748                 pr_warn("Error reading brightness\n");
 749
 750         return value;
 751 }
 752
 753 static int asus_set_brightness(struct backlight_device *bd, int value)
 754 {
 755         struct asus_laptop *asus = bl_get_data(bd);
 756
 757         if (write_acpi_int(asus->handle, METHOD_BRIGHTNESS_SET, value)) {
 758                 pr_warn("Error changing brightness\n");
 759                 return -EIO;
 760         }
 761         return 0;
 762 }
 763
 764 static int update_bl_status(struct backlight_device *bd)
 765 {
 766         int value = bd->props.brightness;
 767
 768         return asus_set_brightness(bd, value);
 769 }
 770
 771 static const struct backlight_ops asusbl_ops = {
 772         .get_brightness = asus_read_brightness,
 773         .update_status = update_bl_status,
 774 };
 775
 776 static int asus_backlight_notify(struct asus_laptop *asus)
 777 {
 778         struct backlight_device *bd = asus->backlight_device;
 779         int old = bd->props.brightness;
 780
 781         backlight_force_update(bd, BACKLIGHT_UPDATE_HOTKEY);
 782
 783         return old;
 784 }
 785
 786 static int asus_backlight_init(struct asus_laptop *asus)
 787 {
 788         struct backlight_device *bd;
 789         struct backlight_properties props;
 790
 791         if (acpi_check_handle(asus->handle, METHOD_BRIGHTNESS_GET, NULL) ||
 792             acpi_check_handle(asus->handle, METHOD_BRIGHTNESS_SET, NULL))
 793                 return 0;
 794
 795         memset(&props, 0, sizeof(struct backlight_properties));
 796         props.max_brightness = 15;
 797         props.type = BACKLIGHT_PLATFORM;
 798
 799         bd = backlight_device_register(ASUS_LAPTOP_FILE,
 800                                        &asus->platform_device->dev, asus,
 801                                        &asusbl_ops, &props);
 802         if (IS_ERR(bd)) {
 803                 pr_err("Could not register asus backlight device\n");
 804                 asus->backlight_device = NULL;
 805                 return PTR_ERR(bd);
 806         }
 807
 808         asus->backlight_device = bd;
 809         bd->props.brightness = asus_read_brightness(bd);
 810         bd->props.power = FB_BLANK_UNBLANK;
 811         backlight_update_status(bd);
 812         return 0;
 813 }
 814
 815 static void asus_backlight_exit(struct asus_laptop *asus)
 816 {
 817         if (asus->backlight_device)
 818                 backlight_device_unregister(asus->backlight_device);
 819         asus->backlight_device = NULL;
 820 }
 821
 822 /*
 823  * Platform device handlers
 824  */
 825
 826 /*
 827  * We write our info in page, we begin at offset off and cannot write more
 828  * than count bytes. We set eof to 1 if we handle those 2 values. We return the
 829  * number of bytes written in page
 830  */
 831 static ssize_t show_infos(struct device *dev,
 832                           struct device_attribute *attr, char *page)
 833 {
 834         struct asus_laptop *asus = dev_get_drvdata(dev);
 835         int len = 0;
 836         unsigned long long temp;
 837         char buf[16];           /* enough for all info */
 838         acpi_status rv = AE_OK;
 839
 840         /*
 841          * We use the easy way, we don't care of off and count,
 842          * so we don't set eof to 1
 843          */
 844
 845         len += sprintf(page, ASUS_LAPTOP_NAME " " ASUS_LAPTOP_VERSION "\n");
 846         len += sprintf(page + len, "Model reference    : %s\n", asus->name);
 847         /*
 848          * The SFUN method probably allows the original driver to get the list
 849          * of features supported by a given model. For now, 0x0100 or 0x0800
 850          * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
 851          * The significance of others is yet to be found.
 852          */
 853         rv = acpi_evaluate_integer(asus->handle, "SFUN", NULL, &temp);
 854         if (!ACPI_FAILURE(rv))
 855                 len += sprintf(page + len, "SFUN value         : %#x\n",
 856                                (uint) temp);
 857         /*
 858          * The HWRS method return informations about the hardware.
 859          * 0x80 bit is for WLAN, 0x100 for Bluetooth.
 860          * The significance of others is yet to be found.
 861          * If we don't find the method, we assume the device are present.
 862          */
 863         rv = acpi_evaluate_integer(asus->handle, "HRWS", NULL, &temp);
 864         if (!ACPI_FAILURE(rv))
 865                 len += sprintf(page + len, "HRWS value         : %#x\n",
 866                                (uint) temp);
 867         /*
 868          * Another value for userspace: the ASYM method returns 0x02 for
 869          * battery low and 0x04 for battery critical, its readings tend to be
 870          * more accurate than those provided by _BST.
 871          * Note: since not all the laptops provide this method, errors are
 872          * silently ignored.
 873          */
 874         rv = acpi_evaluate_integer(asus->handle, "ASYM", NULL, &temp);
 875         if (!ACPI_FAILURE(rv))
 876                 len += sprintf(page + len, "ASYM value         : %#x\n",
 877                                (uint) temp);
 878         if (asus->dsdt_info) {
 879                 snprintf(buf, 16, "%d", asus->dsdt_info->length);
 880                 len += sprintf(page + len, "DSDT length        : %s\n", buf);
 881                 snprintf(buf, 16, "%d", asus->dsdt_info->checksum);
 882                 len += sprintf(page + len, "DSDT checksum      : %s\n", buf);
 883                 snprintf(buf, 16, "%d", asus->dsdt_info->revision);
 884                 len += sprintf(page + len, "DSDT revision      : %s\n", buf);
 885                 snprintf(buf, 7, "%s", asus->dsdt_info->oem_id);
 886                 len += sprintf(page + len, "OEM id             : %s\n", buf);
 887                 snprintf(buf, 9, "%s", asus->dsdt_info->oem_table_id);
 888                 len += sprintf(page + len, "OEM table id       : %s\n", buf);
 889                 snprintf(buf, 16, "%x", asus->dsdt_info->oem_revision);
 890                 len += sprintf(page + len, "OEM revision       : 0x%s\n", buf);
 891                 snprintf(buf, 5, "%s", asus->dsdt_info->asl_compiler_id);
 892                 len += sprintf(page + len, "ASL comp vendor id : %s\n", buf);
 893                 snprintf(buf, 16, "%x", asus->dsdt_info->asl_compiler_revision);
 894                 len += sprintf(page + len, "ASL comp revision  : 0x%s\n", buf);
 895         }
 896
 897         return len;
 898 }
 899
 900 static int parse_arg(const char *buf, unsigned long count, int *val)
 901 {
 902         if (!count)
 903                 return 0;
 904         if (count > 31)
 905                 return -EINVAL;
 906         if (sscanf(buf, "%i", val) != 1)
 907                 return -EINVAL;
 908         return count;
 909 }
 910
 911 static ssize_t sysfs_acpi_set(struct asus_laptop *asus,
 912                               const char *buf, size_t count,
 913                               const char *method)
 914 {
 915         int rv, value;
 916         int out = 0;
 917
 918         rv = parse_arg(buf, count, &value);
 919         if (rv > 0)
 920                 out = value ? 1 : 0;
 921
 922         if (write_acpi_int(asus->handle, method, value))
 923                 return -ENODEV;
 924         return rv;
 925 }
 926
 927 /*
 928  * LEDD display
 929  */
 930 static ssize_t show_ledd(struct device *dev,
 931                          struct device_attribute *attr, char *buf)
 932 {
 933         struct asus_laptop *asus = dev_get_drvdata(dev);
 934
 935         return sprintf(buf, "0x%08x\n", asus->ledd_status);
 936 }
 937
 938 static ssize_t store_ledd(struct device *dev, struct device_attribute *attr,
 939                           const char *buf, size_t count)
 940 {
 941         struct asus_laptop *asus = dev_get_drvdata(dev);
 942         int rv, value;
 943
 944         rv = parse_arg(buf, count, &value);
 945         if (rv > 0) {
 946                 if (write_acpi_int(asus->handle, METHOD_LEDD, value)) {
 947                         pr_warn("LED display write failed\n");
 948                         return -ENODEV;
 949                 }
 950                 asus->ledd_status = (u32) value;
 951         }
 952         return rv;
 953 }
 954
 955 /*
 956  * Wireless
 957  */
 958 static int asus_wireless_status(struct asus_laptop *asus, int mask)
 959 {
 960         unsigned long long status;
 961         acpi_status rv = AE_OK;
 962
 963         if (!asus->have_rsts)
 964                 return (asus->wireless_status & mask) ? 1 : 0;
 965
 966         rv = acpi_evaluate_integer(asus->handle, METHOD_WL_STATUS,
 967                                    NULL, &status);
 968         if (ACPI_FAILURE(rv)) {
 969                 pr_warn("Error reading Wireless status\n");
 970                 return -EINVAL;
 971         }
 972         return !!(status & mask);
 973 }
 974
 975 /*
 976  * WLAN
 977  */
 978 static int asus_wlan_set(struct asus_laptop *asus, int status)
 979 {
 980         if (write_acpi_int(asus->handle, METHOD_WLAN, !!status)) {
 981                 pr_warn("Error setting wlan status to %d\n", status);
 982                 return -EIO;
 983         }
 984         return 0;
 985 }
 986
 987 static ssize_t show_wlan(struct device *dev,
 988                          struct device_attribute *attr, char *buf)
 989 {
 990         struct asus_laptop *asus = dev_get_drvdata(dev);
 991
 992         return sprintf(buf, "%d\n", asus_wireless_status(asus, WL_RSTS));
 993 }
 994
 995 static ssize_t store_wlan(struct device *dev, struct device_attribute *attr,
 996                           const char *buf, size_t count)
 997 {
 998         struct asus_laptop *asus = dev_get_drvdata(dev);
 999
1000         return sysfs_acpi_set(asus, buf, count, METHOD_WLAN);
1001 }
1002
1003 /*e
1004  * Bluetooth
1005  */
1006 static int asus_bluetooth_set(struct asus_laptop *asus, int status)
1007 {
1008         if (write_acpi_int(asus->handle, METHOD_BLUETOOTH, !!status)) {
1009                 pr_warn("Error setting bluetooth status to %d\n", status);
1010                 return -EIO;
1011         }
1012         return 0;
1013 }
1014
1015 static ssize_t show_bluetooth(struct device *dev,
1016                               struct device_attribute *attr, char *buf)
1017 {
1018         struct asus_laptop *asus = dev_get_drvdata(dev);
1019
1020         return sprintf(buf, "%d\n", asus_wireless_status(asus, BT_RSTS));
1021 }
1022
1023 static ssize_t store_bluetooth(struct device *dev,
1024                                struct device_attribute *attr, const char *buf,
1025                                size_t count)
1026 {
1027         struct asus_laptop *asus = dev_get_drvdata(dev);
1028
1029         return sysfs_acpi_set(asus, buf, count, METHOD_BLUETOOTH);
1030 }
1031
1032 /*
1033  * Wimax
1034  */
1035 static int asus_wimax_set(struct asus_laptop *asus, int status)
1036 {
1037         if (write_acpi_int(asus->handle, METHOD_WIMAX, !!status)) {
1038                 pr_warn("Error setting wimax status to %d\n", status);
1039                 return -EIO;
1040         }
1041         return 0;
1042 }
1043
1044 static ssize_t show_wimax(struct device *dev,
1045                               struct device_attribute *attr, char *buf)
1046 {
1047         struct asus_laptop *asus = dev_get_drvdata(dev);
1048
1049         return sprintf(buf, "%d\n", asus_wireless_status(asus, WM_RSTS));
1050 }
1051
1052 static ssize_t store_wimax(struct device *dev,
1053                                struct device_attribute *attr, const char *buf,
1054                                size_t count)
1055 {
1056         struct asus_laptop *asus = dev_get_drvdata(dev);
1057
1058         return sysfs_acpi_set(asus, buf, count, METHOD_WIMAX);
1059 }
1060
1061 /*
1062  * Wwan
1063  */
1064 static int asus_wwan_set(struct asus_laptop *asus, int status)
1065 {
1066         if (write_acpi_int(asus->handle, METHOD_WWAN, !!status)) {
1067                 pr_warn("Error setting wwan status to %d\n", status);
1068                 return -EIO;
1069         }
1070         return 0;
1071 }
1072
1073 static ssize_t show_wwan(struct device *dev,
1074                               struct device_attribute *attr, char *buf)
1075 {
1076         struct asus_laptop *asus = dev_get_drvdata(dev);
1077
1078         return sprintf(buf, "%d\n", asus_wireless_status(asus, WW_RSTS));
1079 }
1080
1081 static ssize_t store_wwan(struct device *dev,
1082                                struct device_attribute *attr, const char *buf,
1083                                size_t count)
1084 {
1085         struct asus_laptop *asus = dev_get_drvdata(dev);
1086
1087         return sysfs_acpi_set(asus, buf, count, METHOD_WWAN);
1088 }
1089
1090 /*
1091  * Display
1092  */
1093 static void asus_set_display(struct asus_laptop *asus, int value)
1094 {
1095         /* no sanity check needed for now */
1096         if (write_acpi_int(asus->handle, METHOD_SWITCH_DISPLAY, value))
1097                 pr_warn("Error setting display\n");
1098         return;
1099 }
1100
1101 /*
1102  * Experimental support for display switching. As of now: 1 should activate
1103  * the LCD output, 2 should do for CRT, 4 for TV-Out and 8 for DVI.
1104  * Any combination (bitwise) of these will suffice. I never actually tested 4
1105  * displays hooked up simultaneously, so be warned. See the acpi4asus README
1106  * for more info.
1107  */
1108 static ssize_t store_disp(struct device *dev, struct device_attribute *attr,
1109                           const char *buf, size_t count)
1110 {
1111         struct asus_laptop *asus = dev_get_drvdata(dev);
1112         int rv, value;
1113
1114         rv = parse_arg(buf, count, &value);
1115         if (rv > 0)
1116                 asus_set_display(asus, value);
1117         return rv;
1118 }
1119
1120 /*
1121  * Light Sens
1122  */
1123 static void asus_als_switch(struct asus_laptop *asus, int value)
1124 {
1125         int ret;
1126
1127         if (asus->is_pega_lucid) {
1128                 ret = asus_pega_lucid_set(asus, PEGA_ALS, value);
1129                 if (!ret)
1130                         ret = asus_pega_lucid_set(asus, PEGA_ALS_POWER, value);
1131         } else {
1132                 ret = write_acpi_int(asus->handle, METHOD_ALS_CONTROL, value);
1133         }
1134         if (ret)
1135                 pr_warning("Error setting light sensor switch\n");
1136
1137         asus->light_switch = value;
1138 }
1139
1140 static ssize_t show_lssw(struct device *dev,
1141                          struct device_attribute *attr, char *buf)
1142 {
1143         struct asus_laptop *asus = dev_get_drvdata(dev);
1144
1145         return sprintf(buf, "%d\n", asus->light_switch);
1146 }
1147
1148 static ssize_t store_lssw(struct device *dev, struct device_attribute *attr,
1149                           const char *buf, size_t count)
1150 {
1151         struct asus_laptop *asus = dev_get_drvdata(dev);
1152         int rv, value;
1153
1154         rv = parse_arg(buf, count, &value);
1155         if (rv > 0)
1156                 asus_als_switch(asus, value ? 1 : 0);
1157
1158         return rv;
1159 }
1160
1161 static void asus_als_level(struct asus_laptop *asus, int value)
1162 {
1163         if (write_acpi_int(asus->handle, METHOD_ALS_LEVEL, value))
1164                 pr_warn("Error setting light sensor level\n");
1165         asus->light_level = value;
1166 }
1167
1168 static ssize_t show_lslvl(struct device *dev,
1169                           struct device_attribute *attr, char *buf)
1170 {
1171         struct asus_laptop *asus = dev_get_drvdata(dev);
1172
1173         return sprintf(buf, "%d\n", asus->light_level);
1174 }
1175
1176 static ssize_t store_lslvl(struct device *dev, struct device_attribute *attr,
1177                            const char *buf, size_t count)
1178 {
1179         struct asus_laptop *asus = dev_get_drvdata(dev);
1180         int rv, value;
1181
1182         rv = parse_arg(buf, count, &value);
1183         if (rv > 0) {
1184                 value = (0 < value) ? ((15 < value) ? 15 : value) : 0;
1185                 /* 0 <= value <= 15 */
1186                 asus_als_level(asus, value);
1187         }
1188
1189         return rv;
1190 }
1191
1192 static int pega_int_read(struct asus_laptop *asus, int arg, int *result)
1193 {
1194         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1195         int err = write_acpi_int_ret(asus->handle, METHOD_PEGA_READ, arg,
1196                                      &buffer);
1197         if (!err) {
1198                 union acpi_object *obj = buffer.pointer;
1199                 if (obj && obj->type == ACPI_TYPE_INTEGER)
1200                         *result = obj->integer.value;
1201                 else
1202                         err = -EIO;
1203         }
1204         return err;
1205 }
1206
1207 static ssize_t show_lsvalue(struct device *dev,
1208                             struct device_attribute *attr, char *buf)
1209 {
1210         struct asus_laptop *asus = dev_get_drvdata(dev);
1211         int err, hi, lo;
1212
1213         err = pega_int_read(asus, PEGA_READ_ALS_H, &hi);
1214         if (!err)
1215                 err = pega_int_read(asus, PEGA_READ_ALS_L, &lo);
1216         if (!err)
1217                 return sprintf(buf, "%d\n", 10 * hi + lo);
1218         return err;
1219 }
1220
1221 /*
1222  * GPS
1223  */
1224 static int asus_gps_status(struct asus_laptop *asus)
1225 {
1226         unsigned long long status;
1227         acpi_status rv = AE_OK;
1228
1229         rv = acpi_evaluate_integer(asus->handle, METHOD_GPS_STATUS,
1230                                    NULL, &status);
1231         if (ACPI_FAILURE(rv)) {
1232                 pr_warn("Error reading GPS status\n");
1233                 return -ENODEV;
1234         }
1235         return !!status;
1236 }
1237
1238 static int asus_gps_switch(struct asus_laptop *asus, int status)
1239 {
1240         const char *meth = status ? METHOD_GPS_ON : METHOD_GPS_OFF;
1241
1242         if (write_acpi_int(asus->handle, meth, 0x02))
1243                 return -ENODEV;
1244         return 0;
1245 }
1246
1247 static ssize_t show_gps(struct device *dev,
1248                         struct device_attribute *attr, char *buf)
1249 {
1250         struct asus_laptop *asus = dev_get_drvdata(dev);
1251
1252         return sprintf(buf, "%d\n", asus_gps_status(asus));
1253 }
1254
1255 static ssize_t store_gps(struct device *dev, struct device_attribute *attr,
1256                          const char *buf, size_t count)
1257 {
1258         struct asus_laptop *asus = dev_get_drvdata(dev);
1259         int rv, value;
1260         int ret;
1261
1262         rv = parse_arg(buf, count, &value);
1263         if (rv <= 0)
1264                 return -EINVAL;
1265         ret = asus_gps_switch(asus, !!value);
1266         if (ret)
1267                 return ret;
1268         rfkill_set_sw_state(asus->gps.rfkill, !value);
1269         return rv;
1270 }
1271
1272 /*
1273  * rfkill
1274  */
1275 static int asus_gps_rfkill_set(void *data, bool blocked)
1276 {
1277         struct asus_laptop *asus = data;
1278
1279         return asus_gps_switch(asus, !blocked);
1280 }
1281
1282 static const struct rfkill_ops asus_gps_rfkill_ops = {
1283         .set_block = asus_gps_rfkill_set,
1284 };
1285
1286 static int asus_rfkill_set(void *data, bool blocked)
1287 {
1288         struct asus_rfkill *rfk = data;
1289         struct asus_laptop *asus = rfk->asus;
1290
1291         if (rfk->control_id == WL_RSTS)
1292                 return asus_wlan_set(asus, !blocked);
1293         else if (rfk->control_id == BT_RSTS)
1294                 return asus_bluetooth_set(asus, !blocked);
1295         else if (rfk->control_id == WM_RSTS)
1296                 return asus_wimax_set(asus, !blocked);
1297         else if (rfk->control_id == WW_RSTS)
1298                 return asus_wwan_set(asus, !blocked);
1299
1300         return -EINVAL;
1301 }
1302
1303 static const struct rfkill_ops asus_rfkill_ops = {
1304         .set_block = asus_rfkill_set,
1305 };
1306
1307 static void asus_rfkill_terminate(struct asus_rfkill *rfk)
1308 {
1309         if (!rfk->rfkill)
1310                 return ;
1311
1312         rfkill_unregister(rfk->rfkill);
1313         rfkill_destroy(rfk->rfkill);
1314         rfk->rfkill = NULL;
1315 }
1316
1317 static void asus_rfkill_exit(struct asus_laptop *asus)
1318 {
1319         asus_rfkill_terminate(&asus->wwan);
1320         asus_rfkill_terminate(&asus->bluetooth);
1321         asus_rfkill_terminate(&asus->wlan);
1322         asus_rfkill_terminate(&asus->gps);
1323 }
1324
1325 static int asus_rfkill_setup(struct asus_laptop *asus, struct asus_rfkill *rfk,
1326                              const char *name, int control_id, int type,
1327                              const struct rfkill_ops *ops)
1328 {
1329         int result;
1330
1331         rfk->control_id = control_id;
1332         rfk->asus = asus;
1333         rfk->rfkill = rfkill_alloc(name, &asus->platform_device->dev,
1334                                    type, ops, rfk);
1335         if (!rfk->rfkill)
1336                 return -EINVAL;
1337
1338         result = rfkill_register(rfk->rfkill);
1339         if (result) {
1340                 rfkill_destroy(rfk->rfkill);
1341                 rfk->rfkill = NULL;
1342         }
1343
1344         return result;
1345 }
1346
1347 static int asus_rfkill_init(struct asus_laptop *asus)
1348 {
1349         int result = 0;
1350
1351         if (asus->is_pega_lucid)
1352                 return -ENODEV;
1353
1354         if (!acpi_check_handle(asus->handle, METHOD_GPS_ON, NULL) &&
1355             !acpi_check_handle(asus->handle, METHOD_GPS_OFF, NULL) &&
1356             !acpi_check_handle(asus->handle, METHOD_GPS_STATUS, NULL))
1357                 result = asus_rfkill_setup(asus, &asus->gps, "asus-gps",
1358                                            -1, RFKILL_TYPE_GPS,
1359                                            &asus_gps_rfkill_ops);
1360         if (result)
1361                 goto exit;
1362
1363
1364         if (!acpi_check_handle(asus->handle, METHOD_WLAN, NULL) &&
1365             asus->wled_type == TYPE_RFKILL)
1366                 result = asus_rfkill_setup(asus, &asus->wlan, "asus-wlan",
1367                                            WL_RSTS, RFKILL_TYPE_WLAN,
1368                                            &asus_rfkill_ops);
1369         if (result)
1370                 goto exit;
1371
1372         if (!acpi_check_handle(asus->handle, METHOD_BLUETOOTH, NULL) &&
1373             asus->bled_type == TYPE_RFKILL)
1374                 result = asus_rfkill_setup(asus, &asus->bluetooth,
1375                                            "asus-bluetooth", BT_RSTS,
1376                                            RFKILL_TYPE_BLUETOOTH,
1377                                            &asus_rfkill_ops);
1378         if (result)
1379                 goto exit;
1380
1381         if (!acpi_check_handle(asus->handle, METHOD_WWAN, NULL))
1382                 result = asus_rfkill_setup(asus, &asus->wwan, "asus-wwan",
1383                                            WW_RSTS, RFKILL_TYPE_WWAN,
1384                                            &asus_rfkill_ops);
1385         if (result)
1386                 goto exit;
1387
1388         if (!acpi_check_handle(asus->handle, METHOD_WIMAX, NULL))
1389                 result = asus_rfkill_setup(asus, &asus->wimax, "asus-wimax",
1390                                            WM_RSTS, RFKILL_TYPE_WIMAX,
1391                                            &asus_rfkill_ops);
1392         if (result)
1393                 goto exit;
1394
1395 exit:
1396         if (result)
1397                 asus_rfkill_exit(asus);
1398
1399         return result;
1400 }
1401
1402 static int pega_rfkill_set(void *data, bool blocked)
1403 {
1404         struct asus_rfkill *rfk = data;
1405
1406         int ret = asus_pega_lucid_set(rfk->asus, rfk->control_id, !blocked);
1407         return ret;
1408 }
1409
1410 static const struct rfkill_ops pega_rfkill_ops = {
1411         .set_block = pega_rfkill_set,
1412 };
1413
1414 static int pega_rfkill_setup(struct asus_laptop *asus, struct asus_rfkill *rfk,
1415                              const char *name, int controlid, int rfkill_type)
1416 {
1417         return asus_rfkill_setup(asus, rfk, name, controlid, rfkill_type,
1418                                  &pega_rfkill_ops);
1419 }
1420
1421 static int pega_rfkill_init(struct asus_laptop *asus)
1422 {
1423         int ret = 0;
1424
1425         if(!asus->is_pega_lucid)
1426                 return -ENODEV;
1427
1428         ret = pega_rfkill_setup(asus, &asus->wlan, "pega-wlan",
1429                                 PEGA_WLAN, RFKILL_TYPE_WLAN);
1430         if(ret)
1431                 goto exit;
1432
1433         ret = pega_rfkill_setup(asus, &asus->bluetooth, "pega-bt",
1434                                 PEGA_BLUETOOTH, RFKILL_TYPE_BLUETOOTH);
1435         if(ret)
1436                 goto exit;
1437
1438         ret = pega_rfkill_setup(asus, &asus->wwan, "pega-wwan",
1439                                 PEGA_WWAN, RFKILL_TYPE_WWAN);
1440
1441 exit:
1442         if (ret)
1443                 asus_rfkill_exit(asus);
1444
1445         return ret;
1446 }
1447
1448 /*
1449  * Input device (i.e. hotkeys)
1450  */
1451 static void asus_input_notify(struct asus_laptop *asus, int event)
1452 {
1453         if (!asus->inputdev)
1454                 return ;
1455         if (!sparse_keymap_report_event(asus->inputdev, event, 1, true))
1456                 pr_info("Unknown key %x pressed\n", event);
1457 }
1458
1459 static int asus_input_init(struct asus_laptop *asus)
1460 {
1461         struct input_dev *input;
1462         int error;
1463
1464         input = input_allocate_device();
1465         if (!input) {
1466                 pr_warn("Unable to allocate input device\n");
1467                 return -ENOMEM;
1468         }
1469         input->name = "Asus Laptop extra buttons";
1470         input->phys = ASUS_LAPTOP_FILE "/input0";
1471         input->id.bustype = BUS_HOST;
1472         input->dev.parent = &asus->platform_device->dev;
1473
1474         error = sparse_keymap_setup(input, asus_keymap, NULL);
1475         if (error) {
1476                 pr_err("Unable to setup input device keymap\n");
1477                 goto err_free_dev;
1478         }
1479         error = input_register_device(input);
1480         if (error) {
1481                 pr_warn("Unable to register input device\n");
1482                 goto err_free_keymap;
1483         }
1484
1485         asus->inputdev = input;
1486         return 0;
1487
1488 err_free_keymap:
1489         sparse_keymap_free(input);
1490 err_free_dev:
1491         input_free_device(input);
1492         return error;
1493 }
1494
1495 static void asus_input_exit(struct asus_laptop *asus)
1496 {
1497         if (asus->inputdev) {
1498                 sparse_keymap_free(asus->inputdev);
1499                 input_unregister_device(asus->inputdev);
1500         }
1501         asus->inputdev = NULL;
1502 }
1503
1504 /*
1505  * ACPI driver
1506  */
1507 static void asus_acpi_notify(struct acpi_device *device, u32 event)
1508 {
1509         struct asus_laptop *asus = acpi_driver_data(device);
1510         u16 count;
1511
1512         /* TODO Find a better way to handle events count. */
1513         count = asus->event_count[event % 128]++;
1514         acpi_bus_generate_proc_event(asus->device, event, count);
1515         acpi_bus_generate_netlink_event(asus->device->pnp.device_class,
1516                                         dev_name(&asus->device->dev), event,
1517                                         count);
1518
1519         /* Brightness events are special */
1520         if (event >= ATKD_BR_MIN && event <= ATKD_BR_MAX) {
1521
1522                 /* Ignore them completely if the acpi video driver is used */
1523                 if (asus->backlight_device != NULL) {
1524                         /* Update the backlight device. */
1525                         asus_backlight_notify(asus);
1526                 }
1527                 return ;
1528         }
1529
1530         /* Accelerometer "coarse orientation change" event */
1531         if (asus->pega_accel_poll && event == 0xEA) {
1532                 kobject_uevent(&asus->pega_accel_poll->input->dev.kobj,
1533                                KOBJ_CHANGE);
1534                 return ;
1535         }
1536
1537         asus_input_notify(asus, event);
1538 }
1539
1540 static DEVICE_ATTR(infos, S_IRUGO, show_infos, NULL);
1541 static DEVICE_ATTR(wlan, S_IRUGO | S_IWUSR, show_wlan, store_wlan);
1542 static DEVICE_ATTR(bluetooth, S_IRUGO | S_IWUSR,
1543                    show_bluetooth, store_bluetooth);
1544 static DEVICE_ATTR(wimax, S_IRUGO | S_IWUSR, show_wimax, store_wimax);
1545 static DEVICE_ATTR(wwan, S_IRUGO | S_IWUSR, show_wwan, store_wwan);
1546 static DEVICE_ATTR(display, S_IWUSR, NULL, store_disp);
1547 static DEVICE_ATTR(ledd, S_IRUGO | S_IWUSR, show_ledd, store_ledd);
1548 static DEVICE_ATTR(ls_value, S_IRUGO, show_lsvalue, NULL);
1549 static DEVICE_ATTR(ls_level, S_IRUGO | S_IWUSR, show_lslvl, store_lslvl);
1550 static DEVICE_ATTR(ls_switch, S_IRUGO | S_IWUSR, show_lssw, store_lssw);
1551 static DEVICE_ATTR(gps, S_IRUGO | S_IWUSR, show_gps, store_gps);
1552
1553 static struct attribute *asus_attributes[] = {
1554         &dev_attr_infos.attr,
1555         &dev_attr_wlan.attr,
1556         &dev_attr_bluetooth.attr,
1557         &dev_attr_wimax.attr,
1558         &dev_attr_wwan.attr,
1559         &dev_attr_display.attr,
1560         &dev_attr_ledd.attr,
1561         &dev_attr_ls_value.attr,
1562         &dev_attr_ls_level.attr,
1563         &dev_attr_ls_switch.attr,
1564         &dev_attr_gps.attr,
1565         NULL
1566 };
1567
1568 static umode_t asus_sysfs_is_visible(struct kobject *kobj,
1569                                     struct attribute *attr,
1570                                     int idx)
1571 {
1572         struct device *dev = container_of(kobj, struct device, kobj);
1573         struct platform_device *pdev = to_platform_device(dev);
1574         struct asus_laptop *asus = platform_get_drvdata(pdev);
1575         acpi_handle handle = asus->handle;
1576         bool supported;
1577
1578         if (asus->is_pega_lucid) {
1579                 /* no ls_level interface on the Lucid */
1580                 if (attr == &dev_attr_ls_switch.attr)
1581                         supported = true;
1582                 else if (attr == &dev_attr_ls_level.attr)
1583                         supported = false;
1584                 else
1585                         goto normal;
1586
1587                 return supported;
1588         }
1589
1590 normal:
1591         if (attr == &dev_attr_wlan.attr) {
1592                 supported = !acpi_check_handle(handle, METHOD_WLAN, NULL);
1593
1594         } else if (attr == &dev_attr_bluetooth.attr) {
1595                 supported = !acpi_check_handle(handle, METHOD_BLUETOOTH, NULL);
1596
1597         } else if (attr == &dev_attr_display.attr) {
1598                 supported = !acpi_check_handle(handle, METHOD_SWITCH_DISPLAY, NULL);
1599
1600         } else if (attr == &dev_attr_wimax.attr) {
1601                 supported =
1602                         !acpi_check_handle(asus->handle, METHOD_WIMAX, NULL);
1603
1604         } else if (attr == &dev_attr_wwan.attr) {
1605                 supported = !acpi_check_handle(asus->handle, METHOD_WWAN, NULL);
1606
1607         } else if (attr == &dev_attr_ledd.attr) {
1608                 supported = !acpi_check_handle(handle, METHOD_LEDD, NULL);
1609
1610         } else if (attr == &dev_attr_ls_switch.attr ||
1611                    attr == &dev_attr_ls_level.attr) {
1612                 supported = !acpi_check_handle(handle, METHOD_ALS_CONTROL, NULL) &&
1613                         !acpi_check_handle(handle, METHOD_ALS_LEVEL, NULL);
1614         } else if (attr == &dev_attr_ls_value.attr) {
1615                 supported = asus->is_pega_lucid;
1616         } else if (attr == &dev_attr_gps.attr) {
1617                 supported = !acpi_check_handle(handle, METHOD_GPS_ON, NULL) &&
1618                             !acpi_check_handle(handle, METHOD_GPS_OFF, NULL) &&
1619                             !acpi_check_handle(handle, METHOD_GPS_STATUS, NULL);
1620         } else {
1621                 supported = true;
1622         }
1623
1624         return supported ? attr->mode : 0;
1625 }
1626
1627
1628 static const struct attribute_group asus_attr_group = {
1629         .is_visible     = asus_sysfs_is_visible,
1630         .attrs          = asus_attributes,
1631 };
1632
1633 static int asus_platform_init(struct asus_laptop *asus)
1634 {
1635         int result;
1636
1637         asus->platform_device = platform_device_alloc(ASUS_LAPTOP_FILE, -1);
1638         if (!asus->platform_device)
1639                 return -ENOMEM;
1640         platform_set_drvdata(asus->platform_device, asus);
1641
1642         result = platform_device_add(asus->platform_device);
1643         if (result)
1644                 goto fail_platform_device;
1645
1646         result = sysfs_create_group(&asus->platform_device->dev.kobj,
1647                                     &asus_attr_group);
1648         if (result)
1649                 goto fail_sysfs;
1650
1651         return 0;
1652
1653 fail_sysfs:
1654         platform_device_del(asus->platform_device);
1655 fail_platform_device:
1656         platform_device_put(asus->platform_device);
1657         return result;
1658 }
1659
1660 static void asus_platform_exit(struct asus_laptop *asus)
1661 {
1662         sysfs_remove_group(&asus->platform_device->dev.kobj, &asus_attr_group);
1663         platform_device_unregister(asus->platform_device);
1664 }
1665
1666 static struct platform_driver platform_driver = {
1667         .driver = {
1668                 .name = ASUS_LAPTOP_FILE,
1669                 .owner = THIS_MODULE,
1670         },
1671 };
1672
1673 /*
1674  * This function is used to initialize the context with right values. In this
1675  * method, we can make all the detection we want, and modify the asus_laptop
1676  * struct
1677  */
1678 static int asus_laptop_get_info(struct asus_laptop *asus)
1679 {
1680         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1681         union acpi_object *model = NULL;
1682         unsigned long long bsts_result, hwrs_result;
1683         char *string = NULL;
1684         acpi_status status;
1685
1686         /*
1687          * Get DSDT headers early enough to allow for differentiating between
1688          * models, but late enough to allow acpi_bus_register_driver() to fail
1689          * before doing anything ACPI-specific. Should we encounter a machine,
1690          * which needs special handling (i.e. its hotkey device has a different
1691          * HID), this bit will be moved.
1692          */
1693         status = acpi_get_table(ACPI_SIG_DSDT, 1, &asus->dsdt_info);
1694         if (ACPI_FAILURE(status))
1695                 pr_warn("Couldn't get the DSDT table header\n");
1696
1697         /* We have to write 0 on init this far for all ASUS models */
1698         if (write_acpi_int_ret(asus->handle, "INIT", 0, &buffer)) {
1699                 pr_err("Hotkey initialization failed\n");
1700                 return -ENODEV;
1701         }
1702
1703         /* This needs to be called for some laptops to init properly */
1704         status =
1705             acpi_evaluate_integer(asus->handle, "BSTS", NULL, &bsts_result);
1706         if (ACPI_FAILURE(status))
1707                 pr_warn("Error calling BSTS\n");
1708         else if (bsts_result)
1709                 pr_notice("BSTS called, 0x%02x returned\n",
1710                        (uint) bsts_result);
1711
1712         /* This too ... */
1713         if (write_acpi_int(asus->handle, "CWAP", wapf))
1714                 pr_err("Error calling CWAP(%d)\n", wapf);
1715         /*
1716          * Try to match the object returned by INIT to the specific model.
1717          * Handle every possible object (or the lack of thereof) the DSDT
1718          * writers might throw at us. When in trouble, we pass NULL to
1719          * asus_model_match() and try something completely different.
1720          */
1721         if (buffer.pointer) {
1722                 model = buffer.pointer;
1723                 switch (model->type) {
1724                 case ACPI_TYPE_STRING:
1725                         string = model->string.pointer;
1726                         break;
1727                 case ACPI_TYPE_BUFFER:
1728                         string = model->buffer.pointer;
1729                         break;
1730                 default:
1731                         string = "";
1732                         break;
1733                 }
1734         }
1735         asus->name = kstrdup(string, GFP_KERNEL);
1736         if (!asus->name) {
1737                 kfree(buffer.pointer);
1738                 return -ENOMEM;
1739         }
1740
1741         if (*string)
1742                 pr_notice("  %s model detected\n", string);
1743
1744         /*
1745          * The HWRS method return informations about the hardware.
1746          * 0x80 bit is for WLAN, 0x100 for Bluetooth,
1747          * 0x40 for WWAN, 0x10 for WIMAX.
1748          * The significance of others is yet to be found.
1749          */
1750         status =
1751             acpi_evaluate_integer(asus->handle, "HRWS", NULL, &hwrs_result);
1752         if (!ACPI_FAILURE(status))
1753                 pr_notice("  HRWS returned %x", (int)hwrs_result);
1754
1755         if (!acpi_check_handle(asus->handle, METHOD_WL_STATUS, NULL))
1756                 asus->have_rsts = true;
1757
1758         kfree(model);
1759
1760         return AE_OK;
1761 }
1762
1763 static int __devinit asus_acpi_init(struct asus_laptop *asus)
1764 {
1765         int result = 0;
1766
1767         result = acpi_bus_get_status(asus->device);
1768         if (result)
1769                 return result;
1770         if (!asus->device->status.present) {
1771                 pr_err("Hotkey device not present, aborting\n");
1772                 return -ENODEV;
1773         }
1774
1775         result = asus_laptop_get_info(asus);
1776         if (result)
1777                 return result;
1778
1779         if (!strcmp(bled_type, "led"))
1780                 asus->bled_type = TYPE_LED;
1781         else if (!strcmp(bled_type, "rfkill"))
1782                 asus->bled_type = TYPE_RFKILL;
1783
1784         if (!strcmp(wled_type, "led"))
1785                 asus->wled_type = TYPE_LED;
1786         else if (!strcmp(wled_type, "rfkill"))
1787                 asus->wled_type = TYPE_RFKILL;
1788
1789         if (bluetooth_status >= 0)
1790                 asus_bluetooth_set(asus, !!bluetooth_status);
1791
1792         if (wlan_status >= 0)
1793                 asus_wlan_set(asus, !!wlan_status);
1794
1795         if (wimax_status >= 0)
1796                 asus_wimax_set(asus, !!wimax_status);
1797
1798         if (wwan_status >= 0)
1799                 asus_wwan_set(asus, !!wwan_status);
1800
1801         /* Keyboard Backlight is on by default */
1802         if (!acpi_check_handle(asus->handle, METHOD_KBD_LIGHT_SET, NULL))
1803                 asus_kled_set(asus, 1);
1804
1805         /* LED display is off by default */
1806         asus->ledd_status = 0xFFF;
1807
1808         /* Set initial values of light sensor and level */
1809         asus->light_switch = !!als_status;
1810         asus->light_level = 5;  /* level 5 for sensor sensitivity */
1811
1812         if (asus->is_pega_lucid) {
1813                 asus_als_switch(asus, asus->light_switch);
1814         } else if (!acpi_check_handle(asus->handle, METHOD_ALS_CONTROL, NULL) &&
1815                    !acpi_check_handle(asus->handle, METHOD_ALS_LEVEL, NULL)) {
1816                 asus_als_switch(asus, asus->light_switch);
1817                 asus_als_level(asus, asus->light_level);
1818         }
1819
1820         return result;
1821 }
1822
1823 static void __devinit asus_dmi_check(void)
1824 {
1825         const char *model;
1826
1827         model = dmi_get_system_info(DMI_PRODUCT_NAME);
1828         if (!model)
1829                 return;
1830
1831         /* On L1400B WLED control the sound card, don't mess with it ... */
1832         if (strncmp(model, "L1400B", 6) == 0) {
1833                 wlan_status = -1;
1834         }
1835 }
1836
1837 static bool asus_device_present;
1838
1839 static int __devinit asus_acpi_add(struct acpi_device *device)
1840 {
1841         struct asus_laptop *asus;
1842         int result;
1843
1844         pr_notice("Asus Laptop Support version %s\n",
1845                   ASUS_LAPTOP_VERSION);
1846         asus = kzalloc(sizeof(struct asus_laptop), GFP_KERNEL);
1847         if (!asus)
1848                 return -ENOMEM;
1849         asus->handle = device->handle;
1850         strcpy(acpi_device_name(device), ASUS_LAPTOP_DEVICE_NAME);
1851         strcpy(acpi_device_class(device), ASUS_LAPTOP_CLASS);
1852         device->driver_data = asus;
1853         asus->device = device;
1854
1855         asus_dmi_check();
1856
1857         result = asus_acpi_init(asus);
1858         if (result)
1859                 goto fail_platform;
1860
1861         /*
1862          * Need platform type detection first, then the platform
1863          * device.  It is used as a parent for the sub-devices below.
1864          */
1865         asus->is_pega_lucid = asus_check_pega_lucid(asus);
1866         result = asus_platform_init(asus);
1867         if (result)
1868                 goto fail_platform;
1869
1870         if (!acpi_video_backlight_support()) {
1871                 result = asus_backlight_init(asus);
1872                 if (result)
1873                         goto fail_backlight;
1874         } else
1875                 pr_info("Backlight controlled by ACPI video driver\n");
1876
1877         result = asus_input_init(asus);
1878         if (result)
1879                 goto fail_input;
1880
1881         result = asus_led_init(asus);
1882         if (result)
1883                 goto fail_led;
1884
1885         result = asus_rfkill_init(asus);
1886         if (result && result != -ENODEV)
1887                 goto fail_rfkill;
1888
1889         result = pega_accel_init(asus);
1890         if (result && result != -ENODEV)
1891                 goto fail_pega_accel;
1892
1893         result = pega_rfkill_init(asus);
1894         if (result && result != -ENODEV)
1895                 goto fail_pega_rfkill;
1896
1897         asus_device_present = true;
1898         return 0;
1899
1900 fail_pega_rfkill:
1901         pega_accel_exit(asus);
1902 fail_pega_accel:
1903         asus_rfkill_exit(asus);
1904 fail_rfkill:
1905         asus_led_exit(asus);
1906 fail_led:
1907         asus_input_exit(asus);
1908 fail_input:
1909         asus_backlight_exit(asus);
1910 fail_backlight:
1911         asus_platform_exit(asus);
1912 fail_platform:
1913         kfree(asus->name);
1914         kfree(asus);
1915
1916         return result;
1917 }
1918
1919 static int asus_acpi_remove(struct acpi_device *device, int type)
1920 {
1921         struct asus_laptop *asus = acpi_driver_data(device);
1922
1923         asus_backlight_exit(asus);
1924         asus_rfkill_exit(asus);
1925         asus_led_exit(asus);
1926         asus_input_exit(asus);
1927         pega_accel_exit(asus);
1928         asus_platform_exit(asus);
1929
1930         kfree(asus->name);
1931         kfree(asus);
1932         return 0;
1933 }
1934
1935 static const struct acpi_device_id asus_device_ids[] = {
1936         {"ATK0100", 0},
1937         {"ATK0101", 0},
1938         {"", 0},
1939 };
1940 MODULE_DEVICE_TABLE(acpi, asus_device_ids);
1941
1942 static struct acpi_driver asus_acpi_driver = {
1943         .name = ASUS_LAPTOP_NAME,
1944         .class = ASUS_LAPTOP_CLASS,
1945         .owner = THIS_MODULE,
1946         .ids = asus_device_ids,
1947         .flags = ACPI_DRIVER_ALL_NOTIFY_EVENTS,
1948         .ops = {
1949                 .add = asus_acpi_add,
1950                 .remove = asus_acpi_remove,
1951                 .notify = asus_acpi_notify,
1952                 },
1953 };
1954
1955 static int __init asus_laptop_init(void)
1956 {
1957         int result;
1958
1959         result = platform_driver_register(&platform_driver);
1960         if (result < 0)
1961                 return result;
1962
1963         result = acpi_bus_register_driver(&asus_acpi_driver);
1964         if (result < 0)
1965                 goto fail_acpi_driver;
1966         if (!asus_device_present) {
1967                 result = -ENODEV;
1968                 goto fail_no_device;
1969         }
1970         return 0;
1971
1972 fail_no_device:
1973         acpi_bus_unregister_driver(&asus_acpi_driver);
1974 fail_acpi_driver:
1975         platform_driver_unregister(&platform_driver);
1976         return result;
1977 }
1978
1979 static void __exit asus_laptop_exit(void)
1980 {
1981         acpi_bus_unregister_driver(&asus_acpi_driver);
1982         platform_driver_unregister(&platform_driver);
1983 }
1984
1985 module_init(asus_laptop_init);
1986 module_exit(asus_laptop_exit);