err.no Git - linux-2.6/blob - drivers/acpi/video.c

   1 /*
   2  *  video.c - ACPI Video Driver ($Revision:$)
   3  *
   4  *  Copyright (C) 2004 Luming Yu <luming.yu@intel.com>
   5  *  Copyright (C) 2004 Bruno Ducrot <ducrot@poupinou.org>
   6  *  Copyright (C) 2006 Thomas Tuttle <linux-kernel@ttuttle.net>
   7  *
   8  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
   9  *
  10  *  This program is free software; you can redistribute it and/or modify
  11  *  it under the terms of the GNU General Public License as published by
  12  *  the Free Software Foundation; either version 2 of the License, or (at
  13  *  your option) any later version.
  14  *
  15  *  This program is distributed in the hope that it will be useful, but
  16  *  WITHOUT ANY WARRANTY; without even the implied warranty of
  17  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  18  *  General Public License for more details.
  19  *
  20  *  You should have received a copy of the GNU General Public License along
  21  *  with this program; if not, write to the Free Software Foundation, Inc.,
  22  *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  23  *
  24  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  25  */
  26
  27 #include <linux/kernel.h>
  28 #include <linux/module.h>
  29 #include <linux/init.h>
  30 #include <linux/types.h>
  31 #include <linux/list.h>
  32 #include <linux/mutex.h>
  33 #include <linux/proc_fs.h>
  34 #include <linux/seq_file.h>
  35 #include <linux/input.h>
  36 #include <linux/backlight.h>
  37 #include <linux/thermal.h>
  38 #include <linux/video_output.h>
  39 #include <asm/uaccess.h>
  40
  41 #include <acpi/acpi_bus.h>
  42 #include <acpi/acpi_drivers.h>
  43
  44 #define ACPI_VIDEO_COMPONENT            0x08000000
  45 #define ACPI_VIDEO_CLASS                "video"
  46 #define ACPI_VIDEO_BUS_NAME             "Video Bus"
  47 #define ACPI_VIDEO_DEVICE_NAME          "Video Device"
  48 #define ACPI_VIDEO_NOTIFY_SWITCH        0x80
  49 #define ACPI_VIDEO_NOTIFY_PROBE         0x81
  50 #define ACPI_VIDEO_NOTIFY_CYCLE         0x82
  51 #define ACPI_VIDEO_NOTIFY_NEXT_OUTPUT   0x83
  52 #define ACPI_VIDEO_NOTIFY_PREV_OUTPUT   0x84
  53
  54 #define ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS      0x85
  55 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS        0x86
  56 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS        0x87
  57 #define ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS       0x88
  58 #define ACPI_VIDEO_NOTIFY_DISPLAY_OFF           0x89
  59
  60 #define ACPI_VIDEO_HEAD_INVALID         (~0u - 1)
  61 #define ACPI_VIDEO_HEAD_END             (~0u)
  62 #define MAX_NAME_LEN    20
  63
  64 #define ACPI_VIDEO_DISPLAY_CRT  1
  65 #define ACPI_VIDEO_DISPLAY_TV   2
  66 #define ACPI_VIDEO_DISPLAY_DVI  3
  67 #define ACPI_VIDEO_DISPLAY_LCD  4
  68
  69 #define _COMPONENT              ACPI_VIDEO_COMPONENT
  70 ACPI_MODULE_NAME("video");
  71
  72 MODULE_AUTHOR("Bruno Ducrot");
  73 MODULE_DESCRIPTION("ACPI Video Driver");
  74 MODULE_LICENSE("GPL");
  75
  76 static int brightness_switch_enabled = 1;
  77 module_param(brightness_switch_enabled, bool, 0644);
  78
  79 static int acpi_video_bus_add(struct acpi_device *device);
  80 static int acpi_video_bus_remove(struct acpi_device *device, int type);
  81 static int acpi_video_resume(struct acpi_device *device);
  82
  83 static const struct acpi_device_id video_device_ids[] = {
  84         {ACPI_VIDEO_HID, 0},
  85         {"", 0},
  86 };
  87 MODULE_DEVICE_TABLE(acpi, video_device_ids);
  88
  89 static struct acpi_driver acpi_video_bus = {
  90         .name = "video",
  91         .class = ACPI_VIDEO_CLASS,
  92         .ids = video_device_ids,
  93         .ops = {
  94                 .add = acpi_video_bus_add,
  95                 .remove = acpi_video_bus_remove,
  96                 .resume = acpi_video_resume,
  97                 },
  98 };
  99
 100 struct acpi_video_bus_flags {
 101         u8 multihead:1;         /* can switch video heads */
 102         u8 rom:1;               /* can retrieve a video rom */
 103         u8 post:1;              /* can configure the head to */
 104         u8 reserved:5;
 105 };
 106
 107 struct acpi_video_bus_cap {
 108         u8 _DOS:1;              /*Enable/Disable output switching */
 109         u8 _DOD:1;              /*Enumerate all devices attached to display adapter */
 110         u8 _ROM:1;              /*Get ROM Data */
 111         u8 _GPD:1;              /*Get POST Device */
 112         u8 _SPD:1;              /*Set POST Device */
 113         u8 _VPO:1;              /*Video POST Options */
 114         u8 reserved:2;
 115 };
 116
 117 struct acpi_video_device_attrib {
 118         u32 display_index:4;    /* A zero-based instance of the Display */
 119         u32 display_port_attachment:4;  /*This field differentiates the display type */
 120         u32 display_type:4;     /*Describe the specific type in use */
 121         u32 vendor_specific:4;  /*Chipset Vendor Specific */
 122         u32 bios_can_detect:1;  /*BIOS can detect the device */
 123         u32 depend_on_vga:1;    /*Non-VGA output device whose power is related to
 124                                    the VGA device. */
 125         u32 pipe_id:3;          /*For VGA multiple-head devices. */
 126         u32 reserved:10;        /*Must be 0 */
 127         u32 device_id_scheme:1; /*Device ID Scheme */
 128 };
 129
 130 struct acpi_video_enumerated_device {
 131         union {
 132                 u32 int_val;
 133                 struct acpi_video_device_attrib attrib;
 134         } value;
 135         struct acpi_video_device *bind_info;
 136 };
 137
 138 struct acpi_video_bus {
 139         struct acpi_device *device;
 140         u8 dos_setting;
 141         struct acpi_video_enumerated_device *attached_array;
 142         u8 attached_count;
 143         struct acpi_video_bus_cap cap;
 144         struct acpi_video_bus_flags flags;
 145         struct list_head video_device_list;
 146         struct mutex device_list_lock;  /* protects video_device_list */
 147         struct proc_dir_entry *dir;
 148         struct input_dev *input;
 149         char phys[32];  /* for input device */
 150 };
 151
 152 struct acpi_video_device_flags {
 153         u8 crt:1;
 154         u8 lcd:1;
 155         u8 tvout:1;
 156         u8 dvi:1;
 157         u8 bios:1;
 158         u8 unknown:1;
 159         u8 reserved:2;
 160 };
 161
 162 struct acpi_video_device_cap {
 163         u8 _ADR:1;              /*Return the unique ID */
 164         u8 _BCL:1;              /*Query list of brightness control levels supported */
 165         u8 _BCM:1;              /*Set the brightness level */
 166         u8 _BQC:1;              /* Get current brightness level */
 167         u8 _DDC:1;              /*Return the EDID for this device */
 168         u8 _DCS:1;              /*Return status of output device */
 169         u8 _DGS:1;              /*Query graphics state */
 170         u8 _DSS:1;              /*Device state set */
 171 };
 172
 173 struct acpi_video_device_brightness {
 174         int curr;
 175         int count;
 176         int *levels;
 177 };
 178
 179 struct acpi_video_device {
 180         unsigned long device_id;
 181         struct acpi_video_device_flags flags;
 182         struct acpi_video_device_cap cap;
 183         struct list_head entry;
 184         struct acpi_video_bus *video;
 185         struct acpi_device *dev;
 186         struct acpi_video_device_brightness *brightness;
 187         struct backlight_device *backlight;
 188         struct thermal_cooling_device *cdev;
 189         struct output_device *output_dev;
 190 };
 191
 192 /* bus */
 193 static int acpi_video_bus_info_open_fs(struct inode *inode, struct file *file);
 194 static struct file_operations acpi_video_bus_info_fops = {
 195         .owner = THIS_MODULE,
 196         .open = acpi_video_bus_info_open_fs,
 197         .read = seq_read,
 198         .llseek = seq_lseek,
 199         .release = single_release,
 200 };
 201
 202 static int acpi_video_bus_ROM_open_fs(struct inode *inode, struct file *file);
 203 static struct file_operations acpi_video_bus_ROM_fops = {
 204         .owner = THIS_MODULE,
 205         .open = acpi_video_bus_ROM_open_fs,
 206         .read = seq_read,
 207         .llseek = seq_lseek,
 208         .release = single_release,
 209 };
 210
 211 static int acpi_video_bus_POST_info_open_fs(struct inode *inode,
 212                                             struct file *file);
 213 static struct file_operations acpi_video_bus_POST_info_fops = {
 214         .owner = THIS_MODULE,
 215         .open = acpi_video_bus_POST_info_open_fs,
 216         .read = seq_read,
 217         .llseek = seq_lseek,
 218         .release = single_release,
 219 };
 220
 221 static int acpi_video_bus_POST_open_fs(struct inode *inode, struct file *file);
 222 static struct file_operations acpi_video_bus_POST_fops = {
 223         .owner = THIS_MODULE,
 224         .open = acpi_video_bus_POST_open_fs,
 225         .read = seq_read,
 226         .llseek = seq_lseek,
 227         .release = single_release,
 228 };
 229
 230 static int acpi_video_bus_DOS_open_fs(struct inode *inode, struct file *file);
 231 static struct file_operations acpi_video_bus_DOS_fops = {
 232         .owner = THIS_MODULE,
 233         .open = acpi_video_bus_DOS_open_fs,
 234         .read = seq_read,
 235         .llseek = seq_lseek,
 236         .release = single_release,
 237 };
 238
 239 /* device */
 240 static int acpi_video_device_info_open_fs(struct inode *inode,
 241                                           struct file *file);
 242 static struct file_operations acpi_video_device_info_fops = {
 243         .owner = THIS_MODULE,
 244         .open = acpi_video_device_info_open_fs,
 245         .read = seq_read,
 246         .llseek = seq_lseek,
 247         .release = single_release,
 248 };
 249
 250 static int acpi_video_device_state_open_fs(struct inode *inode,
 251                                            struct file *file);
 252 static struct file_operations acpi_video_device_state_fops = {
 253         .owner = THIS_MODULE,
 254         .open = acpi_video_device_state_open_fs,
 255         .read = seq_read,
 256         .llseek = seq_lseek,
 257         .release = single_release,
 258 };
 259
 260 static int acpi_video_device_brightness_open_fs(struct inode *inode,
 261                                                 struct file *file);
 262 static struct file_operations acpi_video_device_brightness_fops = {
 263         .owner = THIS_MODULE,
 264         .open = acpi_video_device_brightness_open_fs,
 265         .read = seq_read,
 266         .llseek = seq_lseek,
 267         .release = single_release,
 268 };
 269
 270 static int acpi_video_device_EDID_open_fs(struct inode *inode,
 271                                           struct file *file);
 272 static struct file_operations acpi_video_device_EDID_fops = {
 273         .owner = THIS_MODULE,
 274         .open = acpi_video_device_EDID_open_fs,
 275         .read = seq_read,
 276         .llseek = seq_lseek,
 277         .release = single_release,
 278 };
 279
 280 static char device_decode[][30] = {
 281         "motherboard VGA device",
 282         "PCI VGA device",
 283         "AGP VGA device",
 284         "UNKNOWN",
 285 };
 286
 287 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data);
 288 static void acpi_video_device_rebind(struct acpi_video_bus *video);
 289 static void acpi_video_device_bind(struct acpi_video_bus *video,
 290                                    struct acpi_video_device *device);
 291 static int acpi_video_device_enumerate(struct acpi_video_bus *video);
 292 static int acpi_video_device_lcd_set_level(struct acpi_video_device *device,
 293                         int level);
 294 static int acpi_video_device_lcd_get_level_current(
 295                         struct acpi_video_device *device,
 296                         unsigned long *level);
 297 static int acpi_video_get_next_level(struct acpi_video_device *device,
 298                                      u32 level_current, u32 event);
 299 static void acpi_video_switch_brightness(struct acpi_video_device *device,
 300                                          int event);
 301 static int acpi_video_device_get_state(struct acpi_video_device *device,
 302                             unsigned long *state);
 303 static int acpi_video_output_get(struct output_device *od);
 304 static int acpi_video_device_set_state(struct acpi_video_device *device, int state);
 305
 306 /*backlight device sysfs support*/
 307 static int acpi_video_get_brightness(struct backlight_device *bd)
 308 {
 309         unsigned long cur_level;
 310         int i;
 311         struct acpi_video_device *vd =
 312                 (struct acpi_video_device *)bl_get_data(bd);
 313         acpi_video_device_lcd_get_level_current(vd, &cur_level);
 314         for (i = 2; i < vd->brightness->count; i++) {
 315                 if (vd->brightness->levels[i] == cur_level)
 316                         /* The first two entries are special - see page 575
 317                            of the ACPI spec 3.0 */
 318                         return i-2;
 319         }
 320         return 0;
 321 }
 322
 323 static int acpi_video_set_brightness(struct backlight_device *bd)
 324 {
 325         int request_level = bd->props.brightness+2;
 326         struct acpi_video_device *vd =
 327                 (struct acpi_video_device *)bl_get_data(bd);
 328         acpi_video_device_lcd_set_level(vd,
 329                                         vd->brightness->levels[request_level]);
 330         return 0;
 331 }
 332
 333 static struct backlight_ops acpi_backlight_ops = {
 334         .get_brightness = acpi_video_get_brightness,
 335         .update_status  = acpi_video_set_brightness,
 336 };
 337
 338 /*video output device sysfs support*/
 339 static int acpi_video_output_get(struct output_device *od)
 340 {
 341         unsigned long state;
 342         struct acpi_video_device *vd =
 343                 (struct acpi_video_device *)dev_get_drvdata(&od->dev);
 344         acpi_video_device_get_state(vd, &state);
 345         return (int)state;
 346 }
 347
 348 static int acpi_video_output_set(struct output_device *od)
 349 {
 350         unsigned long state = od->request_state;
 351         struct acpi_video_device *vd=
 352                 (struct acpi_video_device *)dev_get_drvdata(&od->dev);
 353         return acpi_video_device_set_state(vd, state);
 354 }
 355
 356 static struct output_properties acpi_output_properties = {
 357         .set_state = acpi_video_output_set,
 358         .get_status = acpi_video_output_get,
 359 };
 360
 361
 362 /* thermal cooling device callbacks */
 363 static int video_get_max_state(struct thermal_cooling_device *cdev, char *buf)
 364 {
 365         struct acpi_device *device = cdev->devdata;
 366         struct acpi_video_device *video = acpi_driver_data(device);
 367
 368         return sprintf(buf, "%d\n", video->brightness->count - 3);
 369 }
 370
 371 static int video_get_cur_state(struct thermal_cooling_device *cdev, char *buf)
 372 {
 373         struct acpi_device *device = cdev->devdata;
 374         struct acpi_video_device *video = acpi_driver_data(device);
 375         unsigned long level;
 376         int state;
 377
 378         acpi_video_device_lcd_get_level_current(video, &level);
 379         for (state = 2; state < video->brightness->count; state++)
 380                 if (level == video->brightness->levels[state])
 381                         return sprintf(buf, "%d\n",
 382                                        video->brightness->count - state - 1);
 383
 384         return -EINVAL;
 385 }
 386
 387 static int
 388 video_set_cur_state(struct thermal_cooling_device *cdev, unsigned int state)
 389 {
 390         struct acpi_device *device = cdev->devdata;
 391         struct acpi_video_device *video = acpi_driver_data(device);
 392         int level;
 393
 394         if ( state >= video->brightness->count - 2)
 395                 return -EINVAL;
 396
 397         state = video->brightness->count - state;
 398         level = video->brightness->levels[state -1];
 399         return acpi_video_device_lcd_set_level(video, level);
 400 }
 401
 402 static struct thermal_cooling_device_ops video_cooling_ops = {
 403         .get_max_state = video_get_max_state,
 404         .get_cur_state = video_get_cur_state,
 405         .set_cur_state = video_set_cur_state,
 406 };
 407
 408 /* --------------------------------------------------------------------------
 409                                Video Management
 410    -------------------------------------------------------------------------- */
 411
 412 /* device */
 413
 414 static int
 415 acpi_video_device_query(struct acpi_video_device *device, unsigned long *state)
 416 {
 417         int status;
 418
 419         status = acpi_evaluate_integer(device->dev->handle, "_DGS", NULL, state);
 420
 421         return status;
 422 }
 423
 424 static int
 425 acpi_video_device_get_state(struct acpi_video_device *device,
 426                             unsigned long *state)
 427 {
 428         int status;
 429
 430         status = acpi_evaluate_integer(device->dev->handle, "_DCS", NULL, state);
 431
 432         return status;
 433 }
 434
 435 static int
 436 acpi_video_device_set_state(struct acpi_video_device *device, int state)
 437 {
 438         int status;
 439         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 440         struct acpi_object_list args = { 1, &arg0 };
 441         unsigned long ret;
 442
 443
 444         arg0.integer.value = state;
 445         status = acpi_evaluate_integer(device->dev->handle, "_DSS", &args, &ret);
 446
 447         return status;
 448 }
 449
 450 static int
 451 acpi_video_device_lcd_query_levels(struct acpi_video_device *device,
 452                                    union acpi_object **levels)
 453 {
 454         int status;
 455         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
 456         union acpi_object *obj;
 457
 458
 459         *levels = NULL;
 460
 461         status = acpi_evaluate_object(device->dev->handle, "_BCL", NULL, &buffer);
 462         if (!ACPI_SUCCESS(status))
 463                 return status;
 464         obj = (union acpi_object *)buffer.pointer;
 465         if (!obj || (obj->type != ACPI_TYPE_PACKAGE)) {
 466                 printk(KERN_ERR PREFIX "Invalid _BCL data\n");
 467                 status = -EFAULT;
 468                 goto err;
 469         }
 470
 471         *levels = obj;
 472
 473         return 0;
 474
 475       err:
 476         kfree(buffer.pointer);
 477
 478         return status;
 479 }
 480
 481 static int
 482 acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
 483 {
 484         int status = AE_OK;
 485         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 486         struct acpi_object_list args = { 1, &arg0 };
 487
 488
 489         arg0.integer.value = level;
 490
 491         if (device->cap._BCM)
 492                 status = acpi_evaluate_object(device->dev->handle, "_BCM",
 493                                               &args, NULL);
 494         device->brightness->curr = level;
 495         return status;
 496 }
 497
 498 static int
 499 acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
 500                                         unsigned long *level)
 501 {
 502         if (device->cap._BQC)
 503                 return acpi_evaluate_integer(device->dev->handle, "_BQC", NULL,
 504                                              level);
 505         *level = device->brightness->curr;
 506         return AE_OK;
 507 }
 508
 509 static int
 510 acpi_video_device_EDID(struct acpi_video_device *device,
 511                        union acpi_object **edid, ssize_t length)
 512 {
 513         int status;
 514         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
 515         union acpi_object *obj;
 516         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 517         struct acpi_object_list args = { 1, &arg0 };
 518
 519
 520         *edid = NULL;
 521
 522         if (!device)
 523                 return -ENODEV;
 524         if (length == 128)
 525                 arg0.integer.value = 1;
 526         else if (length == 256)
 527                 arg0.integer.value = 2;
 528         else
 529                 return -EINVAL;
 530
 531         status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
 532         if (ACPI_FAILURE(status))
 533                 return -ENODEV;
 534
 535         obj = buffer.pointer;
 536
 537         if (obj && obj->type == ACPI_TYPE_BUFFER)
 538                 *edid = obj;
 539         else {
 540                 printk(KERN_ERR PREFIX "Invalid _DDC data\n");
 541                 status = -EFAULT;
 542                 kfree(obj);
 543         }
 544
 545         return status;
 546 }
 547
 548 /* bus */
 549
 550 static int
 551 acpi_video_bus_set_POST(struct acpi_video_bus *video, unsigned long option)
 552 {
 553         int status;
 554         unsigned long tmp;
 555         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 556         struct acpi_object_list args = { 1, &arg0 };
 557
 558
 559         arg0.integer.value = option;
 560
 561         status = acpi_evaluate_integer(video->device->handle, "_SPD", &args, &tmp);
 562         if (ACPI_SUCCESS(status))
 563                 status = tmp ? (-EINVAL) : (AE_OK);
 564
 565         return status;
 566 }
 567
 568 static int
 569 acpi_video_bus_get_POST(struct acpi_video_bus *video, unsigned long *id)
 570 {
 571         int status;
 572
 573         status = acpi_evaluate_integer(video->device->handle, "_GPD", NULL, id);
 574
 575         return status;
 576 }
 577
 578 static int
 579 acpi_video_bus_POST_options(struct acpi_video_bus *video,
 580                             unsigned long *options)
 581 {
 582         int status;
 583
 584         status = acpi_evaluate_integer(video->device->handle, "_VPO", NULL, options);
 585         *options &= 3;
 586
 587         return status;
 588 }
 589
 590 /*
 591  *  Arg:
 592  *      video           : video bus device pointer
 593  *      bios_flag       :
 594  *              0.      The system BIOS should NOT automatically switch(toggle)
 595  *                      the active display output.
 596  *              1.      The system BIOS should automatically switch (toggle) the
 597  *                      active display output. No switch event.
 598  *              2.      The _DGS value should be locked.
 599  *              3.      The system BIOS should not automatically switch (toggle) the
 600  *                      active display output, but instead generate the display switch
 601  *                      event notify code.
 602  *      lcd_flag        :
 603  *              0.      The system BIOS should automatically control the brightness level
 604  *                      of the LCD when the power changes from AC to DC
 605  *              1.      The system BIOS should NOT automatically control the brightness
 606  *                      level of the LCD when the power changes from AC to DC.
 607  * Return Value:
 608  *              -1      wrong arg.
 609  */
 610
 611 static int
 612 acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
 613 {
 614         acpi_integer status = 0;
 615         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 616         struct acpi_object_list args = { 1, &arg0 };
 617
 618
 619         if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1) {
 620                 status = -1;
 621                 goto Failed;
 622         }
 623         arg0.integer.value = (lcd_flag << 2) | bios_flag;
 624         video->dos_setting = arg0.integer.value;
 625         acpi_evaluate_object(video->device->handle, "_DOS", &args, NULL);
 626
 627       Failed:
 628         return status;
 629 }
 630
 631 /*
 632  *  Arg:
 633  *      device  : video output device (LCD, CRT, ..)
 634  *
 635  *  Return Value:
 636  *      None
 637  *
 638  *  Find out all required AML methods defined under the output
 639  *  device.
 640  */
 641
 642 static void acpi_video_device_find_cap(struct acpi_video_device *device)
 643 {
 644         acpi_handle h_dummy1;
 645         int i;
 646         u32 max_level = 0;
 647         union acpi_object *obj = NULL;
 648         struct acpi_video_device_brightness *br = NULL;
 649
 650
 651         memset(&device->cap, 0, sizeof(device->cap));
 652
 653         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
 654                 device->cap._ADR = 1;
 655         }
 656         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
 657                 device->cap._BCL = 1;
 658         }
 659         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
 660                 device->cap._BCM = 1;
 661         }
 662         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
 663                 device->cap._BQC = 1;
 664         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
 665                 device->cap._DDC = 1;
 666         }
 667         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DCS", &h_dummy1))) {
 668                 device->cap._DCS = 1;
 669         }
 670         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DGS", &h_dummy1))) {
 671                 device->cap._DGS = 1;
 672         }
 673         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DSS", &h_dummy1))) {
 674                 device->cap._DSS = 1;
 675         }
 676
 677         if (ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
 678
 679                 if (obj->package.count >= 2) {
 680                         int count = 0;
 681                         union acpi_object *o;
 682
 683                         br = kzalloc(sizeof(*br), GFP_KERNEL);
 684                         if (!br) {
 685                                 printk(KERN_ERR "can't allocate memory\n");
 686                         } else {
 687                                 br->levels = kmalloc(obj->package.count *
 688                                                      sizeof *(br->levels), GFP_KERNEL);
 689                                 if (!br->levels)
 690                                         goto out;
 691
 692                                 for (i = 0; i < obj->package.count; i++) {
 693                                         o = (union acpi_object *)&obj->package.
 694                                             elements[i];
 695                                         if (o->type != ACPI_TYPE_INTEGER) {
 696                                                 printk(KERN_ERR PREFIX "Invalid data\n");
 697                                                 continue;
 698                                         }
 699                                         br->levels[count] = (u32) o->integer.value;
 700
 701                                         if (br->levels[count] > max_level)
 702                                                 max_level = br->levels[count];
 703                                         count++;
 704                                 }
 705                               out:
 706                                 if (count < 2) {
 707                                         kfree(br->levels);
 708                                         kfree(br);
 709                                 } else {
 710                                         br->count = count;
 711                                         device->brightness = br;
 712                                         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 713                                                           "found %d brightness levels\n",
 714                                                           count));
 715                                 }
 716                         }
 717                 }
 718
 719         } else {
 720                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available LCD brightness level\n"));
 721         }
 722
 723         kfree(obj);
 724
 725         if (device->cap._BCL && device->cap._BCM && device->cap._BQC && max_level > 0){
 726                 int result;
 727                 static int count = 0;
 728                 char *name;
 729                 name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
 730                 if (!name)
 731                         return;
 732
 733                 sprintf(name, "acpi_video%d", count++);
 734                 device->backlight = backlight_device_register(name,
 735                         NULL, device, &acpi_backlight_ops);
 736                 device->backlight->props.max_brightness = device->brightness->count-3;
 737                 device->backlight->props.brightness = acpi_video_get_brightness(device->backlight);
 738                 backlight_update_status(device->backlight);
 739                 kfree(name);
 740
 741                 device->cdev = thermal_cooling_device_register("LCD",
 742                                         device->dev, &video_cooling_ops);
 743                 if (IS_ERR(device->cdev))
 744                         return;
 745
 746                 if (device->cdev) {
 747                         printk(KERN_INFO PREFIX
 748                                 "%s is registered as cooling_device%d\n",
 749                                 device->dev->dev.bus_id, device->cdev->id);
 750                         result = sysfs_create_link(&device->dev->dev.kobj,
 751                                           &device->cdev->device.kobj,
 752                                           "thermal_cooling");
 753                         if (result)
 754                                 printk(KERN_ERR PREFIX "Create sysfs link\n");
 755                         result = sysfs_create_link(&device->cdev->device.kobj,
 756                                           &device->dev->dev.kobj,
 757                                           "device");
 758                         if (result)
 759                                 printk(KERN_ERR PREFIX "Create sysfs link\n");
 760                 }
 761         }
 762         if (device->cap._DCS && device->cap._DSS){
 763                 static int count = 0;
 764                 char *name;
 765                 name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
 766                 if (!name)
 767                         return;
 768                 sprintf(name, "acpi_video%d", count++);
 769                 device->output_dev = video_output_register(name,
 770                                 NULL, device, &acpi_output_properties);
 771                 kfree(name);
 772         }
 773         return;
 774 }
 775
 776 /*
 777  *  Arg:
 778  *      device  : video output device (VGA)
 779  *
 780  *  Return Value:
 781  *      None
 782  *
 783  *  Find out all required AML methods defined under the video bus device.
 784  */
 785
 786 static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
 787 {
 788         acpi_handle h_dummy1;
 789
 790         memset(&video->cap, 0, sizeof(video->cap));
 791         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
 792                 video->cap._DOS = 1;
 793         }
 794         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
 795                 video->cap._DOD = 1;
 796         }
 797         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
 798                 video->cap._ROM = 1;
 799         }
 800         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
 801                 video->cap._GPD = 1;
 802         }
 803         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
 804                 video->cap._SPD = 1;
 805         }
 806         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
 807                 video->cap._VPO = 1;
 808         }
 809 }
 810
 811 /*
 812  * Check whether the video bus device has required AML method to
 813  * support the desired features
 814  */
 815
 816 static int acpi_video_bus_check(struct acpi_video_bus *video)
 817 {
 818         acpi_status status = -ENOENT;
 819
 820
 821         if (!video)
 822                 return -EINVAL;
 823
 824         /* Since there is no HID, CID and so on for VGA driver, we have
 825          * to check well known required nodes.
 826          */
 827
 828         /* Does this device support video switching? */
 829         if (video->cap._DOS) {
 830                 video->flags.multihead = 1;
 831                 status = 0;
 832         }
 833
 834         /* Does this device support retrieving a video ROM? */
 835         if (video->cap._ROM) {
 836                 video->flags.rom = 1;
 837                 status = 0;
 838         }
 839
 840         /* Does this device support configuring which video device to POST? */
 841         if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
 842                 video->flags.post = 1;
 843                 status = 0;
 844         }
 845
 846         return status;
 847 }
 848
 849 /* --------------------------------------------------------------------------
 850                               FS Interface (/proc)
 851    -------------------------------------------------------------------------- */
 852
 853 static struct proc_dir_entry *acpi_video_dir;
 854
 855 /* video devices */
 856
 857 static int acpi_video_device_info_seq_show(struct seq_file *seq, void *offset)
 858 {
 859         struct acpi_video_device *dev = seq->private;
 860
 861
 862         if (!dev)
 863                 goto end;
 864
 865         seq_printf(seq, "device_id:    0x%04x\n", (u32) dev->device_id);
 866         seq_printf(seq, "type:         ");
 867         if (dev->flags.crt)
 868                 seq_printf(seq, "CRT\n");
 869         else if (dev->flags.lcd)
 870                 seq_printf(seq, "LCD\n");
 871         else if (dev->flags.tvout)
 872                 seq_printf(seq, "TVOUT\n");
 873         else if (dev->flags.dvi)
 874                 seq_printf(seq, "DVI\n");
 875         else
 876                 seq_printf(seq, "UNKNOWN\n");
 877
 878         seq_printf(seq, "known by bios: %s\n", dev->flags.bios ? "yes" : "no");
 879
 880       end:
 881         return 0;
 882 }
 883
 884 static int
 885 acpi_video_device_info_open_fs(struct inode *inode, struct file *file)
 886 {
 887         return single_open(file, acpi_video_device_info_seq_show,
 888                            PDE(inode)->data);
 889 }
 890
 891 static int acpi_video_device_state_seq_show(struct seq_file *seq, void *offset)
 892 {
 893         int status;
 894         struct acpi_video_device *dev = seq->private;
 895         unsigned long state;
 896
 897
 898         if (!dev)
 899                 goto end;
 900
 901         status = acpi_video_device_get_state(dev, &state);
 902         seq_printf(seq, "state:     ");
 903         if (ACPI_SUCCESS(status))
 904                 seq_printf(seq, "0x%02lx\n", state);
 905         else
 906                 seq_printf(seq, "<not supported>\n");
 907
 908         status = acpi_video_device_query(dev, &state);
 909         seq_printf(seq, "query:     ");
 910         if (ACPI_SUCCESS(status))
 911                 seq_printf(seq, "0x%02lx\n", state);
 912         else
 913                 seq_printf(seq, "<not supported>\n");
 914
 915       end:
 916         return 0;
 917 }
 918
 919 static int
 920 acpi_video_device_state_open_fs(struct inode *inode, struct file *file)
 921 {
 922         return single_open(file, acpi_video_device_state_seq_show,
 923                            PDE(inode)->data);
 924 }
 925
 926 static ssize_t
 927 acpi_video_device_write_state(struct file *file,
 928                               const char __user * buffer,
 929                               size_t count, loff_t * data)
 930 {
 931         int status;
 932         struct seq_file *m = file->private_data;
 933         struct acpi_video_device *dev = m->private;
 934         char str[12] = { 0 };
 935         u32 state = 0;
 936
 937
 938         if (!dev || count + 1 > sizeof str)
 939                 return -EINVAL;
 940
 941         if (copy_from_user(str, buffer, count))
 942                 return -EFAULT;
 943
 944         str[count] = 0;
 945         state = simple_strtoul(str, NULL, 0);
 946         state &= ((1ul << 31) | (1ul << 30) | (1ul << 0));
 947
 948         status = acpi_video_device_set_state(dev, state);
 949
 950         if (status)
 951                 return -EFAULT;
 952
 953         return count;
 954 }
 955
 956 static int
 957 acpi_video_device_brightness_seq_show(struct seq_file *seq, void *offset)
 958 {
 959         struct acpi_video_device *dev = seq->private;
 960         int i;
 961
 962
 963         if (!dev || !dev->brightness) {
 964                 seq_printf(seq, "<not supported>\n");
 965                 return 0;
 966         }
 967
 968         seq_printf(seq, "levels: ");
 969         for (i = 0; i < dev->brightness->count; i++)
 970                 seq_printf(seq, " %d", dev->brightness->levels[i]);
 971         seq_printf(seq, "\ncurrent: %d\n", dev->brightness->curr);
 972
 973         return 0;
 974 }
 975
 976 static int
 977 acpi_video_device_brightness_open_fs(struct inode *inode, struct file *file)
 978 {
 979         return single_open(file, acpi_video_device_brightness_seq_show,
 980                            PDE(inode)->data);
 981 }
 982
 983 static ssize_t
 984 acpi_video_device_write_brightness(struct file *file,
 985                                    const char __user * buffer,
 986                                    size_t count, loff_t * data)
 987 {
 988         struct seq_file *m = file->private_data;
 989         struct acpi_video_device *dev = m->private;
 990         char str[5] = { 0 };
 991         unsigned int level = 0;
 992         int i;
 993
 994
 995         if (!dev || !dev->brightness || count + 1 > sizeof str)
 996                 return -EINVAL;
 997
 998         if (copy_from_user(str, buffer, count))
 999                 return -EFAULT;
1000
1001         str[count] = 0;
1002         level = simple_strtoul(str, NULL, 0);
1003
1004         if (level > 100)
1005                 return -EFAULT;
1006
1007         /* validate through the list of available levels */
1008         for (i = 0; i < dev->brightness->count; i++)
1009                 if (level == dev->brightness->levels[i]) {
1010                         if (ACPI_SUCCESS
1011                             (acpi_video_device_lcd_set_level(dev, level)))
1012                                 dev->brightness->curr = level;
1013                         break;
1014                 }
1015
1016         return count;
1017 }
1018
1019 static int acpi_video_device_EDID_seq_show(struct seq_file *seq, void *offset)
1020 {
1021         struct acpi_video_device *dev = seq->private;
1022         int status;
1023         int i;
1024         union acpi_object *edid = NULL;
1025
1026
1027         if (!dev)
1028                 goto out;
1029
1030         status = acpi_video_device_EDID(dev, &edid, 128);
1031         if (ACPI_FAILURE(status)) {
1032                 status = acpi_video_device_EDID(dev, &edid, 256);
1033         }
1034
1035         if (ACPI_FAILURE(status)) {
1036                 goto out;
1037         }
1038
1039         if (edid && edid->type == ACPI_TYPE_BUFFER) {
1040                 for (i = 0; i < edid->buffer.length; i++)
1041                         seq_putc(seq, edid->buffer.pointer[i]);
1042         }
1043
1044       out:
1045         if (!edid)
1046                 seq_printf(seq, "<not supported>\n");
1047         else
1048                 kfree(edid);
1049
1050         return 0;
1051 }
1052
1053 static int
1054 acpi_video_device_EDID_open_fs(struct inode *inode, struct file *file)
1055 {
1056         return single_open(file, acpi_video_device_EDID_seq_show,
1057                            PDE(inode)->data);
1058 }
1059
1060 static int acpi_video_device_add_fs(struct acpi_device *device)
1061 {
1062         struct proc_dir_entry *entry = NULL;
1063         struct acpi_video_device *vid_dev;
1064
1065
1066         if (!device)
1067                 return -ENODEV;
1068
1069         vid_dev = acpi_driver_data(device);
1070         if (!vid_dev)
1071                 return -ENODEV;
1072
1073         if (!acpi_device_dir(device)) {
1074                 acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
1075                                                      vid_dev->video->dir);
1076                 if (!acpi_device_dir(device))
1077                         return -ENODEV;
1078                 acpi_device_dir(device)->owner = THIS_MODULE;
1079         }
1080
1081         /* 'info' [R] */
1082         entry = proc_create_data("info", S_IRUGO, acpi_device_dir(device),
1083                         &acpi_video_device_info_fops, acpi_driver_data(device));
1084         if (!entry)
1085                 return -ENODEV;
1086
1087         /* 'state' [R/W] */
1088         acpi_video_device_state_fops.write = acpi_video_device_write_state;
1089         entry = proc_create_data("state", S_IFREG | S_IRUGO | S_IWUSR,
1090                                  acpi_device_dir(device),
1091                                  &acpi_video_device_state_fops,
1092                                  acpi_driver_data(device));
1093         if (!entry)
1094                 return -ENODEV;
1095
1096         /* 'brightness' [R/W] */
1097         acpi_video_device_brightness_fops.write =
1098                 acpi_video_device_write_brightness;
1099         entry = proc_create_data("brightness", S_IFREG | S_IRUGO | S_IWUSR,
1100                                  acpi_device_dir(device),
1101                                  &acpi_video_device_brightness_fops,
1102                                  acpi_driver_data(device));
1103         if (!entry)
1104                 return -ENODEV;
1105
1106         /* 'EDID' [R] */
1107         entry = proc_create_data("EDID", S_IRUGO, acpi_device_dir(device),
1108                                  &acpi_video_device_EDID_fops,
1109                                  acpi_driver_data(device));
1110         if (!entry)
1111                 return -ENODEV;
1112         return 0;
1113 }
1114
1115 static int acpi_video_device_remove_fs(struct acpi_device *device)
1116 {
1117         struct acpi_video_device *vid_dev;
1118
1119         vid_dev = acpi_driver_data(device);
1120         if (!vid_dev || !vid_dev->video || !vid_dev->video->dir)
1121                 return -ENODEV;
1122
1123         if (acpi_device_dir(device)) {
1124                 remove_proc_entry("info", acpi_device_dir(device));
1125                 remove_proc_entry("state", acpi_device_dir(device));
1126                 remove_proc_entry("brightness", acpi_device_dir(device));
1127                 remove_proc_entry("EDID", acpi_device_dir(device));
1128                 remove_proc_entry(acpi_device_bid(device), vid_dev->video->dir);
1129                 acpi_device_dir(device) = NULL;
1130         }
1131
1132         return 0;
1133 }
1134
1135 /* video bus */
1136 static int acpi_video_bus_info_seq_show(struct seq_file *seq, void *offset)
1137 {
1138         struct acpi_video_bus *video = seq->private;
1139
1140
1141         if (!video)
1142                 goto end;
1143
1144         seq_printf(seq, "Switching heads:              %s\n",
1145                    video->flags.multihead ? "yes" : "no");
1146         seq_printf(seq, "Video ROM:                    %s\n",
1147                    video->flags.rom ? "yes" : "no");
1148         seq_printf(seq, "Device to be POSTed on boot:  %s\n",
1149                    video->flags.post ? "yes" : "no");
1150
1151       end:
1152         return 0;
1153 }
1154
1155 static int acpi_video_bus_info_open_fs(struct inode *inode, struct file *file)
1156 {
1157         return single_open(file, acpi_video_bus_info_seq_show,
1158                            PDE(inode)->data);
1159 }
1160
1161 static int acpi_video_bus_ROM_seq_show(struct seq_file *seq, void *offset)
1162 {
1163         struct acpi_video_bus *video = seq->private;
1164
1165
1166         if (!video)
1167                 goto end;
1168
1169         printk(KERN_INFO PREFIX "Please implement %s\n", __func__);
1170         seq_printf(seq, "<TODO>\n");
1171
1172       end:
1173         return 0;
1174 }
1175
1176 static int acpi_video_bus_ROM_open_fs(struct inode *inode, struct file *file)
1177 {
1178         return single_open(file, acpi_video_bus_ROM_seq_show, PDE(inode)->data);
1179 }
1180
1181 static int acpi_video_bus_POST_info_seq_show(struct seq_file *seq, void *offset)
1182 {
1183         struct acpi_video_bus *video = seq->private;
1184         unsigned long options;
1185         int status;
1186
1187
1188         if (!video)
1189                 goto end;
1190
1191         status = acpi_video_bus_POST_options(video, &options);
1192         if (ACPI_SUCCESS(status)) {
1193                 if (!(options & 1)) {
1194                         printk(KERN_WARNING PREFIX
1195                                "The motherboard VGA device is not listed as a possible POST device.\n");
1196                         printk(KERN_WARNING PREFIX
1197                                "This indicates a BIOS bug. Please contact the manufacturer.\n");
1198                 }
1199                 printk("%lx\n", options);
1200                 seq_printf(seq, "can POST: <integrated video>");
1201                 if (options & 2)
1202                         seq_printf(seq, " <PCI video>");
1203                 if (options & 4)
1204                         seq_printf(seq, " <AGP video>");
1205                 seq_putc(seq, '\n');
1206         } else
1207                 seq_printf(seq, "<not supported>\n");
1208       end:
1209         return 0;
1210 }
1211
1212 static int
1213 acpi_video_bus_POST_info_open_fs(struct inode *inode, struct file *file)
1214 {
1215         return single_open(file, acpi_video_bus_POST_info_seq_show,
1216                            PDE(inode)->data);
1217 }
1218
1219 static int acpi_video_bus_POST_seq_show(struct seq_file *seq, void *offset)
1220 {
1221         struct acpi_video_bus *video = seq->private;
1222         int status;
1223         unsigned long id;
1224
1225
1226         if (!video)
1227                 goto end;
1228
1229         status = acpi_video_bus_get_POST(video, &id);
1230         if (!ACPI_SUCCESS(status)) {
1231                 seq_printf(seq, "<not supported>\n");
1232                 goto end;
1233         }
1234         seq_printf(seq, "device POSTed is <%s>\n", device_decode[id & 3]);
1235
1236       end:
1237         return 0;
1238 }
1239
1240 static int acpi_video_bus_DOS_seq_show(struct seq_file *seq, void *offset)
1241 {
1242         struct acpi_video_bus *video = seq->private;
1243
1244
1245         seq_printf(seq, "DOS setting: <%d>\n", video->dos_setting);
1246
1247         return 0;
1248 }
1249
1250 static int acpi_video_bus_POST_open_fs(struct inode *inode, struct file *file)
1251 {
1252         return single_open(file, acpi_video_bus_POST_seq_show,
1253                            PDE(inode)->data);
1254 }
1255
1256 static int acpi_video_bus_DOS_open_fs(struct inode *inode, struct file *file)
1257 {
1258         return single_open(file, acpi_video_bus_DOS_seq_show, PDE(inode)->data);
1259 }
1260
1261 static ssize_t
1262 acpi_video_bus_write_POST(struct file *file,
1263                           const char __user * buffer,
1264                           size_t count, loff_t * data)
1265 {
1266         int status;
1267         struct seq_file *m = file->private_data;
1268         struct acpi_video_bus *video = m->private;
1269         char str[12] = { 0 };
1270         unsigned long opt, options;
1271
1272
1273         if (!video || count + 1 > sizeof str)
1274                 return -EINVAL;
1275
1276         status = acpi_video_bus_POST_options(video, &options);
1277         if (!ACPI_SUCCESS(status))
1278                 return -EINVAL;
1279
1280         if (copy_from_user(str, buffer, count))
1281                 return -EFAULT;
1282
1283         str[count] = 0;
1284         opt = strtoul(str, NULL, 0);
1285         if (opt > 3)
1286                 return -EFAULT;
1287
1288         /* just in case an OEM 'forgot' the motherboard... */
1289         options |= 1;
1290
1291         if (options & (1ul << opt)) {
1292                 status = acpi_video_bus_set_POST(video, opt);
1293                 if (!ACPI_SUCCESS(status))
1294                         return -EFAULT;
1295
1296         }
1297
1298         return count;
1299 }
1300
1301 static ssize_t
1302 acpi_video_bus_write_DOS(struct file *file,
1303                          const char __user * buffer,
1304                          size_t count, loff_t * data)
1305 {
1306         int status;
1307         struct seq_file *m = file->private_data;
1308         struct acpi_video_bus *video = m->private;
1309         char str[12] = { 0 };
1310         unsigned long opt;
1311
1312
1313         if (!video || count + 1 > sizeof str)
1314                 return -EINVAL;
1315
1316         if (copy_from_user(str, buffer, count))
1317                 return -EFAULT;
1318
1319         str[count] = 0;
1320         opt = strtoul(str, NULL, 0);
1321         if (opt > 7)
1322                 return -EFAULT;
1323
1324         status = acpi_video_bus_DOS(video, opt & 0x3, (opt & 0x4) >> 2);
1325
1326         if (!ACPI_SUCCESS(status))
1327                 return -EFAULT;
1328
1329         return count;
1330 }
1331
1332 static int acpi_video_bus_add_fs(struct acpi_device *device)
1333 {
1334         struct proc_dir_entry *entry = NULL;
1335         struct acpi_video_bus *video;
1336
1337
1338         video = acpi_driver_data(device);
1339
1340         if (!acpi_device_dir(device)) {
1341                 acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device),
1342                                                      acpi_video_dir);
1343                 if (!acpi_device_dir(device))
1344                         return -ENODEV;
1345                 video->dir = acpi_device_dir(device);
1346                 acpi_device_dir(device)->owner = THIS_MODULE;
1347         }
1348
1349         /* 'info' [R] */
1350         entry = proc_create_data("info", S_IRUGO, acpi_device_dir(device),
1351                                  &acpi_video_bus_info_fops,
1352                                  acpi_driver_data(device));
1353         if (!entry)
1354                 return -ENODEV;
1355
1356         /* 'ROM' [R] */
1357         entry = proc_create_data("ROM", S_IRUGO, acpi_device_dir(device),
1358                                  &acpi_video_bus_ROM_fops,
1359                                  acpi_driver_data(device));
1360         if (!entry)
1361                 return -ENODEV;
1362
1363         /* 'POST_info' [R] */
1364         entry = proc_create_data("POST_info", S_IRUGO, acpi_device_dir(device),
1365                                  &acpi_video_bus_POST_info_fops,
1366                                  acpi_driver_data(device));
1367         if (!entry)
1368                 return -ENODEV;
1369
1370         /* 'POST' [R/W] */
1371         acpi_video_bus_POST_fops.write = acpi_video_bus_write_POST;
1372         entry = proc_create_data("POST", S_IFREG | S_IRUGO | S_IRUSR,
1373                                  acpi_device_dir(device),
1374                                  &acpi_video_bus_POST_fops,
1375                                  acpi_driver_data(device));
1376         if (!entry)
1377                 return -ENODEV;
1378
1379         /* 'DOS' [R/W] */
1380         acpi_video_bus_DOS_fops.write = acpi_video_bus_write_DOS;
1381         entry = proc_create_data("DOS", S_IFREG | S_IRUGO | S_IRUSR,
1382                                  acpi_device_dir(device),
1383                                  &acpi_video_bus_DOS_fops,
1384                                  acpi_driver_data(device));
1385         if (!entry)
1386                 return -ENODEV;
1387
1388         return 0;
1389 }
1390
1391 static int acpi_video_bus_remove_fs(struct acpi_device *device)
1392 {
1393         struct acpi_video_bus *video;
1394
1395
1396         video = acpi_driver_data(device);
1397
1398         if (acpi_device_dir(device)) {
1399                 remove_proc_entry("info", acpi_device_dir(device));
1400                 remove_proc_entry("ROM", acpi_device_dir(device));
1401                 remove_proc_entry("POST_info", acpi_device_dir(device));
1402                 remove_proc_entry("POST", acpi_device_dir(device));
1403                 remove_proc_entry("DOS", acpi_device_dir(device));
1404                 remove_proc_entry(acpi_device_bid(device), acpi_video_dir);
1405                 acpi_device_dir(device) = NULL;
1406         }
1407
1408         return 0;
1409 }
1410
1411 /* --------------------------------------------------------------------------
1412                                  Driver Interface
1413    -------------------------------------------------------------------------- */
1414
1415 /* device interface */
1416 static struct acpi_video_device_attrib*
1417 acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
1418 {
1419         int count;
1420
1421         for(count = 0; count < video->attached_count; count++)
1422                 if((video->attached_array[count].value.int_val & 0xffff) == device_id)
1423                         return &(video->attached_array[count].value.attrib);
1424         return NULL;
1425 }
1426
1427 static int
1428 acpi_video_bus_get_one_device(struct acpi_device *device,
1429                               struct acpi_video_bus *video)
1430 {
1431         unsigned long device_id;
1432         int status;
1433         struct acpi_video_device *data;
1434         struct acpi_video_device_attrib* attribute;
1435
1436         if (!device || !video)
1437                 return -EINVAL;
1438
1439         status =
1440             acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1441         if (ACPI_SUCCESS(status)) {
1442
1443                 data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
1444                 if (!data)
1445                         return -ENOMEM;
1446
1447                 strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
1448                 strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1449                 acpi_driver_data(device) = data;
1450
1451                 data->device_id = device_id;
1452                 data->video = video;
1453                 data->dev = device;
1454
1455                 attribute = acpi_video_get_device_attr(video, device_id);
1456
1457                 if((attribute != NULL) && attribute->device_id_scheme) {
1458                         switch (attribute->display_type) {
1459                         case ACPI_VIDEO_DISPLAY_CRT:
1460                                 data->flags.crt = 1;
1461                                 break;
1462                         case ACPI_VIDEO_DISPLAY_TV:
1463                                 data->flags.tvout = 1;
1464                                 break;
1465                         case ACPI_VIDEO_DISPLAY_DVI:
1466                                 data->flags.dvi = 1;
1467                                 break;
1468                         case ACPI_VIDEO_DISPLAY_LCD:
1469                                 data->flags.lcd = 1;
1470                                 break;
1471                         default:
1472                                 data->flags.unknown = 1;
1473                                 break;
1474                         }
1475                         if(attribute->bios_can_detect)
1476                                 data->flags.bios = 1;
1477                 } else
1478                         data->flags.unknown = 1;
1479
1480                 acpi_video_device_bind(video, data);
1481                 acpi_video_device_find_cap(data);
1482
1483                 status = acpi_install_notify_handler(device->handle,
1484                                                      ACPI_DEVICE_NOTIFY,
1485                                                      acpi_video_device_notify,
1486                                                      data);
1487                 if (ACPI_FAILURE(status)) {
1488                         ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
1489                                           "Error installing notify handler\n"));
1490                         if(data->brightness)
1491                                 kfree(data->brightness->levels);
1492                         kfree(data->brightness);
1493                         kfree(data);
1494                         return -ENODEV;
1495                 }
1496
1497                 mutex_lock(&video->device_list_lock);
1498                 list_add_tail(&data->entry, &video->video_device_list);
1499                 mutex_unlock(&video->device_list_lock);
1500
1501                 acpi_video_device_add_fs(device);
1502
1503                 return 0;
1504         }
1505
1506         return -ENOENT;
1507 }
1508
1509 /*
1510  *  Arg:
1511  *      video   : video bus device
1512  *
1513  *  Return:
1514  *      none
1515  *
1516  *  Enumerate the video device list of the video bus,
1517  *  bind the ids with the corresponding video devices
1518  *  under the video bus.
1519  */
1520
1521 static void acpi_video_device_rebind(struct acpi_video_bus *video)
1522 {
1523         struct acpi_video_device *dev;
1524
1525         mutex_lock(&video->device_list_lock);
1526
1527         list_for_each_entry(dev, &video->video_device_list, entry)
1528                 acpi_video_device_bind(video, dev);
1529
1530         mutex_unlock(&video->device_list_lock);
1531 }
1532
1533 /*
1534  *  Arg:
1535  *      video   : video bus device
1536  *      device  : video output device under the video
1537  *              bus
1538  *
1539  *  Return:
1540  *      none
1541  *
1542  *  Bind the ids with the corresponding video devices
1543  *  under the video bus.
1544  */
1545
1546 static void
1547 acpi_video_device_bind(struct acpi_video_bus *video,
1548                        struct acpi_video_device *device)
1549 {
1550         int i;
1551
1552 #define IDS_VAL(i) video->attached_array[i].value.int_val
1553 #define IDS_BIND(i) video->attached_array[i].bind_info
1554
1555         for (i = 0; IDS_VAL(i) != ACPI_VIDEO_HEAD_INVALID &&
1556              i < video->attached_count; i++) {
1557                 if (device->device_id == (IDS_VAL(i) & 0xffff)) {
1558                         IDS_BIND(i) = device;
1559                         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
1560                 }
1561         }
1562 #undef IDS_VAL
1563 #undef IDS_BIND
1564 }
1565
1566 /*
1567  *  Arg:
1568  *      video   : video bus device
1569  *
1570  *  Return:
1571  *      < 0     : error
1572  *
1573  *  Call _DOD to enumerate all devices attached to display adapter
1574  *
1575  */
1576
1577 static int acpi_video_device_enumerate(struct acpi_video_bus *video)
1578 {
1579         int status;
1580         int count;
1581         int i;
1582         struct acpi_video_enumerated_device *active_device_list;
1583         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1584         union acpi_object *dod = NULL;
1585         union acpi_object *obj;
1586
1587         status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
1588         if (!ACPI_SUCCESS(status)) {
1589                 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1590                 return status;
1591         }
1592
1593         dod = buffer.pointer;
1594         if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1595                 ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
1596                 status = -EFAULT;
1597                 goto out;
1598         }
1599
1600         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
1601                           dod->package.count));
1602
1603         active_device_list = kmalloc((1 +
1604                                       dod->package.count) *
1605                                      sizeof(struct
1606                                             acpi_video_enumerated_device),
1607                                      GFP_KERNEL);
1608
1609         if (!active_device_list) {
1610                 status = -ENOMEM;
1611                 goto out;
1612         }
1613
1614         count = 0;
1615         for (i = 0; i < dod->package.count; i++) {
1616                 obj = &dod->package.elements[i];
1617
1618                 if (obj->type != ACPI_TYPE_INTEGER) {
1619                         printk(KERN_ERR PREFIX "Invalid _DOD data\n");
1620                         active_device_list[i].value.int_val =
1621                             ACPI_VIDEO_HEAD_INVALID;
1622                 }
1623                 active_device_list[i].value.int_val = obj->integer.value;
1624                 active_device_list[i].bind_info = NULL;
1625                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
1626                                   (int)obj->integer.value));
1627                 count++;
1628         }
1629         active_device_list[count].value.int_val = ACPI_VIDEO_HEAD_END;
1630
1631         kfree(video->attached_array);
1632
1633         video->attached_array = active_device_list;
1634         video->attached_count = count;
1635       out:
1636         kfree(buffer.pointer);
1637         return status;
1638 }
1639
1640 static int
1641 acpi_video_get_next_level(struct acpi_video_device *device,
1642                           u32 level_current, u32 event)
1643 {
1644         int min, max, min_above, max_below, i, l, delta = 255;
1645         max = max_below = 0;
1646         min = min_above = 255;
1647         /* Find closest level to level_current */
1648         for (i = 0; i < device->brightness->count; i++) {
1649                 l = device->brightness->levels[i];
1650                 if (abs(l - level_current) < abs(delta)) {
1651                         delta = l - level_current;
1652                         if (!delta)
1653                                 break;
1654                 }
1655         }
1656         /* Ajust level_current to closest available level */
1657         level_current += delta;
1658         for (i = 0; i < device->brightness->count; i++) {
1659                 l = device->brightness->levels[i];
1660                 if (l < min)
1661                         min = l;
1662                 if (l > max)
1663                         max = l;
1664                 if (l < min_above && l > level_current)
1665                         min_above = l;
1666                 if (l > max_below && l < level_current)
1667                         max_below = l;
1668         }
1669
1670         switch (event) {
1671         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
1672                 return (level_current < max) ? min_above : min;
1673         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
1674                 return (level_current < max) ? min_above : max;
1675         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
1676                 return (level_current > min) ? max_below : min;
1677         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
1678         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
1679                 return 0;
1680         default:
1681                 return level_current;
1682         }
1683 }
1684
1685 static void
1686 acpi_video_switch_brightness(struct acpi_video_device *device, int event)
1687 {
1688         unsigned long level_current, level_next;
1689         acpi_video_device_lcd_get_level_current(device, &level_current);
1690         level_next = acpi_video_get_next_level(device, level_current, event);
1691         acpi_video_device_lcd_set_level(device, level_next);
1692 }
1693
1694 static int
1695 acpi_video_bus_get_devices(struct acpi_video_bus *video,
1696                            struct acpi_device *device)
1697 {
1698         int status = 0;
1699         struct acpi_device *dev;
1700
1701         acpi_video_device_enumerate(video);
1702
1703         list_for_each_entry(dev, &device->children, node) {
1704
1705                 status = acpi_video_bus_get_one_device(dev, video);
1706                 if (ACPI_FAILURE(status)) {
1707                         ACPI_EXCEPTION((AE_INFO, status, "Cant attach device"));
1708                         continue;
1709                 }
1710         }
1711         return status;
1712 }
1713
1714 static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
1715 {
1716         acpi_status status;
1717         struct acpi_video_bus *video;
1718
1719
1720         if (!device || !device->video)
1721                 return -ENOENT;
1722
1723         video = device->video;
1724
1725         acpi_video_device_remove_fs(device->dev);
1726
1727         status = acpi_remove_notify_handler(device->dev->handle,
1728                                             ACPI_DEVICE_NOTIFY,
1729                                             acpi_video_device_notify);
1730         backlight_device_unregister(device->backlight);
1731         if (device->cdev) {
1732                 sysfs_remove_link(&device->dev->dev.kobj,
1733                                   "thermal_cooling");
1734                 sysfs_remove_link(&device->cdev->device.kobj,
1735                                   "device");
1736                 thermal_cooling_device_unregister(device->cdev);
1737                 device->cdev = NULL;
1738         }
1739         video_output_unregister(device->output_dev);
1740
1741         return 0;
1742 }
1743
1744 static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
1745 {
1746         int status;
1747         struct acpi_video_device *dev, *next;
1748
1749         mutex_lock(&video->device_list_lock);
1750
1751         list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
1752
1753                 status = acpi_video_bus_put_one_device(dev);
1754                 if (ACPI_FAILURE(status))
1755                         printk(KERN_WARNING PREFIX
1756                                "hhuuhhuu bug in acpi video driver.\n");
1757
1758                 if (dev->brightness) {
1759                         kfree(dev->brightness->levels);
1760                         kfree(dev->brightness);
1761                 }
1762                 list_del(&dev->entry);
1763                 kfree(dev);
1764         }
1765
1766         mutex_unlock(&video->device_list_lock);
1767
1768         return 0;
1769 }
1770
1771 /* acpi_video interface */
1772
1773 static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
1774 {
1775         return acpi_video_bus_DOS(video, 0, 0);
1776 }
1777
1778 static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
1779 {
1780         return acpi_video_bus_DOS(video, 0, 1);
1781 }
1782
1783 static void acpi_video_bus_notify(acpi_handle handle, u32 event, void *data)
1784 {
1785         struct acpi_video_bus *video = data;
1786         struct acpi_device *device = NULL;
1787         struct input_dev *input;
1788         int keycode;
1789
1790         if (!video)
1791                 return;
1792
1793         device = video->device;
1794         input = video->input;
1795
1796         switch (event) {
1797         case ACPI_VIDEO_NOTIFY_SWITCH:  /* User requested a switch,
1798                                          * most likely via hotkey. */
1799                 acpi_bus_generate_proc_event(device, event, 0);
1800                 keycode = KEY_SWITCHVIDEOMODE;
1801                 break;
1802
1803         case ACPI_VIDEO_NOTIFY_PROBE:   /* User plugged in or removed a video
1804                                          * connector. */
1805                 acpi_video_device_enumerate(video);
1806                 acpi_video_device_rebind(video);
1807                 acpi_bus_generate_proc_event(device, event, 0);
1808                 keycode = KEY_SWITCHVIDEOMODE;
1809                 break;
1810
1811         case ACPI_VIDEO_NOTIFY_CYCLE:   /* Cycle Display output hotkey pressed. */
1812                 acpi_bus_generate_proc_event(device, event, 0);
1813                 keycode = KEY_SWITCHVIDEOMODE;
1814                 break;
1815         case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:     /* Next Display output hotkey pressed. */
1816                 acpi_bus_generate_proc_event(device, event, 0);
1817                 keycode = KEY_VIDEO_NEXT;
1818                 break;
1819         case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:     /* previous Display output hotkey pressed. */
1820                 acpi_bus_generate_proc_event(device, event, 0);
1821                 keycode = KEY_VIDEO_PREV;
1822                 break;
1823
1824         default:
1825                 keycode = KEY_UNKNOWN;
1826                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1827                                   "Unsupported event [0x%x]\n", event));
1828                 break;
1829         }
1830
1831         acpi_notifier_call_chain(device, event, 0);
1832         input_report_key(input, keycode, 1);
1833         input_sync(input);
1834         input_report_key(input, keycode, 0);
1835         input_sync(input);
1836
1837         return;
1838 }
1839
1840 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
1841 {
1842         struct acpi_video_device *video_device = data;
1843         struct acpi_device *device = NULL;
1844         struct acpi_video_bus *bus;
1845         struct input_dev *input;
1846         int keycode;
1847
1848         if (!video_device)
1849                 return;
1850
1851         device = video_device->dev;
1852         bus = video_device->video;
1853         input = bus->input;
1854
1855         switch (event) {
1856         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:        /* Cycle brightness */
1857                 if (brightness_switch_enabled)
1858                         acpi_video_switch_brightness(video_device, event);
1859                 acpi_bus_generate_proc_event(device, event, 0);
1860                 keycode = KEY_BRIGHTNESS_CYCLE;
1861                 break;
1862         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:  /* Increase brightness */
1863                 if (brightness_switch_enabled)
1864                         acpi_video_switch_brightness(video_device, event);
1865                 acpi_bus_generate_proc_event(device, event, 0);
1866                 keycode = KEY_BRIGHTNESSUP;
1867                 break;
1868         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:  /* Decrease brightness */
1869                 if (brightness_switch_enabled)
1870                         acpi_video_switch_brightness(video_device, event);
1871                 acpi_bus_generate_proc_event(device, event, 0);
1872                 keycode = KEY_BRIGHTNESSDOWN;
1873                 break;
1874         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS: /* zero brightnesss */
1875                 if (brightness_switch_enabled)
1876                         acpi_video_switch_brightness(video_device, event);
1877                 acpi_bus_generate_proc_event(device, event, 0);
1878                 keycode = KEY_BRIGHTNESS_ZERO;
1879                 break;
1880         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:     /* display device off */
1881                 if (brightness_switch_enabled)
1882                         acpi_video_switch_brightness(video_device, event);
1883                 acpi_bus_generate_proc_event(device, event, 0);
1884                 keycode = KEY_DISPLAY_OFF;
1885                 break;
1886         default:
1887                 keycode = KEY_UNKNOWN;
1888                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1889                                   "Unsupported event [0x%x]\n", event));
1890                 break;
1891         }
1892
1893         acpi_notifier_call_chain(device, event, 0);
1894         input_report_key(input, keycode, 1);
1895         input_sync(input);
1896         input_report_key(input, keycode, 0);
1897         input_sync(input);
1898
1899         return;
1900 }
1901
1902 static int instance;
1903 static int acpi_video_resume(struct acpi_device *device)
1904 {
1905         struct acpi_video_bus *video;
1906         struct acpi_video_device *video_device;
1907         int i;
1908
1909         if (!device || !acpi_driver_data(device))
1910                 return -EINVAL;
1911
1912         video = acpi_driver_data(device);
1913
1914         for (i = 0; i < video->attached_count; i++) {
1915                 video_device = video->attached_array[i].bind_info;
1916                 if (video_device && video_device->backlight)
1917                         acpi_video_set_brightness(video_device->backlight);
1918         }
1919         return AE_OK;
1920 }
1921
1922 static int acpi_video_bus_add(struct acpi_device *device)
1923 {
1924         acpi_status status;
1925         struct acpi_video_bus *video;
1926         struct input_dev *input;
1927         int error;
1928
1929         video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
1930         if (!video)
1931                 return -ENOMEM;
1932
1933         /* a hack to fix the duplicate name "VID" problem on T61 */
1934         if (!strcmp(device->pnp.bus_id, "VID")) {
1935                 if (instance)
1936                         device->pnp.bus_id[3] = '0' + instance;
1937                 instance ++;
1938         }
1939
1940         video->device = device;
1941         strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
1942         strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1943         acpi_driver_data(device) = video;
1944
1945         acpi_video_bus_find_cap(video);
1946         error = acpi_video_bus_check(video);
1947         if (error)
1948                 goto err_free_video;
1949
1950         error = acpi_video_bus_add_fs(device);
1951         if (error)
1952                 goto err_free_video;
1953
1954         mutex_init(&video->device_list_lock);
1955         INIT_LIST_HEAD(&video->video_device_list);
1956
1957         acpi_video_bus_get_devices(video, device);
1958         acpi_video_bus_start_devices(video);
1959
1960         status = acpi_install_notify_handler(device->handle,
1961                                              ACPI_DEVICE_NOTIFY,
1962                                              acpi_video_bus_notify, video);
1963         if (ACPI_FAILURE(status)) {
1964                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
1965                                   "Error installing notify handler\n"));
1966                 error = -ENODEV;
1967                 goto err_stop_video;
1968         }
1969
1970         video->input = input = input_allocate_device();
1971         if (!input) {
1972                 error = -ENOMEM;
1973                 goto err_uninstall_notify;
1974         }
1975
1976         snprintf(video->phys, sizeof(video->phys),
1977                 "%s/video/input0", acpi_device_hid(video->device));
1978
1979         input->name = acpi_device_name(video->device);
1980         input->phys = video->phys;
1981         input->id.bustype = BUS_HOST;
1982         input->id.product = 0x06;
1983         input->dev.parent = &device->dev;
1984         input->evbit[0] = BIT(EV_KEY);
1985         set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
1986         set_bit(KEY_VIDEO_NEXT, input->keybit);
1987         set_bit(KEY_VIDEO_PREV, input->keybit);
1988         set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
1989         set_bit(KEY_BRIGHTNESSUP, input->keybit);
1990         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
1991         set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
1992         set_bit(KEY_DISPLAY_OFF, input->keybit);
1993         set_bit(KEY_UNKNOWN, input->keybit);
1994
1995         error = input_register_device(input);
1996         if (error)
1997                 goto err_free_input_dev;
1998
1999         printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
2000                ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
2001                video->flags.multihead ? "yes" : "no",
2002                video->flags.rom ? "yes" : "no",
2003                video->flags.post ? "yes" : "no");
2004
2005         return 0;
2006
2007  err_free_input_dev:
2008         input_free_device(input);
2009  err_uninstall_notify:
2010         acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY,
2011                                    acpi_video_bus_notify);
2012  err_stop_video:
2013         acpi_video_bus_stop_devices(video);
2014         acpi_video_bus_put_devices(video);
2015         kfree(video->attached_array);
2016         acpi_video_bus_remove_fs(device);
2017  err_free_video:
2018         kfree(video);
2019         acpi_driver_data(device) = NULL;
2020
2021         return error;
2022 }
2023
2024 static int acpi_video_bus_remove(struct acpi_device *device, int type)
2025 {
2026         acpi_status status = 0;
2027         struct acpi_video_bus *video = NULL;
2028
2029
2030         if (!device || !acpi_driver_data(device))
2031                 return -EINVAL;
2032
2033         video = acpi_driver_data(device);
2034
2035         acpi_video_bus_stop_devices(video);
2036
2037         status = acpi_remove_notify_handler(video->device->handle,
2038                                             ACPI_DEVICE_NOTIFY,
2039                                             acpi_video_bus_notify);
2040
2041         acpi_video_bus_put_devices(video);
2042         acpi_video_bus_remove_fs(device);
2043
2044         input_unregister_device(video->input);
2045         kfree(video->attached_array);
2046         kfree(video);
2047
2048         return 0;
2049 }
2050
2051 static int __init acpi_video_init(void)
2052 {
2053         int result = 0;
2054
2055
2056         /*
2057            acpi_dbg_level = 0xFFFFFFFF;
2058            acpi_dbg_layer = 0x08000000;
2059          */
2060
2061         acpi_video_dir = proc_mkdir(ACPI_VIDEO_CLASS, acpi_root_dir);
2062         if (!acpi_video_dir)
2063                 return -ENODEV;
2064         acpi_video_dir->owner = THIS_MODULE;
2065
2066         result = acpi_bus_register_driver(&acpi_video_bus);
2067         if (result < 0) {
2068                 remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);
2069                 return -ENODEV;
2070         }
2071
2072         return 0;
2073 }
2074
2075 static void __exit acpi_video_exit(void)
2076 {
2077
2078         acpi_bus_unregister_driver(&acpi_video_bus);
2079
2080         remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);
2081
2082         return;
2083 }
2084
2085 module_init(acpi_video_init);
2086 module_exit(acpi_video_exit);