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 <linux/sort.h>
  40 #include <asm/uaccess.h>
  41
  42 #include <acpi/acpi_bus.h>
  43 #include <acpi/acpi_drivers.h>
  44
  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 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 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 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 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 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 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 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 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 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 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 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 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  * Simple comparison function used to sort backlight levels.
 631  */
 632
 633 static int
 634 acpi_video_cmp_level(const void *a, const void *b)
 635 {
 636         return *(int *)a - *(int *)b;
 637 }
 638
 639 /*
 640  *  Arg:
 641  *      device  : video output device (LCD, CRT, ..)
 642  *
 643  *  Return Value:
 644  *      Maximum brightness level
 645  *
 646  *  Allocate and initialize device->brightness.
 647  */
 648
 649 static int
 650 acpi_video_init_brightness(struct acpi_video_device *device)
 651 {
 652         union acpi_object *obj = NULL;
 653         int i, max_level = 0, count = 0;
 654         union acpi_object *o;
 655         struct acpi_video_device_brightness *br = NULL;
 656
 657         if (!ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
 658                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available "
 659                                                 "LCD brightness level\n"));
 660                 goto out;
 661         }
 662
 663         if (obj->package.count < 2)
 664                 goto out;
 665
 666         br = kzalloc(sizeof(*br), GFP_KERNEL);
 667         if (!br) {
 668                 printk(KERN_ERR "can't allocate memory\n");
 669                 goto out;
 670         }
 671
 672         br->levels = kmalloc(obj->package.count * sizeof *(br->levels),
 673                                 GFP_KERNEL);
 674         if (!br->levels)
 675                 goto out_free;
 676
 677         for (i = 0; i < obj->package.count; i++) {
 678                 o = (union acpi_object *)&obj->package.elements[i];
 679                 if (o->type != ACPI_TYPE_INTEGER) {
 680                         printk(KERN_ERR PREFIX "Invalid data\n");
 681                         continue;
 682                 }
 683                 br->levels[count] = (u32) o->integer.value;
 684
 685                 if (br->levels[count] > max_level)
 686                         max_level = br->levels[count];
 687                 count++;
 688         }
 689
 690         /* don't sort the first two brightness levels */
 691         sort(&br->levels[2], count - 2, sizeof(br->levels[2]),
 692                 acpi_video_cmp_level, NULL);
 693
 694         if (count < 2)
 695                 goto out_free_levels;
 696
 697         br->count = count;
 698         device->brightness = br;
 699         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "found %d brightness levels\n", count));
 700         kfree(obj);
 701         return max_level;
 702
 703 out_free_levels:
 704         kfree(br->levels);
 705 out_free:
 706         kfree(br);
 707 out:
 708         device->brightness = NULL;
 709         kfree(obj);
 710         return 0;
 711 }
 712
 713 /*
 714  *  Arg:
 715  *      device  : video output device (LCD, CRT, ..)
 716  *
 717  *  Return Value:
 718  *      None
 719  *
 720  *  Find out all required AML methods defined under the output
 721  *  device.
 722  */
 723
 724 static void acpi_video_device_find_cap(struct acpi_video_device *device)
 725 {
 726         acpi_handle h_dummy1;
 727         u32 max_level = 0;
 728
 729
 730         memset(&device->cap, 0, sizeof(device->cap));
 731
 732         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
 733                 device->cap._ADR = 1;
 734         }
 735         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
 736                 device->cap._BCL = 1;
 737         }
 738         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
 739                 device->cap._BCM = 1;
 740         }
 741         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
 742                 device->cap._BQC = 1;
 743         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
 744                 device->cap._DDC = 1;
 745         }
 746         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DCS", &h_dummy1))) {
 747                 device->cap._DCS = 1;
 748         }
 749         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DGS", &h_dummy1))) {
 750                 device->cap._DGS = 1;
 751         }
 752         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DSS", &h_dummy1))) {
 753                 device->cap._DSS = 1;
 754         }
 755
 756         if (acpi_video_backlight_support())
 757                 max_level = acpi_video_init_brightness(device);
 758
 759         if (device->cap._BCL && device->cap._BCM && max_level > 0) {
 760                 int result;
 761                 static int count = 0;
 762                 char *name;
 763                 name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
 764                 if (!name)
 765                         return;
 766
 767                 sprintf(name, "acpi_video%d", count++);
 768                 device->backlight = backlight_device_register(name,
 769                         NULL, device, &acpi_backlight_ops);
 770                 device->backlight->props.max_brightness = device->brightness->count-3;
 771                 /*
 772                  * If there exists the _BQC object, the _BQC object will be
 773                  * called to get the current backlight brightness. Otherwise
 774                  * the brightness will be set to the maximum.
 775                  */
 776                 if (device->cap._BQC)
 777                         device->backlight->props.brightness =
 778                                 acpi_video_get_brightness(device->backlight);
 779                 else
 780                         device->backlight->props.brightness =
 781                                 device->backlight->props.max_brightness;
 782                 backlight_update_status(device->backlight);
 783                 kfree(name);
 784
 785                 device->cdev = thermal_cooling_device_register("LCD",
 786                                         device->dev, &video_cooling_ops);
 787                 if (IS_ERR(device->cdev))
 788                         return;
 789
 790                 dev_info(&device->dev->dev, "registered as cooling_device%d\n",
 791                          device->cdev->id);
 792                 result = sysfs_create_link(&device->dev->dev.kobj,
 793                                 &device->cdev->device.kobj,
 794                                 "thermal_cooling");
 795                 if (result)
 796                         printk(KERN_ERR PREFIX "Create sysfs link\n");
 797                 result = sysfs_create_link(&device->cdev->device.kobj,
 798                                 &device->dev->dev.kobj, "device");
 799                 if (result)
 800                         printk(KERN_ERR PREFIX "Create sysfs link\n");
 801
 802         }
 803
 804         if (acpi_video_display_switch_support()) {
 805
 806                 if (device->cap._DCS && device->cap._DSS) {
 807                         static int count;
 808                         char *name;
 809                         name = kzalloc(MAX_NAME_LEN, GFP_KERNEL);
 810                         if (!name)
 811                                 return;
 812                         sprintf(name, "acpi_video%d", count++);
 813                         device->output_dev = video_output_register(name,
 814                                         NULL, device, &acpi_output_properties);
 815                         kfree(name);
 816                 }
 817         }
 818 }
 819
 820 /*
 821  *  Arg:
 822  *      device  : video output device (VGA)
 823  *
 824  *  Return Value:
 825  *      None
 826  *
 827  *  Find out all required AML methods defined under the video bus device.
 828  */
 829
 830 static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
 831 {
 832         acpi_handle h_dummy1;
 833
 834         memset(&video->cap, 0, sizeof(video->cap));
 835         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
 836                 video->cap._DOS = 1;
 837         }
 838         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
 839                 video->cap._DOD = 1;
 840         }
 841         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
 842                 video->cap._ROM = 1;
 843         }
 844         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
 845                 video->cap._GPD = 1;
 846         }
 847         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
 848                 video->cap._SPD = 1;
 849         }
 850         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
 851                 video->cap._VPO = 1;
 852         }
 853 }
 854
 855 /*
 856  * Check whether the video bus device has required AML method to
 857  * support the desired features
 858  */
 859
 860 static int acpi_video_bus_check(struct acpi_video_bus *video)
 861 {
 862         acpi_status status = -ENOENT;
 863         struct device *dev;
 864
 865         if (!video)
 866                 return -EINVAL;
 867
 868         dev = acpi_get_physical_pci_device(video->device->handle);
 869         if (!dev)
 870                 return -ENODEV;
 871         put_device(dev);
 872
 873         /* Since there is no HID, CID and so on for VGA driver, we have
 874          * to check well known required nodes.
 875          */
 876
 877         /* Does this device support video switching? */
 878         if (video->cap._DOS) {
 879                 video->flags.multihead = 1;
 880                 status = 0;
 881         }
 882
 883         /* Does this device support retrieving a video ROM? */
 884         if (video->cap._ROM) {
 885                 video->flags.rom = 1;
 886                 status = 0;
 887         }
 888
 889         /* Does this device support configuring which video device to POST? */
 890         if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
 891                 video->flags.post = 1;
 892                 status = 0;
 893         }
 894
 895         return status;
 896 }
 897
 898 /* --------------------------------------------------------------------------
 899                               FS Interface (/proc)
 900    -------------------------------------------------------------------------- */
 901
 902 static struct proc_dir_entry *acpi_video_dir;
 903
 904 /* video devices */
 905
 906 static int acpi_video_device_info_seq_show(struct seq_file *seq, void *offset)
 907 {
 908         struct acpi_video_device *dev = seq->private;
 909
 910
 911         if (!dev)
 912                 goto end;
 913
 914         seq_printf(seq, "device_id:    0x%04x\n", (u32) dev->device_id);
 915         seq_printf(seq, "type:         ");
 916         if (dev->flags.crt)
 917                 seq_printf(seq, "CRT\n");
 918         else if (dev->flags.lcd)
 919                 seq_printf(seq, "LCD\n");
 920         else if (dev->flags.tvout)
 921                 seq_printf(seq, "TVOUT\n");
 922         else if (dev->flags.dvi)
 923                 seq_printf(seq, "DVI\n");
 924         else
 925                 seq_printf(seq, "UNKNOWN\n");
 926
 927         seq_printf(seq, "known by bios: %s\n", dev->flags.bios ? "yes" : "no");
 928
 929       end:
 930         return 0;
 931 }
 932
 933 static int
 934 acpi_video_device_info_open_fs(struct inode *inode, struct file *file)
 935 {
 936         return single_open(file, acpi_video_device_info_seq_show,
 937                            PDE(inode)->data);
 938 }
 939
 940 static int acpi_video_device_state_seq_show(struct seq_file *seq, void *offset)
 941 {
 942         int status;
 943         struct acpi_video_device *dev = seq->private;
 944         unsigned long long state;
 945
 946
 947         if (!dev)
 948                 goto end;
 949
 950         status = acpi_video_device_get_state(dev, &state);
 951         seq_printf(seq, "state:     ");
 952         if (ACPI_SUCCESS(status))
 953                 seq_printf(seq, "0x%02llx\n", state);
 954         else
 955                 seq_printf(seq, "<not supported>\n");
 956
 957         status = acpi_video_device_query(dev, &state);
 958         seq_printf(seq, "query:     ");
 959         if (ACPI_SUCCESS(status))
 960                 seq_printf(seq, "0x%02llx\n", state);
 961         else
 962                 seq_printf(seq, "<not supported>\n");
 963
 964       end:
 965         return 0;
 966 }
 967
 968 static int
 969 acpi_video_device_state_open_fs(struct inode *inode, struct file *file)
 970 {
 971         return single_open(file, acpi_video_device_state_seq_show,
 972                            PDE(inode)->data);
 973 }
 974
 975 static ssize_t
 976 acpi_video_device_write_state(struct file *file,
 977                               const char __user * buffer,
 978                               size_t count, loff_t * data)
 979 {
 980         int status;
 981         struct seq_file *m = file->private_data;
 982         struct acpi_video_device *dev = m->private;
 983         char str[12] = { 0 };
 984         u32 state = 0;
 985
 986
 987         if (!dev || count + 1 > sizeof str)
 988                 return -EINVAL;
 989
 990         if (copy_from_user(str, buffer, count))
 991                 return -EFAULT;
 992
 993         str[count] = 0;
 994         state = simple_strtoul(str, NULL, 0);
 995         state &= ((1ul << 31) | (1ul << 30) | (1ul << 0));
 996
 997         status = acpi_video_device_set_state(dev, state);
 998
 999         if (status)
1000                 return -EFAULT;
1001
1002         return count;
1003 }
1004
1005 static int
1006 acpi_video_device_brightness_seq_show(struct seq_file *seq, void *offset)
1007 {
1008         struct acpi_video_device *dev = seq->private;
1009         int i;
1010
1011
1012         if (!dev || !dev->brightness) {
1013                 seq_printf(seq, "<not supported>\n");
1014                 return 0;
1015         }
1016
1017         seq_printf(seq, "levels: ");
1018         for (i = 0; i < dev->brightness->count; i++)
1019                 seq_printf(seq, " %d", dev->brightness->levels[i]);
1020         seq_printf(seq, "\ncurrent: %d\n", dev->brightness->curr);
1021
1022         return 0;
1023 }
1024
1025 static int
1026 acpi_video_device_brightness_open_fs(struct inode *inode, struct file *file)
1027 {
1028         return single_open(file, acpi_video_device_brightness_seq_show,
1029                            PDE(inode)->data);
1030 }
1031
1032 static ssize_t
1033 acpi_video_device_write_brightness(struct file *file,
1034                                    const char __user * buffer,
1035                                    size_t count, loff_t * data)
1036 {
1037         struct seq_file *m = file->private_data;
1038         struct acpi_video_device *dev = m->private;
1039         char str[5] = { 0 };
1040         unsigned int level = 0;
1041         int i;
1042
1043
1044         if (!dev || !dev->brightness || count + 1 > sizeof str)
1045                 return -EINVAL;
1046
1047         if (copy_from_user(str, buffer, count))
1048                 return -EFAULT;
1049
1050         str[count] = 0;
1051         level = simple_strtoul(str, NULL, 0);
1052
1053         if (level > 100)
1054                 return -EFAULT;
1055
1056         /* validate through the list of available levels */
1057         for (i = 0; i < dev->brightness->count; i++)
1058                 if (level == dev->brightness->levels[i]) {
1059                         if (ACPI_SUCCESS
1060                             (acpi_video_device_lcd_set_level(dev, level)))
1061                                 dev->brightness->curr = level;
1062                         break;
1063                 }
1064
1065         return count;
1066 }
1067
1068 static int acpi_video_device_EDID_seq_show(struct seq_file *seq, void *offset)
1069 {
1070         struct acpi_video_device *dev = seq->private;
1071         int status;
1072         int i;
1073         union acpi_object *edid = NULL;
1074
1075
1076         if (!dev)
1077                 goto out;
1078
1079         status = acpi_video_device_EDID(dev, &edid, 128);
1080         if (ACPI_FAILURE(status)) {
1081                 status = acpi_video_device_EDID(dev, &edid, 256);
1082         }
1083
1084         if (ACPI_FAILURE(status)) {
1085                 goto out;
1086         }
1087
1088         if (edid && edid->type == ACPI_TYPE_BUFFER) {
1089                 for (i = 0; i < edid->buffer.length; i++)
1090                         seq_putc(seq, edid->buffer.pointer[i]);
1091         }
1092
1093       out:
1094         if (!edid)
1095                 seq_printf(seq, "<not supported>\n");
1096         else
1097                 kfree(edid);
1098
1099         return 0;
1100 }
1101
1102 static int
1103 acpi_video_device_EDID_open_fs(struct inode *inode, struct file *file)
1104 {
1105         return single_open(file, acpi_video_device_EDID_seq_show,
1106                            PDE(inode)->data);
1107 }
1108
1109 static int acpi_video_device_add_fs(struct acpi_device *device)
1110 {
1111         struct proc_dir_entry *entry, *device_dir;
1112         struct acpi_video_device *vid_dev;
1113
1114         vid_dev = acpi_driver_data(device);
1115         if (!vid_dev)
1116                 return -ENODEV;
1117
1118         device_dir = proc_mkdir(acpi_device_bid(device),
1119                                 vid_dev->video->dir);
1120         if (!device_dir)
1121                 return -ENOMEM;
1122
1123         device_dir->owner = THIS_MODULE;
1124
1125         /* 'info' [R] */
1126         entry = proc_create_data("info", S_IRUGO, device_dir,
1127                         &acpi_video_device_info_fops, acpi_driver_data(device));
1128         if (!entry)
1129                 goto err_remove_dir;
1130
1131         /* 'state' [R/W] */
1132         acpi_video_device_state_fops.write = acpi_video_device_write_state;
1133         entry = proc_create_data("state", S_IFREG | S_IRUGO | S_IWUSR,
1134                                  device_dir,
1135                                  &acpi_video_device_state_fops,
1136                                  acpi_driver_data(device));
1137         if (!entry)
1138                 goto err_remove_info;
1139
1140         /* 'brightness' [R/W] */
1141         acpi_video_device_brightness_fops.write =
1142                 acpi_video_device_write_brightness;
1143         entry = proc_create_data("brightness", S_IFREG | S_IRUGO | S_IWUSR,
1144                                  device_dir,
1145                                  &acpi_video_device_brightness_fops,
1146                                  acpi_driver_data(device));
1147         if (!entry)
1148                 goto err_remove_state;
1149
1150         /* 'EDID' [R] */
1151         entry = proc_create_data("EDID", S_IRUGO, device_dir,
1152                                  &acpi_video_device_EDID_fops,
1153                                  acpi_driver_data(device));
1154         if (!entry)
1155                 goto err_remove_brightness;
1156
1157         acpi_device_dir(device) = device_dir;
1158
1159         return 0;
1160
1161  err_remove_brightness:
1162         remove_proc_entry("brightness", device_dir);
1163  err_remove_state:
1164         remove_proc_entry("state", device_dir);
1165  err_remove_info:
1166         remove_proc_entry("info", device_dir);
1167  err_remove_dir:
1168         remove_proc_entry(acpi_device_bid(device), vid_dev->video->dir);
1169         return -ENOMEM;
1170 }
1171
1172 static int acpi_video_device_remove_fs(struct acpi_device *device)
1173 {
1174         struct acpi_video_device *vid_dev;
1175         struct proc_dir_entry *device_dir;
1176
1177         vid_dev = acpi_driver_data(device);
1178         if (!vid_dev || !vid_dev->video || !vid_dev->video->dir)
1179                 return -ENODEV;
1180
1181         device_dir = acpi_device_dir(device);
1182         if (device_dir) {
1183                 remove_proc_entry("info", device_dir);
1184                 remove_proc_entry("state", device_dir);
1185                 remove_proc_entry("brightness", device_dir);
1186                 remove_proc_entry("EDID", device_dir);
1187                 remove_proc_entry(acpi_device_bid(device), vid_dev->video->dir);
1188                 acpi_device_dir(device) = NULL;
1189         }
1190
1191         return 0;
1192 }
1193
1194 /* video bus */
1195 static int acpi_video_bus_info_seq_show(struct seq_file *seq, void *offset)
1196 {
1197         struct acpi_video_bus *video = seq->private;
1198
1199
1200         if (!video)
1201                 goto end;
1202
1203         seq_printf(seq, "Switching heads:              %s\n",
1204                    video->flags.multihead ? "yes" : "no");
1205         seq_printf(seq, "Video ROM:                    %s\n",
1206                    video->flags.rom ? "yes" : "no");
1207         seq_printf(seq, "Device to be POSTed on boot:  %s\n",
1208                    video->flags.post ? "yes" : "no");
1209
1210       end:
1211         return 0;
1212 }
1213
1214 static int acpi_video_bus_info_open_fs(struct inode *inode, struct file *file)
1215 {
1216         return single_open(file, acpi_video_bus_info_seq_show,
1217                            PDE(inode)->data);
1218 }
1219
1220 static int acpi_video_bus_ROM_seq_show(struct seq_file *seq, void *offset)
1221 {
1222         struct acpi_video_bus *video = seq->private;
1223
1224
1225         if (!video)
1226                 goto end;
1227
1228         printk(KERN_INFO PREFIX "Please implement %s\n", __func__);
1229         seq_printf(seq, "<TODO>\n");
1230
1231       end:
1232         return 0;
1233 }
1234
1235 static int acpi_video_bus_ROM_open_fs(struct inode *inode, struct file *file)
1236 {
1237         return single_open(file, acpi_video_bus_ROM_seq_show, PDE(inode)->data);
1238 }
1239
1240 static int acpi_video_bus_POST_info_seq_show(struct seq_file *seq, void *offset)
1241 {
1242         struct acpi_video_bus *video = seq->private;
1243         unsigned long long options;
1244         int status;
1245
1246
1247         if (!video)
1248                 goto end;
1249
1250         status = acpi_video_bus_POST_options(video, &options);
1251         if (ACPI_SUCCESS(status)) {
1252                 if (!(options & 1)) {
1253                         printk(KERN_WARNING PREFIX
1254                                "The motherboard VGA device is not listed as a possible POST device.\n");
1255                         printk(KERN_WARNING PREFIX
1256                                "This indicates a BIOS bug. Please contact the manufacturer.\n");
1257                 }
1258                 printk("%llx\n", options);
1259                 seq_printf(seq, "can POST: <integrated video>");
1260                 if (options & 2)
1261                         seq_printf(seq, " <PCI video>");
1262                 if (options & 4)
1263                         seq_printf(seq, " <AGP video>");
1264                 seq_putc(seq, '\n');
1265         } else
1266                 seq_printf(seq, "<not supported>\n");
1267       end:
1268         return 0;
1269 }
1270
1271 static int
1272 acpi_video_bus_POST_info_open_fs(struct inode *inode, struct file *file)
1273 {
1274         return single_open(file, acpi_video_bus_POST_info_seq_show,
1275                            PDE(inode)->data);
1276 }
1277
1278 static int acpi_video_bus_POST_seq_show(struct seq_file *seq, void *offset)
1279 {
1280         struct acpi_video_bus *video = seq->private;
1281         int status;
1282         unsigned long long id;
1283
1284
1285         if (!video)
1286                 goto end;
1287
1288         status = acpi_video_bus_get_POST(video, &id);
1289         if (!ACPI_SUCCESS(status)) {
1290                 seq_printf(seq, "<not supported>\n");
1291                 goto end;
1292         }
1293         seq_printf(seq, "device POSTed is <%s>\n", device_decode[id & 3]);
1294
1295       end:
1296         return 0;
1297 }
1298
1299 static int acpi_video_bus_DOS_seq_show(struct seq_file *seq, void *offset)
1300 {
1301         struct acpi_video_bus *video = seq->private;
1302
1303
1304         seq_printf(seq, "DOS setting: <%d>\n", video->dos_setting);
1305
1306         return 0;
1307 }
1308
1309 static int acpi_video_bus_POST_open_fs(struct inode *inode, struct file *file)
1310 {
1311         return single_open(file, acpi_video_bus_POST_seq_show,
1312                            PDE(inode)->data);
1313 }
1314
1315 static int acpi_video_bus_DOS_open_fs(struct inode *inode, struct file *file)
1316 {
1317         return single_open(file, acpi_video_bus_DOS_seq_show, PDE(inode)->data);
1318 }
1319
1320 static ssize_t
1321 acpi_video_bus_write_POST(struct file *file,
1322                           const char __user * buffer,
1323                           size_t count, loff_t * data)
1324 {
1325         int status;
1326         struct seq_file *m = file->private_data;
1327         struct acpi_video_bus *video = m->private;
1328         char str[12] = { 0 };
1329         unsigned long long opt, options;
1330
1331
1332         if (!video || count + 1 > sizeof str)
1333                 return -EINVAL;
1334
1335         status = acpi_video_bus_POST_options(video, &options);
1336         if (!ACPI_SUCCESS(status))
1337                 return -EINVAL;
1338
1339         if (copy_from_user(str, buffer, count))
1340                 return -EFAULT;
1341
1342         str[count] = 0;
1343         opt = strtoul(str, NULL, 0);
1344         if (opt > 3)
1345                 return -EFAULT;
1346
1347         /* just in case an OEM 'forgot' the motherboard... */
1348         options |= 1;
1349
1350         if (options & (1ul << opt)) {
1351                 status = acpi_video_bus_set_POST(video, opt);
1352                 if (!ACPI_SUCCESS(status))
1353                         return -EFAULT;
1354
1355         }
1356
1357         return count;
1358 }
1359
1360 static ssize_t
1361 acpi_video_bus_write_DOS(struct file *file,
1362                          const char __user * buffer,
1363                          size_t count, loff_t * data)
1364 {
1365         int status;
1366         struct seq_file *m = file->private_data;
1367         struct acpi_video_bus *video = m->private;
1368         char str[12] = { 0 };
1369         unsigned long opt;
1370
1371
1372         if (!video || count + 1 > sizeof str)
1373                 return -EINVAL;
1374
1375         if (copy_from_user(str, buffer, count))
1376                 return -EFAULT;
1377
1378         str[count] = 0;
1379         opt = strtoul(str, NULL, 0);
1380         if (opt > 7)
1381                 return -EFAULT;
1382
1383         status = acpi_video_bus_DOS(video, opt & 0x3, (opt & 0x4) >> 2);
1384
1385         if (!ACPI_SUCCESS(status))
1386                 return -EFAULT;
1387
1388         return count;
1389 }
1390
1391 static int acpi_video_bus_add_fs(struct acpi_device *device)
1392 {
1393         struct acpi_video_bus *video = acpi_driver_data(device);
1394         struct proc_dir_entry *device_dir;
1395         struct proc_dir_entry *entry;
1396
1397         device_dir = proc_mkdir(acpi_device_bid(device), acpi_video_dir);
1398         if (!device_dir)
1399                 return -ENOMEM;
1400
1401         device_dir->owner = THIS_MODULE;
1402
1403         /* 'info' [R] */
1404         entry = proc_create_data("info", S_IRUGO, device_dir,
1405                                  &acpi_video_bus_info_fops,
1406                                  acpi_driver_data(device));
1407         if (!entry)
1408                 goto err_remove_dir;
1409
1410         /* 'ROM' [R] */
1411         entry = proc_create_data("ROM", S_IRUGO, device_dir,
1412                                  &acpi_video_bus_ROM_fops,
1413                                  acpi_driver_data(device));
1414         if (!entry)
1415                 goto err_remove_info;
1416
1417         /* 'POST_info' [R] */
1418         entry = proc_create_data("POST_info", S_IRUGO, device_dir,
1419                                  &acpi_video_bus_POST_info_fops,
1420                                  acpi_driver_data(device));
1421         if (!entry)
1422                 goto err_remove_rom;
1423
1424         /* 'POST' [R/W] */
1425         acpi_video_bus_POST_fops.write = acpi_video_bus_write_POST;
1426         entry = proc_create_data("POST", S_IFREG | S_IRUGO | S_IWUSR,
1427                                  device_dir,
1428                                  &acpi_video_bus_POST_fops,
1429                                  acpi_driver_data(device));
1430         if (!entry)
1431                 goto err_remove_post_info;
1432
1433         /* 'DOS' [R/W] */
1434         acpi_video_bus_DOS_fops.write = acpi_video_bus_write_DOS;
1435         entry = proc_create_data("DOS", S_IFREG | S_IRUGO | S_IWUSR,
1436                                  device_dir,
1437                                  &acpi_video_bus_DOS_fops,
1438                                  acpi_driver_data(device));
1439         if (!entry)
1440                 goto err_remove_post;
1441
1442         video->dir = acpi_device_dir(device) = device_dir;
1443         return 0;
1444
1445  err_remove_post:
1446         remove_proc_entry("POST", device_dir);
1447  err_remove_post_info:
1448         remove_proc_entry("POST_info", device_dir);
1449  err_remove_rom:
1450         remove_proc_entry("ROM", device_dir);
1451  err_remove_info:
1452         remove_proc_entry("info", device_dir);
1453  err_remove_dir:
1454         remove_proc_entry(acpi_device_bid(device), acpi_video_dir);
1455         return -ENOMEM;
1456 }
1457
1458 static int acpi_video_bus_remove_fs(struct acpi_device *device)
1459 {
1460         struct proc_dir_entry *device_dir = acpi_device_dir(device);
1461
1462         if (device_dir) {
1463                 remove_proc_entry("info", device_dir);
1464                 remove_proc_entry("ROM", device_dir);
1465                 remove_proc_entry("POST_info", device_dir);
1466                 remove_proc_entry("POST", device_dir);
1467                 remove_proc_entry("DOS", device_dir);
1468                 remove_proc_entry(acpi_device_bid(device), acpi_video_dir);
1469                 acpi_device_dir(device) = NULL;
1470         }
1471
1472         return 0;
1473 }
1474
1475 /* --------------------------------------------------------------------------
1476                                  Driver Interface
1477    -------------------------------------------------------------------------- */
1478
1479 /* device interface */
1480 static struct acpi_video_device_attrib*
1481 acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
1482 {
1483         struct acpi_video_enumerated_device *ids;
1484         int i;
1485
1486         for (i = 0; i < video->attached_count; i++) {
1487                 ids = &video->attached_array[i];
1488                 if ((ids->value.int_val & 0xffff) == device_id)
1489                         return &ids->value.attrib;
1490         }
1491
1492         return NULL;
1493 }
1494
1495 static int
1496 acpi_video_bus_get_one_device(struct acpi_device *device,
1497                               struct acpi_video_bus *video)
1498 {
1499         unsigned long long device_id;
1500         int status;
1501         struct acpi_video_device *data;
1502         struct acpi_video_device_attrib* attribute;
1503
1504         if (!device || !video)
1505                 return -EINVAL;
1506
1507         status =
1508             acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1509         if (ACPI_SUCCESS(status)) {
1510
1511                 data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
1512                 if (!data)
1513                         return -ENOMEM;
1514
1515                 strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
1516                 strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1517                 device->driver_data = data;
1518
1519                 data->device_id = device_id;
1520                 data->video = video;
1521                 data->dev = device;
1522
1523                 attribute = acpi_video_get_device_attr(video, device_id);
1524
1525                 if((attribute != NULL) && attribute->device_id_scheme) {
1526                         switch (attribute->display_type) {
1527                         case ACPI_VIDEO_DISPLAY_CRT:
1528                                 data->flags.crt = 1;
1529                                 break;
1530                         case ACPI_VIDEO_DISPLAY_TV:
1531                                 data->flags.tvout = 1;
1532                                 break;
1533                         case ACPI_VIDEO_DISPLAY_DVI:
1534                                 data->flags.dvi = 1;
1535                                 break;
1536                         case ACPI_VIDEO_DISPLAY_LCD:
1537                                 data->flags.lcd = 1;
1538                                 break;
1539                         default:
1540                                 data->flags.unknown = 1;
1541                                 break;
1542                         }
1543                         if(attribute->bios_can_detect)
1544                                 data->flags.bios = 1;
1545                 } else
1546                         data->flags.unknown = 1;
1547
1548                 acpi_video_device_bind(video, data);
1549                 acpi_video_device_find_cap(data);
1550
1551                 status = acpi_install_notify_handler(device->handle,
1552                                                      ACPI_DEVICE_NOTIFY,
1553                                                      acpi_video_device_notify,
1554                                                      data);
1555                 if (ACPI_FAILURE(status)) {
1556                         printk(KERN_ERR PREFIX
1557                                           "Error installing notify handler\n");
1558                         if(data->brightness)
1559                                 kfree(data->brightness->levels);
1560                         kfree(data->brightness);
1561                         kfree(data);
1562                         return -ENODEV;
1563                 }
1564
1565                 mutex_lock(&video->device_list_lock);
1566                 list_add_tail(&data->entry, &video->video_device_list);
1567                 mutex_unlock(&video->device_list_lock);
1568
1569                 acpi_video_device_add_fs(device);
1570
1571                 return 0;
1572         }
1573
1574         return -ENOENT;
1575 }
1576
1577 /*
1578  *  Arg:
1579  *      video   : video bus device
1580  *
1581  *  Return:
1582  *      none
1583  *
1584  *  Enumerate the video device list of the video bus,
1585  *  bind the ids with the corresponding video devices
1586  *  under the video bus.
1587  */
1588
1589 static void acpi_video_device_rebind(struct acpi_video_bus *video)
1590 {
1591         struct acpi_video_device *dev;
1592
1593         mutex_lock(&video->device_list_lock);
1594
1595         list_for_each_entry(dev, &video->video_device_list, entry)
1596                 acpi_video_device_bind(video, dev);
1597
1598         mutex_unlock(&video->device_list_lock);
1599 }
1600
1601 /*
1602  *  Arg:
1603  *      video   : video bus device
1604  *      device  : video output device under the video
1605  *              bus
1606  *
1607  *  Return:
1608  *      none
1609  *
1610  *  Bind the ids with the corresponding video devices
1611  *  under the video bus.
1612  */
1613
1614 static void
1615 acpi_video_device_bind(struct acpi_video_bus *video,
1616                        struct acpi_video_device *device)
1617 {
1618         struct acpi_video_enumerated_device *ids;
1619         int i;
1620
1621         for (i = 0; i < video->attached_count; i++) {
1622                 ids = &video->attached_array[i];
1623                 if (device->device_id == (ids->value.int_val & 0xffff)) {
1624                         ids->bind_info = device;
1625                         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
1626                 }
1627         }
1628 }
1629
1630 /*
1631  *  Arg:
1632  *      video   : video bus device
1633  *
1634  *  Return:
1635  *      < 0     : error
1636  *
1637  *  Call _DOD to enumerate all devices attached to display adapter
1638  *
1639  */
1640
1641 static int acpi_video_device_enumerate(struct acpi_video_bus *video)
1642 {
1643         int status;
1644         int count;
1645         int i;
1646         struct acpi_video_enumerated_device *active_list;
1647         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1648         union acpi_object *dod = NULL;
1649         union acpi_object *obj;
1650
1651         status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
1652         if (!ACPI_SUCCESS(status)) {
1653                 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1654                 return status;
1655         }
1656
1657         dod = buffer.pointer;
1658         if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1659                 ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
1660                 status = -EFAULT;
1661                 goto out;
1662         }
1663
1664         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
1665                           dod->package.count));
1666
1667         active_list = kcalloc(1 + dod->package.count,
1668                               sizeof(struct acpi_video_enumerated_device),
1669                               GFP_KERNEL);
1670         if (!active_list) {
1671                 status = -ENOMEM;
1672                 goto out;
1673         }
1674
1675         count = 0;
1676         for (i = 0; i < dod->package.count; i++) {
1677                 obj = &dod->package.elements[i];
1678
1679                 if (obj->type != ACPI_TYPE_INTEGER) {
1680                         printk(KERN_ERR PREFIX
1681                                 "Invalid _DOD data in element %d\n", i);
1682                         continue;
1683                 }
1684
1685                 active_list[count].value.int_val = obj->integer.value;
1686                 active_list[count].bind_info = NULL;
1687                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
1688                                   (int)obj->integer.value));
1689                 count++;
1690         }
1691
1692         kfree(video->attached_array);
1693
1694         video->attached_array = active_list;
1695         video->attached_count = count;
1696
1697  out:
1698         kfree(buffer.pointer);
1699         return status;
1700 }
1701
1702 static int
1703 acpi_video_get_next_level(struct acpi_video_device *device,
1704                           u32 level_current, u32 event)
1705 {
1706         int min, max, min_above, max_below, i, l, delta = 255;
1707         max = max_below = 0;
1708         min = min_above = 255;
1709         /* Find closest level to level_current */
1710         for (i = 0; i < device->brightness->count; i++) {
1711                 l = device->brightness->levels[i];
1712                 if (abs(l - level_current) < abs(delta)) {
1713                         delta = l - level_current;
1714                         if (!delta)
1715                                 break;
1716                 }
1717         }
1718         /* Ajust level_current to closest available level */
1719         level_current += delta;
1720         for (i = 0; i < device->brightness->count; i++) {
1721                 l = device->brightness->levels[i];
1722                 if (l < min)
1723                         min = l;
1724                 if (l > max)
1725                         max = l;
1726                 if (l < min_above && l > level_current)
1727                         min_above = l;
1728                 if (l > max_below && l < level_current)
1729                         max_below = l;
1730         }
1731
1732         switch (event) {
1733         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
1734                 return (level_current < max) ? min_above : min;
1735         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
1736                 return (level_current < max) ? min_above : max;
1737         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
1738                 return (level_current > min) ? max_below : min;
1739         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
1740         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
1741                 return 0;
1742         default:
1743                 return level_current;
1744         }
1745 }
1746
1747 static void
1748 acpi_video_switch_brightness(struct acpi_video_device *device, int event)
1749 {
1750         unsigned long long level_current, level_next;
1751         if (!device->brightness)
1752                 return;
1753         acpi_video_device_lcd_get_level_current(device, &level_current);
1754         level_next = acpi_video_get_next_level(device, level_current, event);
1755         acpi_video_device_lcd_set_level(device, level_next);
1756 }
1757
1758 static int
1759 acpi_video_bus_get_devices(struct acpi_video_bus *video,
1760                            struct acpi_device *device)
1761 {
1762         int status = 0;
1763         struct acpi_device *dev;
1764
1765         acpi_video_device_enumerate(video);
1766
1767         list_for_each_entry(dev, &device->children, node) {
1768
1769                 status = acpi_video_bus_get_one_device(dev, video);
1770                 if (ACPI_FAILURE(status)) {
1771                         printk(KERN_WARNING PREFIX
1772                                         "Cant attach device");
1773                         continue;
1774                 }
1775         }
1776         return status;
1777 }
1778
1779 static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
1780 {
1781         acpi_status status;
1782         struct acpi_video_bus *video;
1783
1784
1785         if (!device || !device->video)
1786                 return -ENOENT;
1787
1788         video = device->video;
1789
1790         acpi_video_device_remove_fs(device->dev);
1791
1792         status = acpi_remove_notify_handler(device->dev->handle,
1793                                             ACPI_DEVICE_NOTIFY,
1794                                             acpi_video_device_notify);
1795         backlight_device_unregister(device->backlight);
1796         if (device->cdev) {
1797                 sysfs_remove_link(&device->dev->dev.kobj,
1798                                   "thermal_cooling");
1799                 sysfs_remove_link(&device->cdev->device.kobj,
1800                                   "device");
1801                 thermal_cooling_device_unregister(device->cdev);
1802                 device->cdev = NULL;
1803         }
1804         video_output_unregister(device->output_dev);
1805
1806         return 0;
1807 }
1808
1809 static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
1810 {
1811         int status;
1812         struct acpi_video_device *dev, *next;
1813
1814         mutex_lock(&video->device_list_lock);
1815
1816         list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
1817
1818                 status = acpi_video_bus_put_one_device(dev);
1819                 if (ACPI_FAILURE(status))
1820                         printk(KERN_WARNING PREFIX
1821                                "hhuuhhuu bug in acpi video driver.\n");
1822
1823                 if (dev->brightness) {
1824                         kfree(dev->brightness->levels);
1825                         kfree(dev->brightness);
1826                 }
1827                 list_del(&dev->entry);
1828                 kfree(dev);
1829         }
1830
1831         mutex_unlock(&video->device_list_lock);
1832
1833         return 0;
1834 }
1835
1836 /* acpi_video interface */
1837
1838 static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
1839 {
1840         return acpi_video_bus_DOS(video, 0, 0);
1841 }
1842
1843 static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
1844 {
1845         return acpi_video_bus_DOS(video, 0, 1);
1846 }
1847
1848 static void acpi_video_bus_notify(acpi_handle handle, u32 event, void *data)
1849 {
1850         struct acpi_video_bus *video = data;
1851         struct acpi_device *device = NULL;
1852         struct input_dev *input;
1853         int keycode;
1854
1855         if (!video)
1856                 return;
1857
1858         device = video->device;
1859         input = video->input;
1860
1861         switch (event) {
1862         case ACPI_VIDEO_NOTIFY_SWITCH:  /* User requested a switch,
1863                                          * most likely via hotkey. */
1864                 acpi_bus_generate_proc_event(device, event, 0);
1865                 keycode = KEY_SWITCHVIDEOMODE;
1866                 break;
1867
1868         case ACPI_VIDEO_NOTIFY_PROBE:   /* User plugged in or removed a video
1869                                          * connector. */
1870                 acpi_video_device_enumerate(video);
1871                 acpi_video_device_rebind(video);
1872                 acpi_bus_generate_proc_event(device, event, 0);
1873                 keycode = KEY_SWITCHVIDEOMODE;
1874                 break;
1875
1876         case ACPI_VIDEO_NOTIFY_CYCLE:   /* Cycle Display output hotkey pressed. */
1877                 acpi_bus_generate_proc_event(device, event, 0);
1878                 keycode = KEY_SWITCHVIDEOMODE;
1879                 break;
1880         case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:     /* Next Display output hotkey pressed. */
1881                 acpi_bus_generate_proc_event(device, event, 0);
1882                 keycode = KEY_VIDEO_NEXT;
1883                 break;
1884         case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:     /* previous Display output hotkey pressed. */
1885                 acpi_bus_generate_proc_event(device, event, 0);
1886                 keycode = KEY_VIDEO_PREV;
1887                 break;
1888
1889         default:
1890                 keycode = KEY_UNKNOWN;
1891                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1892                                   "Unsupported event [0x%x]\n", event));
1893                 break;
1894         }
1895
1896         acpi_notifier_call_chain(device, event, 0);
1897         input_report_key(input, keycode, 1);
1898         input_sync(input);
1899         input_report_key(input, keycode, 0);
1900         input_sync(input);
1901
1902         return;
1903 }
1904
1905 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
1906 {
1907         struct acpi_video_device *video_device = data;
1908         struct acpi_device *device = NULL;
1909         struct acpi_video_bus *bus;
1910         struct input_dev *input;
1911         int keycode;
1912
1913         if (!video_device)
1914                 return;
1915
1916         device = video_device->dev;
1917         bus = video_device->video;
1918         input = bus->input;
1919
1920         switch (event) {
1921         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:        /* Cycle brightness */
1922                 if (brightness_switch_enabled)
1923                         acpi_video_switch_brightness(video_device, event);
1924                 acpi_bus_generate_proc_event(device, event, 0);
1925                 keycode = KEY_BRIGHTNESS_CYCLE;
1926                 break;
1927         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:  /* Increase brightness */
1928                 if (brightness_switch_enabled)
1929                         acpi_video_switch_brightness(video_device, event);
1930                 acpi_bus_generate_proc_event(device, event, 0);
1931                 keycode = KEY_BRIGHTNESSUP;
1932                 break;
1933         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:  /* Decrease brightness */
1934                 if (brightness_switch_enabled)
1935                         acpi_video_switch_brightness(video_device, event);
1936                 acpi_bus_generate_proc_event(device, event, 0);
1937                 keycode = KEY_BRIGHTNESSDOWN;
1938                 break;
1939         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS: /* zero brightnesss */
1940                 if (brightness_switch_enabled)
1941                         acpi_video_switch_brightness(video_device, event);
1942                 acpi_bus_generate_proc_event(device, event, 0);
1943                 keycode = KEY_BRIGHTNESS_ZERO;
1944                 break;
1945         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:     /* display device off */
1946                 if (brightness_switch_enabled)
1947                         acpi_video_switch_brightness(video_device, event);
1948                 acpi_bus_generate_proc_event(device, event, 0);
1949                 keycode = KEY_DISPLAY_OFF;
1950                 break;
1951         default:
1952                 keycode = KEY_UNKNOWN;
1953                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1954                                   "Unsupported event [0x%x]\n", event));
1955                 break;
1956         }
1957
1958         acpi_notifier_call_chain(device, event, 0);
1959         input_report_key(input, keycode, 1);
1960         input_sync(input);
1961         input_report_key(input, keycode, 0);
1962         input_sync(input);
1963
1964         return;
1965 }
1966
1967 static int instance;
1968 static int acpi_video_resume(struct acpi_device *device)
1969 {
1970         struct acpi_video_bus *video;
1971         struct acpi_video_device *video_device;
1972         int i;
1973
1974         if (!device || !acpi_driver_data(device))
1975                 return -EINVAL;
1976
1977         video = acpi_driver_data(device);
1978
1979         for (i = 0; i < video->attached_count; i++) {
1980                 video_device = video->attached_array[i].bind_info;
1981                 if (video_device && video_device->backlight)
1982                         acpi_video_set_brightness(video_device->backlight);
1983         }
1984         return AE_OK;
1985 }
1986
1987 static int acpi_video_bus_add(struct acpi_device *device)
1988 {
1989         acpi_status status;
1990         struct acpi_video_bus *video;
1991         struct input_dev *input;
1992         int error;
1993
1994         video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
1995         if (!video)
1996                 return -ENOMEM;
1997
1998         /* a hack to fix the duplicate name "VID" problem on T61 */
1999         if (!strcmp(device->pnp.bus_id, "VID")) {
2000                 if (instance)
2001                         device->pnp.bus_id[3] = '0' + instance;
2002                 instance ++;
2003         }
2004
2005         video->device = device;
2006         strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
2007         strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
2008         device->driver_data = video;
2009
2010         acpi_video_bus_find_cap(video);
2011         error = acpi_video_bus_check(video);
2012         if (error)
2013                 goto err_free_video;
2014
2015         error = acpi_video_bus_add_fs(device);
2016         if (error)
2017                 goto err_free_video;
2018
2019         mutex_init(&video->device_list_lock);
2020         INIT_LIST_HEAD(&video->video_device_list);
2021
2022         acpi_video_bus_get_devices(video, device);
2023         acpi_video_bus_start_devices(video);
2024
2025         status = acpi_install_notify_handler(device->handle,
2026                                              ACPI_DEVICE_NOTIFY,
2027                                              acpi_video_bus_notify, video);
2028         if (ACPI_FAILURE(status)) {
2029                 printk(KERN_ERR PREFIX
2030                                   "Error installing notify handler\n");
2031                 error = -ENODEV;
2032                 goto err_stop_video;
2033         }
2034
2035         video->input = input = input_allocate_device();
2036         if (!input) {
2037                 error = -ENOMEM;
2038                 goto err_uninstall_notify;
2039         }
2040
2041         snprintf(video->phys, sizeof(video->phys),
2042                 "%s/video/input0", acpi_device_hid(video->device));
2043
2044         input->name = acpi_device_name(video->device);
2045         input->phys = video->phys;
2046         input->id.bustype = BUS_HOST;
2047         input->id.product = 0x06;
2048         input->dev.parent = &device->dev;
2049         input->evbit[0] = BIT(EV_KEY);
2050         set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
2051         set_bit(KEY_VIDEO_NEXT, input->keybit);
2052         set_bit(KEY_VIDEO_PREV, input->keybit);
2053         set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
2054         set_bit(KEY_BRIGHTNESSUP, input->keybit);
2055         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
2056         set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
2057         set_bit(KEY_DISPLAY_OFF, input->keybit);
2058         set_bit(KEY_UNKNOWN, input->keybit);
2059
2060         error = input_register_device(input);
2061         if (error)
2062                 goto err_free_input_dev;
2063
2064         printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
2065                ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
2066                video->flags.multihead ? "yes" : "no",
2067                video->flags.rom ? "yes" : "no",
2068                video->flags.post ? "yes" : "no");
2069
2070         return 0;
2071
2072  err_free_input_dev:
2073         input_free_device(input);
2074  err_uninstall_notify:
2075         acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY,
2076                                    acpi_video_bus_notify);
2077  err_stop_video:
2078         acpi_video_bus_stop_devices(video);
2079         acpi_video_bus_put_devices(video);
2080         kfree(video->attached_array);
2081         acpi_video_bus_remove_fs(device);
2082  err_free_video:
2083         kfree(video);
2084         device->driver_data = NULL;
2085
2086         return error;
2087 }
2088
2089 static int acpi_video_bus_remove(struct acpi_device *device, int type)
2090 {
2091         acpi_status status = 0;
2092         struct acpi_video_bus *video = NULL;
2093
2094
2095         if (!device || !acpi_driver_data(device))
2096                 return -EINVAL;
2097
2098         video = acpi_driver_data(device);
2099
2100         acpi_video_bus_stop_devices(video);
2101
2102         status = acpi_remove_notify_handler(video->device->handle,
2103                                             ACPI_DEVICE_NOTIFY,
2104                                             acpi_video_bus_notify);
2105
2106         acpi_video_bus_put_devices(video);
2107         acpi_video_bus_remove_fs(device);
2108
2109         input_unregister_device(video->input);
2110         kfree(video->attached_array);
2111         kfree(video);
2112
2113         return 0;
2114 }
2115
2116 static int __init acpi_video_init(void)
2117 {
2118         int result = 0;
2119
2120         acpi_video_dir = proc_mkdir(ACPI_VIDEO_CLASS, acpi_root_dir);
2121         if (!acpi_video_dir)
2122                 return -ENODEV;
2123         acpi_video_dir->owner = THIS_MODULE;
2124
2125         result = acpi_bus_register_driver(&acpi_video_bus);
2126         if (result < 0) {
2127                 remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);
2128                 return -ENODEV;
2129         }
2130
2131         return 0;
2132 }
2133
2134 static void __exit acpi_video_exit(void)
2135 {
2136
2137         acpi_bus_unregister_driver(&acpi_video_bus);
2138
2139         remove_proc_entry(ACPI_VIDEO_CLASS, acpi_root_dir);
2140
2141         return;
2142 }
2143
2144 module_init(acpi_video_init);
2145 module_exit(acpi_video_exit);