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