git.oblomov.eu Git - linux-2.6/blob - drivers/misc/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 Corentin Chary
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or
  11  *  (at your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  21  *
  22  *
  23  *  The development page for this driver is located at
  24  *  http://sourceforge.net/projects/acpi4asus/
  25  *
  26  *  Credits:
  27  *  Pontus Fuchs   - Helper functions, cleanup
  28  *  Johann Wiesner - Small compile fixes
  29  *  John Belmonte  - ACPI code for Toshiba laptop was a good starting point.
  30  *  Eric Burghard  - LED display support for W1N
  31  *  Josh Green     - Light Sens support
  32  *  Thomas Tuttle  - His first patch for led support was very helpfull
  33  *
  34  */
  35
  36 #include <linux/autoconf.h>
  37 #include <linux/kernel.h>
  38 #include <linux/module.h>
  39 #include <linux/init.h>
  40 #include <linux/types.h>
  41 #include <linux/err.h>
  42 #include <linux/proc_fs.h>
  43 #include <linux/leds.h>
  44 #include <linux/platform_device.h>
  45 #include <acpi/acpi_drivers.h>
  46 #include <acpi/acpi_bus.h>
  47 #include <asm/uaccess.h>
  48
  49 #define ASUS_LAPTOP_VERSION "0.40"
  50
  51 #define ASUS_HOTK_NAME          "Asus Laptop Support"
  52 #define ASUS_HOTK_CLASS         "hotkey"
  53 #define ASUS_HOTK_DEVICE_NAME   "Hotkey"
  54 #define ASUS_HOTK_HID           "ATK0100"
  55 #define ASUS_HOTK_FILE          "asus-laptop"
  56 #define ASUS_HOTK_PREFIX        "\\_SB.ATKD."
  57
  58 /*
  59  * Known bits returned by \_SB.ATKD.HWRS
  60  */
  61 #define WL_HWRS     0x80
  62 #define BT_HWRS     0x100
  63
  64 /*
  65  * Flags for hotk status
  66  * WL_ON and BT_ON are also used for wireless_status()
  67  */
  68 #define WL_ON       0x01        //internal Wifi
  69 #define BT_ON       0x02        //internal Bluetooth
  70 #define MLED_ON     0x04        //mail LED
  71 #define TLED_ON     0x08        //touchpad LED
  72 #define RLED_ON     0x10        //Record LED
  73 #define PLED_ON     0x20        //Phone LED
  74
  75 #define ASUS_LOG    ASUS_HOTK_FILE ": "
  76 #define ASUS_ERR    KERN_ERR    ASUS_LOG
  77 #define ASUS_WARNING    KERN_WARNING    ASUS_LOG
  78 #define ASUS_NOTICE KERN_NOTICE ASUS_LOG
  79 #define ASUS_INFO   KERN_INFO   ASUS_LOG
  80 #define ASUS_DEBUG  KERN_DEBUG  ASUS_LOG
  81
  82 MODULE_AUTHOR("Julien Lerouge, Karol Kozimor, Corentin Chary");
  83 MODULE_DESCRIPTION(ASUS_HOTK_NAME);
  84 MODULE_LICENSE("GPL");
  85
  86 #define ASUS_HANDLE(object, paths...)                                   \
  87         static acpi_handle  object##_handle = NULL;                     \
  88         static char *object##_paths[] = { paths }
  89
  90 /* LED */
  91 ASUS_HANDLE(mled_set, ASUS_HOTK_PREFIX "MLED");
  92 ASUS_HANDLE(tled_set, ASUS_HOTK_PREFIX "TLED");
  93 ASUS_HANDLE(rled_set, ASUS_HOTK_PREFIX "RLED"); /* W1JC */
  94 ASUS_HANDLE(pled_set, ASUS_HOTK_PREFIX "PLED"); /* A7J */
  95
  96 /* Bluetooth and WLAN
  97  * WLED and BLED are not handled like other XLED, because in some dsdt
  98  * they also control the WLAN/Bluetooth device.
  99  */
 100 ASUS_HANDLE(wl_switch, ASUS_HOTK_PREFIX "WLED");
 101 ASUS_HANDLE(bt_switch, ASUS_HOTK_PREFIX "BLED");
 102 ASUS_HANDLE(wireless_status, ASUS_HOTK_PREFIX "RSTS"); /* All new models */
 103
 104 /*
 105  * This is the main structure, we can use it to store anything interesting
 106  * about the hotk device
 107  */
 108 struct asus_hotk {
 109         char *name; //laptop name
 110         struct acpi_device *device;     //the device we are in
 111         acpi_handle handle;     //the handle of the hotk device
 112         char status;            //status of the hotk, for LEDs, ...
 113         u16 event_count[128];   //count for each event TODO make this better
 114 };
 115
 116 /*
 117  * This header is made available to allow proper configuration given model,
 118  * revision number , ... this info cannot go in struct asus_hotk because it is
 119  * available before the hotk
 120  */
 121 static struct acpi_table_header *asus_info;
 122
 123 /* The actual device the driver binds to */
 124 static struct asus_hotk *hotk;
 125
 126 /*
 127  * The hotkey driver declaration
 128  */
 129 static int asus_hotk_add(struct acpi_device *device);
 130 static int asus_hotk_remove(struct acpi_device *device, int type);
 131 static struct acpi_driver asus_hotk_driver = {
 132         .name = ASUS_HOTK_NAME,
 133         .class = ASUS_HOTK_CLASS,
 134         .ids = ASUS_HOTK_HID,
 135         .ops = {
 136                 .add = asus_hotk_add,
 137                 .remove = asus_hotk_remove,
 138                 },
 139 };
 140
 141 /* These functions actually update the LED's, and are called from a
 142  * workqueue. By doing this as separate work rather than when the LED
 143  * subsystem asks, we avoid messing with the Asus ACPI stuff during a
 144  * potentially bad time, such as a timer interrupt. */
 145 static struct workqueue_struct *led_workqueue;
 146
 147 #define ASUS_LED(object, ledname)                                       \
 148         static void object##_led_set(struct led_classdev *led_cdev,     \
 149                                      enum led_brightness value);        \
 150         static void object##_led_update(struct work_struct *ignored);   \
 151         static int object##_led_wk;                                     \
 152         DECLARE_WORK(object##_led_work, object##_led_update);           \
 153         static struct led_classdev object##_led = {                     \
 154                 .name           = "asus:" ledname,                      \
 155                 .brightness_set = object##_led_set,                     \
 156         }
 157
 158 ASUS_LED(mled, "mail");
 159 ASUS_LED(tled, "touchpad");
 160 ASUS_LED(rled, "record");
 161 ASUS_LED(pled, "phone");
 162
 163 /*
 164  * This function evaluates an ACPI method, given an int as parameter, the
 165  * method is searched within the scope of the handle, can be NULL. The output
 166  * of the method is written is output, which can also be NULL
 167  *
 168  * returns 1 if write is successful, 0 else.
 169  */
 170 static int write_acpi_int(acpi_handle handle, const char *method, int val,
 171                           struct acpi_buffer *output)
 172 {
 173         struct acpi_object_list params; //list of input parameters (an int here)
 174         union acpi_object in_obj;       //the only param we use
 175         acpi_status status;
 176
 177         params.count = 1;
 178         params.pointer = &in_obj;
 179         in_obj.type = ACPI_TYPE_INTEGER;
 180         in_obj.integer.value = val;
 181
 182         status = acpi_evaluate_object(handle, (char *)method, &params, output);
 183         return (status == AE_OK);
 184 }
 185
 186 static int read_acpi_int(acpi_handle handle, const char *method, int *val,
 187                          struct acpi_object_list *params)
 188 {
 189         struct acpi_buffer output;
 190         union acpi_object out_obj;
 191         acpi_status status;
 192
 193         output.length = sizeof(out_obj);
 194         output.pointer = &out_obj;
 195
 196         status = acpi_evaluate_object(handle, (char *)method, params, &output);
 197         *val = out_obj.integer.value;
 198         return (status == AE_OK) && (out_obj.type == ACPI_TYPE_INTEGER);
 199 }
 200
 201 static int read_wireless_status(int mask) {
 202         int status;
 203
 204         if (!wireless_status_handle)
 205                 return (hotk->status & mask) ? 1 : 0;
 206
 207         if (read_acpi_int(wireless_status_handle, NULL, &status, NULL)) {
 208                 return (status & mask) ? 1 : 0;
 209         } else
 210                 printk(ASUS_WARNING "Error reading Wireless status\n");
 211
 212         return (hotk->status & mask) ? 1 : 0;
 213 }
 214
 215 /* Generic LED functions */
 216 static int read_status(int mask)
 217 {
 218         /* There is a special method for both wireless devices */
 219         if (mask == BT_ON || mask == WL_ON)
 220                 return read_wireless_status(mask);
 221
 222         return (hotk->status & mask) ? 1 : 0;
 223 }
 224
 225 static void write_status(acpi_handle handle, int out, int mask,
 226                          int invert)
 227 {
 228         hotk->status = (out) ? (hotk->status | mask) : (hotk->status & ~mask);
 229
 230         if (invert)             /* invert target value */
 231                 out = !out & 0x1;
 232
 233         if (handle && !write_acpi_int(handle, NULL, out, NULL))
 234                 printk(ASUS_WARNING " write failed\n");
 235 }
 236
 237 /* /sys/class/led handlers */
 238 #define ASUS_LED_HANDLER(object, mask, invert)                          \
 239         static void object##_led_set(struct led_classdev *led_cdev,     \
 240                                      enum led_brightness value)         \
 241         {                                                               \
 242                 object##_led_wk = value;                                \
 243                 queue_work(led_workqueue, &object##_led_work);          \
 244         }                                                               \
 245         static void object##_led_update(struct work_struct *ignored)    \
 246         {                                                               \
 247                 int value = object##_led_wk;                            \
 248                 write_status(object##_set_handle, value, (mask), (invert)); \
 249         }
 250
 251 ASUS_LED_HANDLER(mled, MLED_ON, 1);
 252 ASUS_LED_HANDLER(pled, PLED_ON, 0);
 253 ASUS_LED_HANDLER(rled, RLED_ON, 0);
 254 ASUS_LED_HANDLER(tled, TLED_ON, 0);
 255
 256 /*
 257  * Platform device handlers
 258  */
 259
 260 /*
 261  * We write our info in page, we begin at offset off and cannot write more
 262  * than count bytes. We set eof to 1 if we handle those 2 values. We return the
 263  * number of bytes written in page
 264  */
 265 static ssize_t show_infos(struct device *dev,
 266                          struct device_attribute *attr, char *page)
 267 {
 268         int len = 0;
 269         int temp;
 270         char buf[16];           //enough for all info
 271         /*
 272          * We use the easy way, we don't care of off and count, so we don't set eof
 273          * to 1
 274          */
 275
 276         len += sprintf(page, ASUS_HOTK_NAME " " ASUS_LAPTOP_VERSION "\n");
 277         len += sprintf(page + len, "Model reference    : %s\n", hotk->name);
 278         /*
 279          * The SFUN method probably allows the original driver to get the list
 280          * of features supported by a given model. For now, 0x0100 or 0x0800
 281          * bit signifies that the laptop is equipped with a Wi-Fi MiniPCI card.
 282          * The significance of others is yet to be found.
 283          */
 284         if (read_acpi_int(hotk->handle, "SFUN", &temp, NULL))
 285                 len +=
 286                     sprintf(page + len, "SFUN value         : 0x%04x\n", temp);
 287         /*
 288          * Another value for userspace: the ASYM method returns 0x02 for
 289          * battery low and 0x04 for battery critical, its readings tend to be
 290          * more accurate than those provided by _BST.
 291          * Note: since not all the laptops provide this method, errors are
 292          * silently ignored.
 293          */
 294         if (read_acpi_int(hotk->handle, "ASYM", &temp, NULL))
 295                 len +=
 296                     sprintf(page + len, "ASYM value         : 0x%04x\n", temp);
 297         if (asus_info) {
 298                 snprintf(buf, 16, "%d", asus_info->length);
 299                 len += sprintf(page + len, "DSDT length        : %s\n", buf);
 300                 snprintf(buf, 16, "%d", asus_info->checksum);
 301                 len += sprintf(page + len, "DSDT checksum      : %s\n", buf);
 302                 snprintf(buf, 16, "%d", asus_info->revision);
 303                 len += sprintf(page + len, "DSDT revision      : %s\n", buf);
 304                 snprintf(buf, 7, "%s", asus_info->oem_id);
 305                 len += sprintf(page + len, "OEM id             : %s\n", buf);
 306                 snprintf(buf, 9, "%s", asus_info->oem_table_id);
 307                 len += sprintf(page + len, "OEM table id       : %s\n", buf);
 308                 snprintf(buf, 16, "%x", asus_info->oem_revision);
 309                 len += sprintf(page + len, "OEM revision       : 0x%s\n", buf);
 310                 snprintf(buf, 5, "%s", asus_info->asl_compiler_id);
 311                 len += sprintf(page + len, "ASL comp vendor id : %s\n", buf);
 312                 snprintf(buf, 16, "%x", asus_info->asl_compiler_revision);
 313                 len += sprintf(page + len, "ASL comp revision  : 0x%s\n", buf);
 314         }
 315
 316         return len;
 317 }
 318
 319 static int parse_arg(const char *buf, unsigned long count, int *val)
 320 {
 321         if (!count)
 322                 return 0;
 323         if (count > 31)
 324                 return -EINVAL;
 325         if (sscanf(buf, "%i", val) != 1)
 326                 return -EINVAL;
 327         return count;
 328 }
 329
 330 static ssize_t store_status(const char *buf, size_t count,
 331                             acpi_handle handle, int mask, int invert)
 332 {
 333         int rv, value;
 334         int out = 0;
 335
 336         rv = parse_arg(buf, count, &value);
 337         if (rv > 0)
 338                 out = value ? 1 : 0;
 339
 340         write_status(handle, out, mask, invert);
 341
 342         return rv;
 343 }
 344
 345 /*
 346  * WLAN
 347  */
 348 static ssize_t show_wlan(struct device *dev,
 349                          struct device_attribute *attr, char *buf)
 350 {
 351         return sprintf(buf, "%d\n", read_status(WL_ON));
 352 }
 353
 354 static ssize_t store_wlan(struct device *dev, struct device_attribute *attr,
 355                           const char *buf, size_t count)
 356 {
 357         return store_status(buf, count, wl_switch_handle, WL_ON, 0);
 358 }
 359
 360 /*
 361  * Bluetooth
 362  */
 363 static ssize_t show_bluetooth(struct device *dev,
 364                               struct device_attribute *attr, char *buf)
 365 {
 366         return sprintf(buf, "%d\n", read_status(BT_ON));
 367 }
 368
 369 static ssize_t store_bluetooth(struct device *dev, struct device_attribute *attr,
 370                                const char *buf, size_t count)
 371 {
 372         return store_status(buf, count, bt_switch_handle, BT_ON, 0);
 373 }
 374
 375 static void asus_hotk_notify(acpi_handle handle, u32 event, void *data)
 376 {
 377         /* TODO Find a better way to handle events count. */
 378         if (!hotk)
 379                 return;
 380
 381         acpi_bus_generate_event(hotk->device, event,
 382                                 hotk->event_count[event % 128]++);
 383
 384         return;
 385 }
 386
 387 #define ASUS_CREATE_DEVICE_ATTR(_name)                                  \
 388         struct device_attribute dev_attr_##_name = {                    \
 389                 .attr = {                                               \
 390                         .name = __stringify(_name),                     \
 391                         .mode = 0,                                      \
 392                         .owner = THIS_MODULE },                         \
 393                 .show   = NULL,                                         \
 394                 .store  = NULL,                                         \
 395         }
 396
 397 #define ASUS_SET_DEVICE_ATTR(_name, _mode, _show, _store)               \
 398         do {                                                            \
 399                 dev_attr_##_name.attr.mode = _mode;                     \
 400                 dev_attr_##_name.show = _show;                          \
 401                 dev_attr_##_name.store = _store;                        \
 402         } while(0)
 403
 404 static ASUS_CREATE_DEVICE_ATTR(infos);
 405 static ASUS_CREATE_DEVICE_ATTR(wlan);
 406 static ASUS_CREATE_DEVICE_ATTR(bluetooth);
 407
 408 static struct attribute *asuspf_attributes[] = {
 409         &dev_attr_infos.attr,
 410         &dev_attr_wlan.attr,
 411         &dev_attr_bluetooth.attr,
 412         NULL
 413 };
 414
 415 static struct attribute_group asuspf_attribute_group = {
 416         .attrs = asuspf_attributes
 417 };
 418
 419 static struct platform_driver asuspf_driver = {
 420         .driver = {
 421                 .name = ASUS_HOTK_FILE,
 422                 .owner = THIS_MODULE,
 423         }
 424 };
 425
 426 static struct platform_device *asuspf_device;
 427
 428
 429 static void asus_hotk_add_fs(void)
 430 {
 431         ASUS_SET_DEVICE_ATTR(infos, 0444, show_infos, NULL);
 432
 433         if (wl_switch_handle)
 434                 ASUS_SET_DEVICE_ATTR(wlan, 0644, show_wlan, store_wlan);
 435
 436         if (bt_switch_handle)
 437                 ASUS_SET_DEVICE_ATTR(bluetooth, 0644,
 438                                      show_bluetooth, store_bluetooth);
 439 }
 440
 441 static int asus_handle_init(char *name, acpi_handle *handle,
 442                             char **paths, int num_paths)
 443 {
 444         int i;
 445         acpi_status status;
 446
 447         for (i = 0; i < num_paths; i++) {
 448                 status = acpi_get_handle(NULL, paths[i], handle);
 449                 if (ACPI_SUCCESS(status))
 450                         return 0;
 451         }
 452
 453         *handle = NULL;
 454         return -ENODEV;
 455 }
 456
 457 #define ASUS_HANDLE_INIT(object)                                        \
 458         asus_handle_init(#object, &object##_handle, object##_paths,     \
 459                          ARRAY_SIZE(object##_paths))
 460
 461
 462 /*
 463  * This function is used to initialize the hotk with right values. In this
 464  * method, we can make all the detection we want, and modify the hotk struct
 465  */
 466 static int asus_hotk_get_info(void)
 467 {
 468         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
 469         struct acpi_buffer dsdt = { ACPI_ALLOCATE_BUFFER, NULL };
 470         union acpi_object *model = NULL;
 471         int bsts_result, hwrs_result;
 472         char *string = NULL;
 473         acpi_status status;
 474
 475         /*
 476          * Get DSDT headers early enough to allow for differentiating between
 477          * models, but late enough to allow acpi_bus_register_driver() to fail
 478          * before doing anything ACPI-specific. Should we encounter a machine,
 479          * which needs special handling (i.e. its hotkey device has a different
 480          * HID), this bit will be moved. A global variable asus_info contains
 481          * the DSDT header.
 482          */
 483         status = acpi_get_table(ACPI_TABLE_ID_DSDT, 1, &dsdt);
 484         if (ACPI_FAILURE(status))
 485                 printk(ASUS_WARNING "Couldn't get the DSDT table header\n");
 486         else
 487                 asus_info = dsdt.pointer;
 488
 489         /* We have to write 0 on init this far for all ASUS models */
 490         if (!write_acpi_int(hotk->handle, "INIT", 0, &buffer)) {
 491                 printk(ASUS_ERR "Hotkey initialization failed\n");
 492                 return -ENODEV;
 493         }
 494
 495         /* This needs to be called for some laptops to init properly */
 496         if (!read_acpi_int(hotk->handle, "BSTS", &bsts_result, NULL))
 497                 printk(ASUS_WARNING "Error calling BSTS\n");
 498         else if (bsts_result)
 499                 printk(ASUS_NOTICE "BSTS called, 0x%02x returned\n",
 500                        bsts_result);
 501
 502         /*
 503          * Try to match the object returned by INIT to the specific model.
 504          * Handle every possible object (or the lack of thereof) the DSDT
 505          * writers might throw at us. When in trouble, we pass NULL to
 506          * asus_model_match() and try something completely different.
 507          */
 508         if (buffer.pointer) {
 509                 model = buffer.pointer;
 510                 switch (model->type) {
 511                 case ACPI_TYPE_STRING:
 512                         string = model->string.pointer;
 513                         break;
 514                 case ACPI_TYPE_BUFFER:
 515                         string = model->buffer.pointer;
 516                         break;
 517                 default:
 518                         string = "";
 519                         break;
 520                 }
 521         }
 522         hotk->name = kstrdup(string, GFP_KERNEL);
 523         if (!hotk->name)
 524                 return -ENOMEM;
 525
 526         if(*string)
 527                 printk(ASUS_NOTICE "  %s model detected\n", string);
 528
 529         ASUS_HANDLE_INIT(mled_set);
 530         ASUS_HANDLE_INIT(tled_set);
 531         ASUS_HANDLE_INIT(rled_set);
 532         ASUS_HANDLE_INIT(pled_set);
 533
 534         /*
 535          * The HWRS method return informations about the hardware.
 536          * 0x80 bit is for WLAN, 0x100 for Bluetooth.
 537          * The significance of others is yet to be found.
 538          * If we don't find the method, we assume the device are present.
 539          */
 540         if (!read_acpi_int(hotk->handle, "HRWS", &hwrs_result, NULL))
 541                 hwrs_result = WL_HWRS | BT_HWRS;
 542
 543         if(hwrs_result & WL_HWRS)
 544                 ASUS_HANDLE_INIT(wl_switch);
 545         if(hwrs_result & BT_HWRS)
 546                 ASUS_HANDLE_INIT(bt_switch);
 547
 548         ASUS_HANDLE_INIT(wireless_status);
 549
 550         kfree(model);
 551
 552         return AE_OK;
 553 }
 554
 555 static int asus_hotk_check(void)
 556 {
 557         int result = 0;
 558
 559         result = acpi_bus_get_status(hotk->device);
 560         if (result)
 561                 return result;
 562
 563         if (hotk->device->status.present) {
 564                 result = asus_hotk_get_info();
 565         } else {
 566                 printk(ASUS_ERR "Hotkey device not present, aborting\n");
 567                 return -EINVAL;
 568         }
 569
 570         return result;
 571 }
 572
 573 static int asus_hotk_found;
 574
 575 static int asus_hotk_add(struct acpi_device *device)
 576 {
 577         acpi_status status = AE_OK;
 578         int result;
 579
 580         if (!device)
 581                 return -EINVAL;
 582
 583         printk(ASUS_NOTICE "Asus Laptop Support version %s\n",
 584                ASUS_LAPTOP_VERSION);
 585
 586         hotk = kmalloc(sizeof(struct asus_hotk), GFP_KERNEL);
 587         if (!hotk)
 588                 return -ENOMEM;
 589         memset(hotk, 0, sizeof(struct asus_hotk));
 590
 591         hotk->handle = device->handle;
 592         strcpy(acpi_device_name(device), ASUS_HOTK_DEVICE_NAME);
 593         strcpy(acpi_device_class(device), ASUS_HOTK_CLASS);
 594         acpi_driver_data(device) = hotk;
 595         hotk->device = device;
 596
 597         result = asus_hotk_check();
 598         if (result)
 599                 goto end;
 600
 601         asus_hotk_add_fs();
 602
 603         /*
 604          * We install the handler, it will receive the hotk in parameter, so, we
 605          * could add other data to the hotk struct
 606          */
 607         status = acpi_install_notify_handler(hotk->handle, ACPI_SYSTEM_NOTIFY,
 608                                              asus_hotk_notify, hotk);
 609         if (ACPI_FAILURE(status))
 610                 printk(ASUS_ERR "Error installing notify handler\n");
 611
 612         asus_hotk_found = 1;
 613
 614         /* WLED and BLED are on by  default */
 615         write_status(bt_switch_handle, 1, BT_ON, 0);
 616         write_status(wl_switch_handle, 1, WL_ON, 0);
 617
 618       end:
 619         if (result) {
 620                 kfree(hotk->name);
 621                 kfree(hotk);
 622         }
 623
 624         return result;
 625 }
 626
 627 static int asus_hotk_remove(struct acpi_device *device, int type)
 628 {
 629         acpi_status status = 0;
 630
 631         if (!device || !acpi_driver_data(device))
 632                 return -EINVAL;
 633
 634         status = acpi_remove_notify_handler(hotk->handle, ACPI_SYSTEM_NOTIFY,
 635                                             asus_hotk_notify);
 636         if (ACPI_FAILURE(status))
 637                 printk(ASUS_ERR "Error removing notify handler\n");
 638
 639         kfree(hotk->name);
 640         kfree(hotk);
 641
 642         return 0;
 643 }
 644
 645 #define  ASUS_LED_UNREGISTER(object)                            \
 646         if(object##_led.class_dev                               \
 647            && !IS_ERR(object##_led.class_dev))                  \
 648                 led_classdev_unregister(&object##_led)
 649
 650 static void asus_led_exit(void)
 651 {
 652         ASUS_LED_UNREGISTER(mled);
 653         ASUS_LED_UNREGISTER(tled);
 654         ASUS_LED_UNREGISTER(pled);
 655         ASUS_LED_UNREGISTER(rled);
 656
 657         destroy_workqueue(led_workqueue);
 658 }
 659
 660 static void __exit asus_laptop_exit(void)
 661 {
 662         asus_led_exit();
 663
 664         acpi_bus_unregister_driver(&asus_hotk_driver);
 665         sysfs_remove_group(&asuspf_device->dev.kobj, &asuspf_attribute_group);
 666         platform_device_unregister(asuspf_device);
 667         platform_driver_unregister(&asuspf_driver);
 668
 669         kfree(asus_info);
 670 }
 671
 672 static int asus_led_register(acpi_handle handle,
 673                              struct led_classdev * ldev,
 674                              struct device * dev)
 675 {
 676         if(!handle)
 677                 return 0;
 678
 679         return led_classdev_register(dev, ldev);
 680 }
 681 #define ASUS_LED_REGISTER(object, device)                               \
 682         asus_led_register(object##_set_handle, &object##_led, device)
 683
 684 static int asus_led_init(struct device * dev)
 685 {
 686         int rv;
 687
 688         rv = ASUS_LED_REGISTER(mled, dev);
 689         if(rv)
 690                 return rv;
 691
 692         rv = ASUS_LED_REGISTER(tled, dev);
 693         if(rv)
 694                 return rv;
 695
 696         rv = ASUS_LED_REGISTER(rled, dev);
 697         if(rv)
 698                 return rv;
 699
 700         rv = ASUS_LED_REGISTER(pled, dev);
 701         if(rv)
 702                 return rv;
 703
 704         led_workqueue = create_singlethread_workqueue("led_workqueue");
 705         if(!led_workqueue)
 706                 return -ENOMEM;
 707
 708         return 0;
 709 }
 710
 711 static int __init asus_laptop_init(void)
 712 {
 713         struct device *dev;
 714         int result;
 715
 716         if (acpi_disabled)
 717                 return -ENODEV;
 718
 719         if (!acpi_specific_hotkey_enabled) {
 720                 printk(ASUS_ERR "Using generic hotkey driver\n");
 721                 return -ENODEV;
 722         }
 723
 724         result = acpi_bus_register_driver(&asus_hotk_driver);
 725         if (result < 0)
 726                 return result;
 727
 728         /*
 729          * This is a bit of a kludge.  We only want this module loaded
 730          * for ASUS systems, but there's currently no way to probe the
 731          * ACPI namespace for ASUS HIDs.  So we just return failure if
 732          * we didn't find one, which will cause the module to be
 733          * unloaded.
 734          */
 735         if (!asus_hotk_found) {
 736                 acpi_bus_unregister_driver(&asus_hotk_driver);
 737                 return -ENODEV;
 738         }
 739
 740         dev = acpi_get_physical_device(hotk->device->handle);
 741
 742         result = asus_led_init(dev);
 743         if(result)
 744                 goto fail_led;
 745
 746         /* Register platform stuff */
 747         result = platform_driver_register(&asuspf_driver);
 748         if (result)
 749                 goto fail_platform_driver;
 750
 751         asuspf_device = platform_device_alloc(ASUS_HOTK_FILE, -1);
 752         if (!asuspf_device) {
 753                 result = -ENOMEM;
 754                 goto fail_platform_device1;
 755         }
 756
 757         result = platform_device_add(asuspf_device);
 758         if (result)
 759                 goto fail_platform_device2;
 760
 761         result = sysfs_create_group(&asuspf_device->dev.kobj,
 762                                     &asuspf_attribute_group);
 763         if (result)
 764                 goto fail_sysfs;
 765
 766         return 0;
 767
 768 fail_sysfs:
 769         platform_device_del(asuspf_device);
 770
 771 fail_platform_device2:
 772         platform_device_put(asuspf_device);
 773
 774 fail_platform_device1:
 775         platform_driver_unregister(&asuspf_driver);
 776
 777 fail_platform_driver:
 778         asus_led_exit();
 779
 780 fail_led:
 781
 782         return result;
 783 }
 784
 785 module_init(asus_laptop_init);
 786 module_exit(asus_laptop_exit);