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/input.h>
  34 #include <linux/backlight.h>
  35 #include <linux/thermal.h>
  36 #include <linux/sort.h>
  37 #include <linux/pci.h>
  38 #include <linux/pci_ids.h>
  39 #include <linux/slab.h>
  40 #include <asm/uaccess.h>
  41 #include <linux/dmi.h>
  42 #include <acpi/acpi_bus.h>
  43 #include <acpi/acpi_drivers.h>
  44 #include <linux/suspend.h>
  45 #include <acpi/video.h>
  46
  47 #define PREFIX "ACPI: "
  48
  49 #define ACPI_VIDEO_BUS_NAME             "Video Bus"
  50 #define ACPI_VIDEO_DEVICE_NAME          "Video Device"
  51 #define ACPI_VIDEO_NOTIFY_SWITCH        0x80
  52 #define ACPI_VIDEO_NOTIFY_PROBE         0x81
  53 #define ACPI_VIDEO_NOTIFY_CYCLE         0x82
  54 #define ACPI_VIDEO_NOTIFY_NEXT_OUTPUT   0x83
  55 #define ACPI_VIDEO_NOTIFY_PREV_OUTPUT   0x84
  56
  57 #define ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS      0x85
  58 #define ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS        0x86
  59 #define ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS        0x87
  60 #define ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS       0x88
  61 #define ACPI_VIDEO_NOTIFY_DISPLAY_OFF           0x89
  62
  63 #define MAX_NAME_LEN    20
  64
  65 #define _COMPONENT              ACPI_VIDEO_COMPONENT
  66 ACPI_MODULE_NAME("video");
  67
  68 MODULE_AUTHOR("Bruno Ducrot");
  69 MODULE_DESCRIPTION("ACPI Video Driver");
  70 MODULE_LICENSE("GPL");
  71
  72 static int brightness_switch_enabled = 1;
  73 module_param(brightness_switch_enabled, bool, 0644);
  74
  75 /*
  76  * By default, we don't allow duplicate ACPI video bus devices
  77  * under the same VGA controller
  78  */
  79 static int allow_duplicates;
  80 module_param(allow_duplicates, bool, 0644);
  81
  82 /*
  83  * Some BIOSes claim they use minimum backlight at boot,
  84  * and this may bring dimming screen after boot
  85  */
  86 static int use_bios_initial_backlight = 1;
  87 module_param(use_bios_initial_backlight, bool, 0644);
  88
  89 static int register_count = 0;
  90 static int acpi_video_bus_add(struct acpi_device *device);
  91 static int acpi_video_bus_remove(struct acpi_device *device, int type);
  92 static void acpi_video_bus_notify(struct acpi_device *device, u32 event);
  93
  94 static const struct acpi_device_id video_device_ids[] = {
  95         {ACPI_VIDEO_HID, 0},
  96         {"", 0},
  97 };
  98 MODULE_DEVICE_TABLE(acpi, video_device_ids);
  99
 100 static struct acpi_driver acpi_video_bus = {
 101         .name = "video",
 102         .class = ACPI_VIDEO_CLASS,
 103         .ids = video_device_ids,
 104         .ops = {
 105                 .add = acpi_video_bus_add,
 106                 .remove = acpi_video_bus_remove,
 107                 .notify = acpi_video_bus_notify,
 108                 },
 109 };
 110
 111 struct acpi_video_bus_flags {
 112         u8 multihead:1;         /* can switch video heads */
 113         u8 rom:1;               /* can retrieve a video rom */
 114         u8 post:1;              /* can configure the head to */
 115         u8 reserved:5;
 116 };
 117
 118 struct acpi_video_bus_cap {
 119         u8 _DOS:1;              /*Enable/Disable output switching */
 120         u8 _DOD:1;              /*Enumerate all devices attached to display adapter */
 121         u8 _ROM:1;              /*Get ROM Data */
 122         u8 _GPD:1;              /*Get POST Device */
 123         u8 _SPD:1;              /*Set POST Device */
 124         u8 _VPO:1;              /*Video POST Options */
 125         u8 reserved:2;
 126 };
 127
 128 struct acpi_video_device_attrib {
 129         u32 display_index:4;    /* A zero-based instance of the Display */
 130         u32 display_port_attachment:4;  /*This field differentiates the display type */
 131         u32 display_type:4;     /*Describe the specific type in use */
 132         u32 vendor_specific:4;  /*Chipset Vendor Specific */
 133         u32 bios_can_detect:1;  /*BIOS can detect the device */
 134         u32 depend_on_vga:1;    /*Non-VGA output device whose power is related to
 135                                    the VGA device. */
 136         u32 pipe_id:3;          /*For VGA multiple-head devices. */
 137         u32 reserved:10;        /*Must be 0 */
 138         u32 device_id_scheme:1; /*Device ID Scheme */
 139 };
 140
 141 struct acpi_video_enumerated_device {
 142         union {
 143                 u32 int_val;
 144                 struct acpi_video_device_attrib attrib;
 145         } value;
 146         struct acpi_video_device *bind_info;
 147 };
 148
 149 struct acpi_video_bus {
 150         struct acpi_device *device;
 151         u8 dos_setting;
 152         struct acpi_video_enumerated_device *attached_array;
 153         u8 attached_count;
 154         struct acpi_video_bus_cap cap;
 155         struct acpi_video_bus_flags flags;
 156         struct list_head video_device_list;
 157         struct mutex device_list_lock;  /* protects video_device_list */
 158         struct input_dev *input;
 159         char phys[32];  /* for input device */
 160         struct notifier_block pm_nb;
 161 };
 162
 163 struct acpi_video_device_flags {
 164         u8 crt:1;
 165         u8 lcd:1;
 166         u8 tvout:1;
 167         u8 dvi:1;
 168         u8 bios:1;
 169         u8 unknown:1;
 170         u8 reserved:2;
 171 };
 172
 173 struct acpi_video_device_cap {
 174         u8 _ADR:1;              /*Return the unique ID */
 175         u8 _BCL:1;              /*Query list of brightness control levels supported */
 176         u8 _BCM:1;              /*Set the brightness level */
 177         u8 _BQC:1;              /* Get current brightness level */
 178         u8 _BCQ:1;              /* Some buggy BIOS uses _BCQ instead of _BQC */
 179         u8 _DDC:1;              /*Return the EDID for this device */
 180 };
 181
 182 struct acpi_video_brightness_flags {
 183         u8 _BCL_no_ac_battery_levels:1; /* no AC/Battery levels in _BCL */
 184         u8 _BCL_reversed:1;             /* _BCL package is in a reversed order*/
 185         u8 _BCL_use_index:1;            /* levels in _BCL are index values */
 186         u8 _BCM_use_index:1;            /* input of _BCM is an index value */
 187         u8 _BQC_use_index:1;            /* _BQC returns an index value */
 188 };
 189
 190 struct acpi_video_device_brightness {
 191         int curr;
 192         int count;
 193         int *levels;
 194         struct acpi_video_brightness_flags flags;
 195 };
 196
 197 struct acpi_video_device {
 198         unsigned long device_id;
 199         struct acpi_video_device_flags flags;
 200         struct acpi_video_device_cap cap;
 201         struct list_head entry;
 202         struct acpi_video_bus *video;
 203         struct acpi_device *dev;
 204         struct acpi_video_device_brightness *brightness;
 205         struct backlight_device *backlight;
 206         struct thermal_cooling_device *cooling_dev;
 207 };
 208
 209 static const char device_decode[][30] = {
 210         "motherboard VGA device",
 211         "PCI VGA device",
 212         "AGP VGA device",
 213         "UNKNOWN",
 214 };
 215
 216 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data);
 217 static void acpi_video_device_rebind(struct acpi_video_bus *video);
 218 static void acpi_video_device_bind(struct acpi_video_bus *video,
 219                                    struct acpi_video_device *device);
 220 static int acpi_video_device_enumerate(struct acpi_video_bus *video);
 221 static int acpi_video_device_lcd_set_level(struct acpi_video_device *device,
 222                         int level);
 223 static int acpi_video_device_lcd_get_level_current(
 224                         struct acpi_video_device *device,
 225                         unsigned long long *level, int init);
 226 static int acpi_video_get_next_level(struct acpi_video_device *device,
 227                                      u32 level_current, u32 event);
 228 static int acpi_video_switch_brightness(struct acpi_video_device *device,
 229                                          int event);
 230
 231 /*backlight device sysfs support*/
 232 static int acpi_video_get_brightness(struct backlight_device *bd)
 233 {
 234         unsigned long long cur_level;
 235         int i;
 236         struct acpi_video_device *vd =
 237                 (struct acpi_video_device *)bl_get_data(bd);
 238
 239         if (acpi_video_device_lcd_get_level_current(vd, &cur_level, 0))
 240                 return -EINVAL;
 241         for (i = 2; i < vd->brightness->count; i++) {
 242                 if (vd->brightness->levels[i] == cur_level)
 243                         /* The first two entries are special - see page 575
 244                            of the ACPI spec 3.0 */
 245                         return i-2;
 246         }
 247         return 0;
 248 }
 249
 250 static int acpi_video_set_brightness(struct backlight_device *bd)
 251 {
 252         int request_level = bd->props.brightness + 2;
 253         struct acpi_video_device *vd =
 254                 (struct acpi_video_device *)bl_get_data(bd);
 255
 256         return acpi_video_device_lcd_set_level(vd,
 257                                 vd->brightness->levels[request_level]);
 258 }
 259
 260 static const struct backlight_ops acpi_backlight_ops = {
 261         .get_brightness = acpi_video_get_brightness,
 262         .update_status  = acpi_video_set_brightness,
 263 };
 264
 265 /* thermal cooling device callbacks */
 266 static int video_get_max_state(struct thermal_cooling_device *cooling_dev, unsigned
 267                                long *state)
 268 {
 269         struct acpi_device *device = cooling_dev->devdata;
 270         struct acpi_video_device *video = acpi_driver_data(device);
 271
 272         *state = video->brightness->count - 3;
 273         return 0;
 274 }
 275
 276 static int video_get_cur_state(struct thermal_cooling_device *cooling_dev, unsigned
 277                                long *state)
 278 {
 279         struct acpi_device *device = cooling_dev->devdata;
 280         struct acpi_video_device *video = acpi_driver_data(device);
 281         unsigned long long level;
 282         int offset;
 283
 284         if (acpi_video_device_lcd_get_level_current(video, &level, 0))
 285                 return -EINVAL;
 286         for (offset = 2; offset < video->brightness->count; offset++)
 287                 if (level == video->brightness->levels[offset]) {
 288                         *state = video->brightness->count - offset - 1;
 289                         return 0;
 290                 }
 291
 292         return -EINVAL;
 293 }
 294
 295 static int
 296 video_set_cur_state(struct thermal_cooling_device *cooling_dev, unsigned long state)
 297 {
 298         struct acpi_device *device = cooling_dev->devdata;
 299         struct acpi_video_device *video = acpi_driver_data(device);
 300         int level;
 301
 302         if ( state >= video->brightness->count - 2)
 303                 return -EINVAL;
 304
 305         state = video->brightness->count - state;
 306         level = video->brightness->levels[state -1];
 307         return acpi_video_device_lcd_set_level(video, level);
 308 }
 309
 310 static const struct thermal_cooling_device_ops video_cooling_ops = {
 311         .get_max_state = video_get_max_state,
 312         .get_cur_state = video_get_cur_state,
 313         .set_cur_state = video_set_cur_state,
 314 };
 315
 316 /* --------------------------------------------------------------------------
 317                                Video Management
 318    -------------------------------------------------------------------------- */
 319
 320 static int
 321 acpi_video_device_lcd_query_levels(struct acpi_video_device *device,
 322                                    union acpi_object **levels)
 323 {
 324         int status;
 325         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
 326         union acpi_object *obj;
 327
 328
 329         *levels = NULL;
 330
 331         status = acpi_evaluate_object(device->dev->handle, "_BCL", NULL, &buffer);
 332         if (!ACPI_SUCCESS(status))
 333                 return status;
 334         obj = (union acpi_object *)buffer.pointer;
 335         if (!obj || (obj->type != ACPI_TYPE_PACKAGE)) {
 336                 printk(KERN_ERR PREFIX "Invalid _BCL data\n");
 337                 status = -EFAULT;
 338                 goto err;
 339         }
 340
 341         *levels = obj;
 342
 343         return 0;
 344
 345       err:
 346         kfree(buffer.pointer);
 347
 348         return status;
 349 }
 350
 351 static int
 352 acpi_video_device_lcd_set_level(struct acpi_video_device *device, int level)
 353 {
 354         int status;
 355         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 356         struct acpi_object_list args = { 1, &arg0 };
 357         int state;
 358
 359         arg0.integer.value = level;
 360
 361         status = acpi_evaluate_object(device->dev->handle, "_BCM",
 362                                       &args, NULL);
 363         if (ACPI_FAILURE(status)) {
 364                 ACPI_ERROR((AE_INFO, "Evaluating _BCM failed"));
 365                 return -EIO;
 366         }
 367
 368         device->brightness->curr = level;
 369         for (state = 2; state < device->brightness->count; state++)
 370                 if (level == device->brightness->levels[state]) {
 371                         if (device->backlight)
 372                                 device->backlight->props.brightness = state - 2;
 373                         return 0;
 374                 }
 375
 376         ACPI_ERROR((AE_INFO, "Current brightness invalid"));
 377         return -EINVAL;
 378 }
 379
 380 /*
 381  * For some buggy _BQC methods, we need to add a constant value to
 382  * the _BQC return value to get the actual current brightness level
 383  */
 384
 385 static int bqc_offset_aml_bug_workaround;
 386 static int __init video_set_bqc_offset(const struct dmi_system_id *d)
 387 {
 388         bqc_offset_aml_bug_workaround = 9;
 389         return 0;
 390 }
 391
 392 static int video_ignore_initial_backlight(const struct dmi_system_id *d)
 393 {
 394         use_bios_initial_backlight = 0;
 395         return 0;
 396 }
 397
 398 static struct dmi_system_id video_dmi_table[] __initdata = {
 399         /*
 400          * Broken _BQC workaround http://bugzilla.kernel.org/show_bug.cgi?id=13121
 401          */
 402         {
 403          .callback = video_set_bqc_offset,
 404          .ident = "Acer Aspire 5720",
 405          .matches = {
 406                 DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
 407                 DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5720"),
 408                 },
 409         },
 410         {
 411          .callback = video_set_bqc_offset,
 412          .ident = "Acer Aspire 5710Z",
 413          .matches = {
 414                 DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
 415                 DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5710Z"),
 416                 },
 417         },
 418         {
 419          .callback = video_set_bqc_offset,
 420          .ident = "eMachines E510",
 421          .matches = {
 422                 DMI_MATCH(DMI_BOARD_VENDOR, "EMACHINES"),
 423                 DMI_MATCH(DMI_PRODUCT_NAME, "eMachines E510"),
 424                 },
 425         },
 426         {
 427          .callback = video_set_bqc_offset,
 428          .ident = "Acer Aspire 5315",
 429          .matches = {
 430                 DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
 431                 DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5315"),
 432                 },
 433         },
 434         {
 435          .callback = video_set_bqc_offset,
 436          .ident = "Acer Aspire 7720",
 437          .matches = {
 438                 DMI_MATCH(DMI_BOARD_VENDOR, "Acer"),
 439                 DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 7720"),
 440                 },
 441         },
 442         {
 443          .callback = video_ignore_initial_backlight,
 444          .ident = "HP Folio 13-2000",
 445          .matches = {
 446                 DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
 447                 DMI_MATCH(DMI_PRODUCT_NAME, "HP Folio 13 - 2000 Notebook PC"),
 448                 },
 449         },
 450         {
 451          .callback = video_ignore_initial_backlight,
 452          .ident = "HP Pavilion dm4",
 453          .matches = {
 454                 DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
 455                 DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion dm4 Notebook PC"),
 456                 },
 457         },
 458         {
 459          .callback = video_ignore_initial_backlight,
 460          .ident = "HP Pavilion g6 Notebook PC",
 461          .matches = {
 462                  DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
 463                  DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion g6 Notebook PC"),
 464                 },
 465         },
 466         {
 467          .callback = video_ignore_initial_backlight,
 468          .ident = "HP 1000 Notebook PC",
 469          .matches = {
 470                 DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
 471                 DMI_MATCH(DMI_PRODUCT_NAME, "HP 1000 Notebook PC"),
 472                 },
 473         },
 474         {
 475          .callback = video_ignore_initial_backlight,
 476          .ident = "HP Pavilion m4",
 477          .matches = {
 478                 DMI_MATCH(DMI_BOARD_VENDOR, "Hewlett-Packard"),
 479                 DMI_MATCH(DMI_PRODUCT_NAME, "HP Pavilion m4 Notebook PC"),
 480                 },
 481         },
 482         {}
 483 };
 484
 485 static int
 486 acpi_video_device_lcd_get_level_current(struct acpi_video_device *device,
 487                                         unsigned long long *level, int init)
 488 {
 489         acpi_status status = AE_OK;
 490         int i;
 491
 492         if (device->cap._BQC || device->cap._BCQ) {
 493                 char *buf = device->cap._BQC ? "_BQC" : "_BCQ";
 494
 495                 status = acpi_evaluate_integer(device->dev->handle, buf,
 496                                                 NULL, level);
 497                 if (ACPI_SUCCESS(status)) {
 498                         if (device->brightness->flags._BQC_use_index) {
 499                                 if (device->brightness->flags._BCL_reversed)
 500                                         *level = device->brightness->count
 501                                                                  - 3 - (*level);
 502                                 *level = device->brightness->levels[*level + 2];
 503
 504                         }
 505                         *level += bqc_offset_aml_bug_workaround;
 506                         for (i = 2; i < device->brightness->count; i++)
 507                                 if (device->brightness->levels[i] == *level) {
 508                                         device->brightness->curr = *level;
 509                                         return 0;
 510                         }
 511                         if (!init) {
 512                                 /*
 513                                  * BQC returned an invalid level.
 514                                  * Stop using it.
 515                                  */
 516                                 ACPI_WARNING((AE_INFO,
 517                                               "%s returned an invalid level",
 518                                               buf));
 519                                 device->cap._BQC = device->cap._BCQ = 0;
 520                         }
 521                 } else {
 522                         /* Fixme:
 523                          * should we return an error or ignore this failure?
 524                          * dev->brightness->curr is a cached value which stores
 525                          * the correct current backlight level in most cases.
 526                          * ACPI video backlight still works w/ buggy _BQC.
 527                          * http://bugzilla.kernel.org/show_bug.cgi?id=12233
 528                          */
 529                         ACPI_WARNING((AE_INFO, "Evaluating %s failed", buf));
 530                         device->cap._BQC = device->cap._BCQ = 0;
 531                 }
 532         }
 533
 534         *level = device->brightness->curr;
 535         return 0;
 536 }
 537
 538 static int
 539 acpi_video_device_EDID(struct acpi_video_device *device,
 540                        union acpi_object **edid, ssize_t length)
 541 {
 542         int status;
 543         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
 544         union acpi_object *obj;
 545         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 546         struct acpi_object_list args = { 1, &arg0 };
 547
 548
 549         *edid = NULL;
 550
 551         if (!device)
 552                 return -ENODEV;
 553         if (length == 128)
 554                 arg0.integer.value = 1;
 555         else if (length == 256)
 556                 arg0.integer.value = 2;
 557         else
 558                 return -EINVAL;
 559
 560         status = acpi_evaluate_object(device->dev->handle, "_DDC", &args, &buffer);
 561         if (ACPI_FAILURE(status))
 562                 return -ENODEV;
 563
 564         obj = buffer.pointer;
 565
 566         if (obj && obj->type == ACPI_TYPE_BUFFER)
 567                 *edid = obj;
 568         else {
 569                 printk(KERN_ERR PREFIX "Invalid _DDC data\n");
 570                 status = -EFAULT;
 571                 kfree(obj);
 572         }
 573
 574         return status;
 575 }
 576
 577 /* bus */
 578
 579 /*
 580  *  Arg:
 581  *      video           : video bus device pointer
 582  *      bios_flag       :
 583  *              0.      The system BIOS should NOT automatically switch(toggle)
 584  *                      the active display output.
 585  *              1.      The system BIOS should automatically switch (toggle) the
 586  *                      active display output. No switch event.
 587  *              2.      The _DGS value should be locked.
 588  *              3.      The system BIOS should not automatically switch (toggle) the
 589  *                      active display output, but instead generate the display switch
 590  *                      event notify code.
 591  *      lcd_flag        :
 592  *              0.      The system BIOS should automatically control the brightness level
 593  *                      of the LCD when the power changes from AC to DC
 594  *              1.      The system BIOS should NOT automatically control the brightness
 595  *                      level of the LCD when the power changes from AC to DC.
 596  * Return Value:
 597  *              -1      wrong arg.
 598  */
 599
 600 static int
 601 acpi_video_bus_DOS(struct acpi_video_bus *video, int bios_flag, int lcd_flag)
 602 {
 603         u64 status = 0;
 604         union acpi_object arg0 = { ACPI_TYPE_INTEGER };
 605         struct acpi_object_list args = { 1, &arg0 };
 606
 607
 608         if (bios_flag < 0 || bios_flag > 3 || lcd_flag < 0 || lcd_flag > 1) {
 609                 status = -1;
 610                 goto Failed;
 611         }
 612         arg0.integer.value = (lcd_flag << 2) | bios_flag;
 613         video->dos_setting = arg0.integer.value;
 614         acpi_evaluate_object(video->device->handle, "_DOS", &args, NULL);
 615
 616       Failed:
 617         return status;
 618 }
 619
 620 /*
 621  * Simple comparison function used to sort backlight levels.
 622  */
 623
 624 static int
 625 acpi_video_cmp_level(const void *a, const void *b)
 626 {
 627         return *(int *)a - *(int *)b;
 628 }
 629
 630 /*
 631  *  Arg:
 632  *      device  : video output device (LCD, CRT, ..)
 633  *
 634  *  Return Value:
 635  *      Maximum brightness level
 636  *
 637  *  Allocate and initialize device->brightness.
 638  */
 639
 640 static int
 641 acpi_video_init_brightness(struct acpi_video_device *device)
 642 {
 643         union acpi_object *obj = NULL;
 644         int i, max_level = 0, count = 0, level_ac_battery = 0;
 645         unsigned long long level, level_old;
 646         union acpi_object *o;
 647         struct acpi_video_device_brightness *br = NULL;
 648         int result = -EINVAL;
 649         u32 value;
 650
 651         if (!ACPI_SUCCESS(acpi_video_device_lcd_query_levels(device, &obj))) {
 652                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Could not query available "
 653                                                 "LCD brightness level\n"));
 654                 goto out;
 655         }
 656
 657         if (obj->package.count < 2)
 658                 goto out;
 659
 660         br = kzalloc(sizeof(*br), GFP_KERNEL);
 661         if (!br) {
 662                 printk(KERN_ERR "can't allocate memory\n");
 663                 result = -ENOMEM;
 664                 goto out;
 665         }
 666
 667         br->levels = kmalloc((obj->package.count + 2) * sizeof *(br->levels),
 668                                 GFP_KERNEL);
 669         if (!br->levels) {
 670                 result = -ENOMEM;
 671                 goto out_free;
 672         }
 673
 674         for (i = 0; i < obj->package.count; i++) {
 675                 o = (union acpi_object *)&obj->package.elements[i];
 676                 if (o->type != ACPI_TYPE_INTEGER) {
 677                         printk(KERN_ERR PREFIX "Invalid data\n");
 678                         continue;
 679                 }
 680                 value = (u32) o->integer.value;
 681                 /* Skip duplicate entries */
 682                 if (count > 2 && br->levels[count - 1] == value)
 683                         continue;
 684
 685                 br->levels[count] = value;
 686
 687                 if (br->levels[count] > max_level)
 688                         max_level = br->levels[count];
 689                 count++;
 690         }
 691
 692         /*
 693          * some buggy BIOS don't export the levels
 694          * when machine is on AC/Battery in _BCL package.
 695          * In this case, the first two elements in _BCL packages
 696          * are also supported brightness levels that OS should take care of.
 697          */
 698         for (i = 2; i < count; i++) {
 699                 if (br->levels[i] == br->levels[0])
 700                         level_ac_battery++;
 701                 if (br->levels[i] == br->levels[1])
 702                         level_ac_battery++;
 703         }
 704
 705         if (level_ac_battery < 2) {
 706                 level_ac_battery = 2 - level_ac_battery;
 707                 br->flags._BCL_no_ac_battery_levels = 1;
 708                 for (i = (count - 1 + level_ac_battery); i >= 2; i--)
 709                         br->levels[i] = br->levels[i - level_ac_battery];
 710                 count += level_ac_battery;
 711         } else if (level_ac_battery > 2)
 712                 ACPI_ERROR((AE_INFO, "Too many duplicates in _BCL package\n"));
 713
 714         /* Check if the _BCL package is in a reversed order */
 715         if (max_level == br->levels[2]) {
 716                 br->flags._BCL_reversed = 1;
 717                 sort(&br->levels[2], count - 2, sizeof(br->levels[2]),
 718                         acpi_video_cmp_level, NULL);
 719         } else if (max_level != br->levels[count - 1])
 720                 ACPI_ERROR((AE_INFO,
 721                             "Found unordered _BCL package\n"));
 722
 723         br->count = count;
 724         device->brightness = br;
 725
 726         /* Check the input/output of _BQC/_BCL/_BCM */
 727         if ((max_level < 100) && (max_level <= (count - 2)))
 728                 br->flags._BCL_use_index = 1;
 729
 730         /*
 731          * _BCM is always consistent with _BCL,
 732          * at least for all the laptops we have ever seen.
 733          */
 734         br->flags._BCM_use_index = br->flags._BCL_use_index;
 735
 736         /* _BQC uses INDEX while _BCL uses VALUE in some laptops */
 737         br->curr = level = max_level;
 738
 739         if (!device->cap._BQC)
 740                 goto set_level;
 741
 742         result = acpi_video_device_lcd_get_level_current(device, &level_old, 1);
 743         if (result)
 744                 goto out_free_levels;
 745
 746         /*
 747          * Set the level to maximum and check if _BQC uses indexed value
 748          */
 749         result = acpi_video_device_lcd_set_level(device, max_level);
 750         if (result)
 751                 goto out_free_levels;
 752
 753         result = acpi_video_device_lcd_get_level_current(device, &level, 0);
 754         if (result)
 755                 goto out_free_levels;
 756
 757         br->flags._BQC_use_index = (level == max_level ? 0 : 1);
 758
 759         if (!br->flags._BQC_use_index) {
 760                 /*
 761                  * Set the backlight to the initial state.
 762                  * On some buggy laptops, _BQC returns an uninitialized value
 763                  * when invoked for the first time, i.e. level_old is invalid.
 764                  * set the backlight to max_level in this case
 765                  */
 766                 if (use_bios_initial_backlight) {
 767                         for (i = 2; i < br->count; i++)
 768                                 if (level_old == br->levels[i])
 769                                         level = level_old;
 770                 }
 771                 goto set_level;
 772         }
 773
 774         if (br->flags._BCL_reversed)
 775                 level_old = (br->count - 1) - level_old;
 776         level = br->levels[level_old];
 777
 778 set_level:
 779         result = acpi_video_device_lcd_set_level(device, level);
 780         if (result)
 781                 goto out_free_levels;
 782
 783         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 784                           "found %d brightness levels\n", count - 2));
 785         kfree(obj);
 786         return result;
 787
 788 out_free_levels:
 789         kfree(br->levels);
 790 out_free:
 791         kfree(br);
 792 out:
 793         device->brightness = NULL;
 794         kfree(obj);
 795         return result;
 796 }
 797
 798 /*
 799  *  Arg:
 800  *      device  : video output device (LCD, CRT, ..)
 801  *
 802  *  Return Value:
 803  *      None
 804  *
 805  *  Find out all required AML methods defined under the output
 806  *  device.
 807  */
 808
 809 static void acpi_video_device_find_cap(struct acpi_video_device *device)
 810 {
 811         acpi_handle h_dummy1;
 812
 813         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_ADR", &h_dummy1))) {
 814                 device->cap._ADR = 1;
 815         }
 816         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCL", &h_dummy1))) {
 817                 device->cap._BCL = 1;
 818         }
 819         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCM", &h_dummy1))) {
 820                 device->cap._BCM = 1;
 821         }
 822         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle,"_BQC",&h_dummy1)))
 823                 device->cap._BQC = 1;
 824         else if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_BCQ",
 825                                 &h_dummy1))) {
 826                 printk(KERN_WARNING FW_BUG "_BCQ is used instead of _BQC\n");
 827                 device->cap._BCQ = 1;
 828         }
 829
 830         if (ACPI_SUCCESS(acpi_get_handle(device->dev->handle, "_DDC", &h_dummy1))) {
 831                 device->cap._DDC = 1;
 832         }
 833
 834         if (acpi_video_backlight_support()) {
 835                 struct backlight_properties props;
 836                 struct pci_dev *pdev;
 837                 acpi_handle acpi_parent;
 838                 struct device *parent = NULL;
 839                 int result;
 840                 static int count = 0;
 841                 char *name;
 842
 843                 result = acpi_video_init_brightness(device);
 844                 if (result)
 845                         return;
 846                 name = kasprintf(GFP_KERNEL, "acpi_video%d", count);
 847                 if (!name)
 848                         return;
 849                 count++;
 850
 851                 acpi_get_parent(device->dev->handle, &acpi_parent);
 852
 853                 pdev = acpi_get_pci_dev(acpi_parent);
 854                 if (pdev) {
 855                         parent = &pdev->dev;
 856                         pci_dev_put(pdev);
 857                 }
 858
 859                 memset(&props, 0, sizeof(struct backlight_properties));
 860                 props.type = BACKLIGHT_FIRMWARE;
 861                 props.max_brightness = device->brightness->count - 3;
 862                 device->backlight = backlight_device_register(name,
 863                                                               parent,
 864                                                               device,
 865                                                               &acpi_backlight_ops,
 866                                                               &props);
 867                 kfree(name);
 868                 if (IS_ERR(device->backlight))
 869                         return;
 870
 871                 /*
 872                  * Save current brightness level in case we have to restore it
 873                  * before acpi_video_device_lcd_set_level() is called next time.
 874                  */
 875                 device->backlight->props.brightness =
 876                                 acpi_video_get_brightness(device->backlight);
 877
 878                 device->cooling_dev = thermal_cooling_device_register("LCD",
 879                                         device->dev, &video_cooling_ops);
 880                 if (IS_ERR(device->cooling_dev)) {
 881                         /*
 882                          * Set cooling_dev to NULL so we don't crash trying to
 883                          * free it.
 884                          * Also, why the hell we are returning early and
 885                          * not attempt to register video output if cooling
 886                          * device registration failed?
 887                          * -- dtor
 888                          */
 889                         device->cooling_dev = NULL;
 890                         return;
 891                 }
 892
 893                 dev_info(&device->dev->dev, "registered as cooling_device%d\n",
 894                          device->cooling_dev->id);
 895                 result = sysfs_create_link(&device->dev->dev.kobj,
 896                                 &device->cooling_dev->device.kobj,
 897                                 "thermal_cooling");
 898                 if (result)
 899                         printk(KERN_ERR PREFIX "Create sysfs link\n");
 900                 result = sysfs_create_link(&device->cooling_dev->device.kobj,
 901                                 &device->dev->dev.kobj, "device");
 902                 if (result)
 903                         printk(KERN_ERR PREFIX "Create sysfs link\n");
 904
 905         }
 906 }
 907
 908 /*
 909  *  Arg:
 910  *      device  : video output device (VGA)
 911  *
 912  *  Return Value:
 913  *      None
 914  *
 915  *  Find out all required AML methods defined under the video bus device.
 916  */
 917
 918 static void acpi_video_bus_find_cap(struct acpi_video_bus *video)
 919 {
 920         acpi_handle h_dummy1;
 921
 922         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOS", &h_dummy1))) {
 923                 video->cap._DOS = 1;
 924         }
 925         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_DOD", &h_dummy1))) {
 926                 video->cap._DOD = 1;
 927         }
 928         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_ROM", &h_dummy1))) {
 929                 video->cap._ROM = 1;
 930         }
 931         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_GPD", &h_dummy1))) {
 932                 video->cap._GPD = 1;
 933         }
 934         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_SPD", &h_dummy1))) {
 935                 video->cap._SPD = 1;
 936         }
 937         if (ACPI_SUCCESS(acpi_get_handle(video->device->handle, "_VPO", &h_dummy1))) {
 938                 video->cap._VPO = 1;
 939         }
 940 }
 941
 942 /*
 943  * Check whether the video bus device has required AML method to
 944  * support the desired features
 945  */
 946
 947 static int acpi_video_bus_check(struct acpi_video_bus *video)
 948 {
 949         acpi_status status = -ENOENT;
 950         struct pci_dev *dev;
 951
 952         if (!video)
 953                 return -EINVAL;
 954
 955         dev = acpi_get_pci_dev(video->device->handle);
 956         if (!dev)
 957                 return -ENODEV;
 958         pci_dev_put(dev);
 959
 960         /* Since there is no HID, CID and so on for VGA driver, we have
 961          * to check well known required nodes.
 962          */
 963
 964         /* Does this device support video switching? */
 965         if (video->cap._DOS || video->cap._DOD) {
 966                 if (!video->cap._DOS) {
 967                         printk(KERN_WARNING FW_BUG
 968                                 "ACPI(%s) defines _DOD but not _DOS\n",
 969                                 acpi_device_bid(video->device));
 970                 }
 971                 video->flags.multihead = 1;
 972                 status = 0;
 973         }
 974
 975         /* Does this device support retrieving a video ROM? */
 976         if (video->cap._ROM) {
 977                 video->flags.rom = 1;
 978                 status = 0;
 979         }
 980
 981         /* Does this device support configuring which video device to POST? */
 982         if (video->cap._GPD && video->cap._SPD && video->cap._VPO) {
 983                 video->flags.post = 1;
 984                 status = 0;
 985         }
 986
 987         return status;
 988 }
 989
 990 /* --------------------------------------------------------------------------
 991                                  Driver Interface
 992    -------------------------------------------------------------------------- */
 993
 994 /* device interface */
 995 static struct acpi_video_device_attrib*
 996 acpi_video_get_device_attr(struct acpi_video_bus *video, unsigned long device_id)
 997 {
 998         struct acpi_video_enumerated_device *ids;
 999         int i;
1000
1001         for (i = 0; i < video->attached_count; i++) {
1002                 ids = &video->attached_array[i];
1003                 if ((ids->value.int_val & 0xffff) == device_id)
1004                         return &ids->value.attrib;
1005         }
1006
1007         return NULL;
1008 }
1009
1010 static int
1011 acpi_video_get_device_type(struct acpi_video_bus *video,
1012                            unsigned long device_id)
1013 {
1014         struct acpi_video_enumerated_device *ids;
1015         int i;
1016
1017         for (i = 0; i < video->attached_count; i++) {
1018                 ids = &video->attached_array[i];
1019                 if ((ids->value.int_val & 0xffff) == device_id)
1020                         return ids->value.int_val;
1021         }
1022
1023         return 0;
1024 }
1025
1026 static int
1027 acpi_video_bus_get_one_device(struct acpi_device *device,
1028                               struct acpi_video_bus *video)
1029 {
1030         unsigned long long device_id;
1031         int status, device_type;
1032         struct acpi_video_device *data;
1033         struct acpi_video_device_attrib* attribute;
1034
1035         if (!device || !video)
1036                 return -EINVAL;
1037
1038         status =
1039             acpi_evaluate_integer(device->handle, "_ADR", NULL, &device_id);
1040         if (ACPI_SUCCESS(status)) {
1041
1042                 data = kzalloc(sizeof(struct acpi_video_device), GFP_KERNEL);
1043                 if (!data)
1044                         return -ENOMEM;
1045
1046                 strcpy(acpi_device_name(device), ACPI_VIDEO_DEVICE_NAME);
1047                 strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1048                 device->driver_data = data;
1049
1050                 data->device_id = device_id;
1051                 data->video = video;
1052                 data->dev = device;
1053
1054                 attribute = acpi_video_get_device_attr(video, device_id);
1055
1056                 if((attribute != NULL) && attribute->device_id_scheme) {
1057                         switch (attribute->display_type) {
1058                         case ACPI_VIDEO_DISPLAY_CRT:
1059                                 data->flags.crt = 1;
1060                                 break;
1061                         case ACPI_VIDEO_DISPLAY_TV:
1062                                 data->flags.tvout = 1;
1063                                 break;
1064                         case ACPI_VIDEO_DISPLAY_DVI:
1065                                 data->flags.dvi = 1;
1066                                 break;
1067                         case ACPI_VIDEO_DISPLAY_LCD:
1068                                 data->flags.lcd = 1;
1069                                 break;
1070                         default:
1071                                 data->flags.unknown = 1;
1072                                 break;
1073                         }
1074                         if(attribute->bios_can_detect)
1075                                 data->flags.bios = 1;
1076                 } else {
1077                         /* Check for legacy IDs */
1078                         device_type = acpi_video_get_device_type(video,
1079                                                                  device_id);
1080                         /* Ignore bits 16 and 18-20 */
1081                         switch (device_type & 0xffe2ffff) {
1082                         case ACPI_VIDEO_DISPLAY_LEGACY_MONITOR:
1083                                 data->flags.crt = 1;
1084                                 break;
1085                         case ACPI_VIDEO_DISPLAY_LEGACY_PANEL:
1086                                 data->flags.lcd = 1;
1087                                 break;
1088                         case ACPI_VIDEO_DISPLAY_LEGACY_TV:
1089                                 data->flags.tvout = 1;
1090                                 break;
1091                         default:
1092                                 data->flags.unknown = 1;
1093                         }
1094                 }
1095
1096                 acpi_video_device_bind(video, data);
1097                 acpi_video_device_find_cap(data);
1098
1099                 status = acpi_install_notify_handler(device->handle,
1100                                                      ACPI_DEVICE_NOTIFY,
1101                                                      acpi_video_device_notify,
1102                                                      data);
1103                 if (ACPI_FAILURE(status)) {
1104                         printk(KERN_ERR PREFIX
1105                                           "Error installing notify handler\n");
1106                         if(data->brightness)
1107                                 kfree(data->brightness->levels);
1108                         kfree(data->brightness);
1109                         kfree(data);
1110                         return -ENODEV;
1111                 }
1112
1113                 mutex_lock(&video->device_list_lock);
1114                 list_add_tail(&data->entry, &video->video_device_list);
1115                 mutex_unlock(&video->device_list_lock);
1116
1117                 return 0;
1118         }
1119
1120         return -ENOENT;
1121 }
1122
1123 /*
1124  *  Arg:
1125  *      video   : video bus device
1126  *
1127  *  Return:
1128  *      none
1129  *
1130  *  Enumerate the video device list of the video bus,
1131  *  bind the ids with the corresponding video devices
1132  *  under the video bus.
1133  */
1134
1135 static void acpi_video_device_rebind(struct acpi_video_bus *video)
1136 {
1137         struct acpi_video_device *dev;
1138
1139         mutex_lock(&video->device_list_lock);
1140
1141         list_for_each_entry(dev, &video->video_device_list, entry)
1142                 acpi_video_device_bind(video, dev);
1143
1144         mutex_unlock(&video->device_list_lock);
1145 }
1146
1147 /*
1148  *  Arg:
1149  *      video   : video bus device
1150  *      device  : video output device under the video
1151  *              bus
1152  *
1153  *  Return:
1154  *      none
1155  *
1156  *  Bind the ids with the corresponding video devices
1157  *  under the video bus.
1158  */
1159
1160 static void
1161 acpi_video_device_bind(struct acpi_video_bus *video,
1162                        struct acpi_video_device *device)
1163 {
1164         struct acpi_video_enumerated_device *ids;
1165         int i;
1166
1167         for (i = 0; i < video->attached_count; i++) {
1168                 ids = &video->attached_array[i];
1169                 if (device->device_id == (ids->value.int_val & 0xffff)) {
1170                         ids->bind_info = device;
1171                         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "device_bind %d\n", i));
1172                 }
1173         }
1174 }
1175
1176 /*
1177  *  Arg:
1178  *      video   : video bus device
1179  *
1180  *  Return:
1181  *      < 0     : error
1182  *
1183  *  Call _DOD to enumerate all devices attached to display adapter
1184  *
1185  */
1186
1187 static int acpi_video_device_enumerate(struct acpi_video_bus *video)
1188 {
1189         int status;
1190         int count;
1191         int i;
1192         struct acpi_video_enumerated_device *active_list;
1193         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1194         union acpi_object *dod = NULL;
1195         union acpi_object *obj;
1196
1197         status = acpi_evaluate_object(video->device->handle, "_DOD", NULL, &buffer);
1198         if (!ACPI_SUCCESS(status)) {
1199                 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _DOD"));
1200                 return status;
1201         }
1202
1203         dod = buffer.pointer;
1204         if (!dod || (dod->type != ACPI_TYPE_PACKAGE)) {
1205                 ACPI_EXCEPTION((AE_INFO, status, "Invalid _DOD data"));
1206                 status = -EFAULT;
1207                 goto out;
1208         }
1209
1210         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d video heads in _DOD\n",
1211                           dod->package.count));
1212
1213         active_list = kcalloc(1 + dod->package.count,
1214                               sizeof(struct acpi_video_enumerated_device),
1215                               GFP_KERNEL);
1216         if (!active_list) {
1217                 status = -ENOMEM;
1218                 goto out;
1219         }
1220
1221         count = 0;
1222         for (i = 0; i < dod->package.count; i++) {
1223                 obj = &dod->package.elements[i];
1224
1225                 if (obj->type != ACPI_TYPE_INTEGER) {
1226                         printk(KERN_ERR PREFIX
1227                                 "Invalid _DOD data in element %d\n", i);
1228                         continue;
1229                 }
1230
1231                 active_list[count].value.int_val = obj->integer.value;
1232                 active_list[count].bind_info = NULL;
1233                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "dod element[%d] = %d\n", i,
1234                                   (int)obj->integer.value));
1235                 count++;
1236         }
1237
1238         kfree(video->attached_array);
1239
1240         video->attached_array = active_list;
1241         video->attached_count = count;
1242
1243  out:
1244         kfree(buffer.pointer);
1245         return status;
1246 }
1247
1248 static int
1249 acpi_video_get_next_level(struct acpi_video_device *device,
1250                           u32 level_current, u32 event)
1251 {
1252         int min, max, min_above, max_below, i, l, delta = 255;
1253         max = max_below = 0;
1254         min = min_above = 255;
1255         /* Find closest level to level_current */
1256         for (i = 2; i < device->brightness->count; i++) {
1257                 l = device->brightness->levels[i];
1258                 if (abs(l - level_current) < abs(delta)) {
1259                         delta = l - level_current;
1260                         if (!delta)
1261                                 break;
1262                 }
1263         }
1264         /* Ajust level_current to closest available level */
1265         level_current += delta;
1266         for (i = 2; i < device->brightness->count; i++) {
1267                 l = device->brightness->levels[i];
1268                 if (l < min)
1269                         min = l;
1270                 if (l > max)
1271                         max = l;
1272                 if (l < min_above && l > level_current)
1273                         min_above = l;
1274                 if (l > max_below && l < level_current)
1275                         max_below = l;
1276         }
1277
1278         switch (event) {
1279         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:
1280                 return (level_current < max) ? min_above : min;
1281         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:
1282                 return (level_current < max) ? min_above : max;
1283         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:
1284                 return (level_current > min) ? max_below : min;
1285         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS:
1286         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:
1287                 return 0;
1288         default:
1289                 return level_current;
1290         }
1291 }
1292
1293 static int
1294 acpi_video_switch_brightness(struct acpi_video_device *device, int event)
1295 {
1296         unsigned long long level_current, level_next;
1297         int result = -EINVAL;
1298
1299         /* no warning message if acpi_backlight=vendor is used */
1300         if (!acpi_video_backlight_support())
1301                 return 0;
1302
1303         if (!device->brightness)
1304                 goto out;
1305
1306         result = acpi_video_device_lcd_get_level_current(device,
1307                                                          &level_current, 0);
1308         if (result)
1309                 goto out;
1310
1311         level_next = acpi_video_get_next_level(device, level_current, event);
1312
1313         result = acpi_video_device_lcd_set_level(device, level_next);
1314
1315         if (!result)
1316                 backlight_force_update(device->backlight,
1317                                        BACKLIGHT_UPDATE_HOTKEY);
1318
1319 out:
1320         if (result)
1321                 printk(KERN_ERR PREFIX "Failed to switch the brightness\n");
1322
1323         return result;
1324 }
1325
1326 int acpi_video_get_edid(struct acpi_device *device, int type, int device_id,
1327                         void **edid)
1328 {
1329         struct acpi_video_bus *video;
1330         struct acpi_video_device *video_device;
1331         union acpi_object *buffer = NULL;
1332         acpi_status status;
1333         int i, length;
1334
1335         if (!device || !acpi_driver_data(device))
1336                 return -EINVAL;
1337
1338         video = acpi_driver_data(device);
1339
1340         for (i = 0; i < video->attached_count; i++) {
1341                 video_device = video->attached_array[i].bind_info;
1342                 length = 256;
1343
1344                 if (!video_device)
1345                         continue;
1346
1347                 if (!video_device->cap._DDC)
1348                         continue;
1349
1350                 if (type) {
1351                         switch (type) {
1352                         case ACPI_VIDEO_DISPLAY_CRT:
1353                                 if (!video_device->flags.crt)
1354                                         continue;
1355                                 break;
1356                         case ACPI_VIDEO_DISPLAY_TV:
1357                                 if (!video_device->flags.tvout)
1358                                         continue;
1359                                 break;
1360                         case ACPI_VIDEO_DISPLAY_DVI:
1361                                 if (!video_device->flags.dvi)
1362                                         continue;
1363                                 break;
1364                         case ACPI_VIDEO_DISPLAY_LCD:
1365                                 if (!video_device->flags.lcd)
1366                                         continue;
1367                                 break;
1368                         }
1369                 } else if (video_device->device_id != device_id) {
1370                         continue;
1371                 }
1372
1373                 status = acpi_video_device_EDID(video_device, &buffer, length);
1374
1375                 if (ACPI_FAILURE(status) || !buffer ||
1376                     buffer->type != ACPI_TYPE_BUFFER) {
1377                         length = 128;
1378                         status = acpi_video_device_EDID(video_device, &buffer,
1379                                                         length);
1380                         if (ACPI_FAILURE(status) || !buffer ||
1381                             buffer->type != ACPI_TYPE_BUFFER) {
1382                                 continue;
1383                         }
1384                 }
1385
1386                 *edid = buffer->buffer.pointer;
1387                 return length;
1388         }
1389
1390         return -ENODEV;
1391 }
1392 EXPORT_SYMBOL(acpi_video_get_edid);
1393
1394 static int
1395 acpi_video_bus_get_devices(struct acpi_video_bus *video,
1396                            struct acpi_device *device)
1397 {
1398         int status = 0;
1399         struct acpi_device *dev;
1400
1401         acpi_video_device_enumerate(video);
1402
1403         list_for_each_entry(dev, &device->children, node) {
1404
1405                 status = acpi_video_bus_get_one_device(dev, video);
1406                 if (ACPI_FAILURE(status)) {
1407                         printk(KERN_WARNING PREFIX
1408                                         "Can't attach device\n");
1409                         continue;
1410                 }
1411         }
1412         return status;
1413 }
1414
1415 static int acpi_video_bus_put_one_device(struct acpi_video_device *device)
1416 {
1417         acpi_status status;
1418
1419         if (!device || !device->video)
1420                 return -ENOENT;
1421
1422         status = acpi_remove_notify_handler(device->dev->handle,
1423                                             ACPI_DEVICE_NOTIFY,
1424                                             acpi_video_device_notify);
1425         if (ACPI_FAILURE(status)) {
1426                 printk(KERN_WARNING PREFIX
1427                        "Can't remove video notify handler\n");
1428         }
1429         if (device->backlight) {
1430                 backlight_device_unregister(device->backlight);
1431                 device->backlight = NULL;
1432         }
1433         if (device->cooling_dev) {
1434                 sysfs_remove_link(&device->dev->dev.kobj,
1435                                   "thermal_cooling");
1436                 sysfs_remove_link(&device->cooling_dev->device.kobj,
1437                                   "device");
1438                 thermal_cooling_device_unregister(device->cooling_dev);
1439                 device->cooling_dev = NULL;
1440         }
1441
1442         return 0;
1443 }
1444
1445 static int acpi_video_bus_put_devices(struct acpi_video_bus *video)
1446 {
1447         int status;
1448         struct acpi_video_device *dev, *next;
1449
1450         mutex_lock(&video->device_list_lock);
1451
1452         list_for_each_entry_safe(dev, next, &video->video_device_list, entry) {
1453
1454                 status = acpi_video_bus_put_one_device(dev);
1455                 if (ACPI_FAILURE(status))
1456                         printk(KERN_WARNING PREFIX
1457                                "hhuuhhuu bug in acpi video driver.\n");
1458
1459                 if (dev->brightness) {
1460                         kfree(dev->brightness->levels);
1461                         kfree(dev->brightness);
1462                 }
1463                 list_del(&dev->entry);
1464                 kfree(dev);
1465         }
1466
1467         mutex_unlock(&video->device_list_lock);
1468
1469         return 0;
1470 }
1471
1472 /* acpi_video interface */
1473
1474 static int acpi_video_bus_start_devices(struct acpi_video_bus *video)
1475 {
1476         return acpi_video_bus_DOS(video, 0, 0);
1477 }
1478
1479 static int acpi_video_bus_stop_devices(struct acpi_video_bus *video)
1480 {
1481         return acpi_video_bus_DOS(video, 0, 1);
1482 }
1483
1484 static void acpi_video_bus_notify(struct acpi_device *device, u32 event)
1485 {
1486         struct acpi_video_bus *video = acpi_driver_data(device);
1487         struct input_dev *input;
1488         int keycode = 0;
1489
1490         if (!video)
1491                 return;
1492
1493         input = video->input;
1494
1495         switch (event) {
1496         case ACPI_VIDEO_NOTIFY_SWITCH:  /* User requested a switch,
1497                                          * most likely via hotkey. */
1498                 acpi_bus_generate_proc_event(device, event, 0);
1499                 if (!acpi_notifier_call_chain(device, event, 0))
1500                         keycode = KEY_SWITCHVIDEOMODE;
1501                 break;
1502
1503         case ACPI_VIDEO_NOTIFY_PROBE:   /* User plugged in or removed a video
1504                                          * connector. */
1505                 acpi_video_device_enumerate(video);
1506                 acpi_video_device_rebind(video);
1507                 acpi_bus_generate_proc_event(device, event, 0);
1508                 keycode = KEY_SWITCHVIDEOMODE;
1509                 break;
1510
1511         case ACPI_VIDEO_NOTIFY_CYCLE:   /* Cycle Display output hotkey pressed. */
1512                 acpi_bus_generate_proc_event(device, event, 0);
1513                 keycode = KEY_SWITCHVIDEOMODE;
1514                 break;
1515         case ACPI_VIDEO_NOTIFY_NEXT_OUTPUT:     /* Next Display output hotkey pressed. */
1516                 acpi_bus_generate_proc_event(device, event, 0);
1517                 keycode = KEY_VIDEO_NEXT;
1518                 break;
1519         case ACPI_VIDEO_NOTIFY_PREV_OUTPUT:     /* previous Display output hotkey pressed. */
1520                 acpi_bus_generate_proc_event(device, event, 0);
1521                 keycode = KEY_VIDEO_PREV;
1522                 break;
1523
1524         default:
1525                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1526                                   "Unsupported event [0x%x]\n", event));
1527                 break;
1528         }
1529
1530         if (event != ACPI_VIDEO_NOTIFY_SWITCH)
1531                 acpi_notifier_call_chain(device, event, 0);
1532
1533         if (keycode) {
1534                 input_report_key(input, keycode, 1);
1535                 input_sync(input);
1536                 input_report_key(input, keycode, 0);
1537                 input_sync(input);
1538         }
1539
1540         return;
1541 }
1542
1543 static void acpi_video_device_notify(acpi_handle handle, u32 event, void *data)
1544 {
1545         struct acpi_video_device *video_device = data;
1546         struct acpi_device *device = NULL;
1547         struct acpi_video_bus *bus;
1548         struct input_dev *input;
1549         int keycode = 0;
1550
1551         if (!video_device)
1552                 return;
1553
1554         device = video_device->dev;
1555         bus = video_device->video;
1556         input = bus->input;
1557
1558         switch (event) {
1559         case ACPI_VIDEO_NOTIFY_CYCLE_BRIGHTNESS:        /* Cycle brightness */
1560                 if (brightness_switch_enabled)
1561                         acpi_video_switch_brightness(video_device, event);
1562                 acpi_bus_generate_proc_event(device, event, 0);
1563                 keycode = KEY_BRIGHTNESS_CYCLE;
1564                 break;
1565         case ACPI_VIDEO_NOTIFY_INC_BRIGHTNESS:  /* Increase brightness */
1566                 if (brightness_switch_enabled)
1567                         acpi_video_switch_brightness(video_device, event);
1568                 acpi_bus_generate_proc_event(device, event, 0);
1569                 keycode = KEY_BRIGHTNESSUP;
1570                 break;
1571         case ACPI_VIDEO_NOTIFY_DEC_BRIGHTNESS:  /* Decrease brightness */
1572                 if (brightness_switch_enabled)
1573                         acpi_video_switch_brightness(video_device, event);
1574                 acpi_bus_generate_proc_event(device, event, 0);
1575                 keycode = KEY_BRIGHTNESSDOWN;
1576                 break;
1577         case ACPI_VIDEO_NOTIFY_ZERO_BRIGHTNESS: /* zero brightness */
1578                 if (brightness_switch_enabled)
1579                         acpi_video_switch_brightness(video_device, event);
1580                 acpi_bus_generate_proc_event(device, event, 0);
1581                 keycode = KEY_BRIGHTNESS_ZERO;
1582                 break;
1583         case ACPI_VIDEO_NOTIFY_DISPLAY_OFF:     /* display device off */
1584                 if (brightness_switch_enabled)
1585                         acpi_video_switch_brightness(video_device, event);
1586                 acpi_bus_generate_proc_event(device, event, 0);
1587                 keycode = KEY_DISPLAY_OFF;
1588                 break;
1589         default:
1590                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1591                                   "Unsupported event [0x%x]\n", event));
1592                 break;
1593         }
1594
1595         acpi_notifier_call_chain(device, event, 0);
1596
1597         if (keycode) {
1598                 input_report_key(input, keycode, 1);
1599                 input_sync(input);
1600                 input_report_key(input, keycode, 0);
1601                 input_sync(input);
1602         }
1603
1604         return;
1605 }
1606
1607 static int acpi_video_resume(struct notifier_block *nb,
1608                                 unsigned long val, void *ign)
1609 {
1610         struct acpi_video_bus *video;
1611         struct acpi_video_device *video_device;
1612         int i;
1613
1614         switch (val) {
1615         case PM_HIBERNATION_PREPARE:
1616         case PM_SUSPEND_PREPARE:
1617         case PM_RESTORE_PREPARE:
1618                 return NOTIFY_DONE;
1619         }
1620
1621         video = container_of(nb, struct acpi_video_bus, pm_nb);
1622
1623         dev_info(&video->device->dev, "Restoring backlight state\n");
1624
1625         for (i = 0; i < video->attached_count; i++) {
1626                 video_device = video->attached_array[i].bind_info;
1627                 if (video_device && video_device->backlight)
1628                         acpi_video_set_brightness(video_device->backlight);
1629         }
1630
1631         return NOTIFY_OK;
1632 }
1633
1634 static acpi_status
1635 acpi_video_bus_match(acpi_handle handle, u32 level, void *context,
1636                         void **return_value)
1637 {
1638         struct acpi_device *device = context;
1639         struct acpi_device *sibling;
1640         int result;
1641
1642         if (handle == device->handle)
1643                 return AE_CTRL_TERMINATE;
1644
1645         result = acpi_bus_get_device(handle, &sibling);
1646         if (result)
1647                 return AE_OK;
1648
1649         if (!strcmp(acpi_device_name(sibling), ACPI_VIDEO_BUS_NAME))
1650                         return AE_ALREADY_EXISTS;
1651
1652         return AE_OK;
1653 }
1654
1655 static int instance;
1656
1657 static int acpi_video_bus_add(struct acpi_device *device)
1658 {
1659         struct acpi_video_bus *video;
1660         struct input_dev *input;
1661         int error;
1662         acpi_status status;
1663
1664         status = acpi_walk_namespace(ACPI_TYPE_DEVICE,
1665                                 device->parent->handle, 1,
1666                                 acpi_video_bus_match, NULL,
1667                                 device, NULL);
1668         if (status == AE_ALREADY_EXISTS) {
1669                 printk(KERN_WARNING FW_BUG
1670                         "Duplicate ACPI video bus devices for the"
1671                         " same VGA controller, please try module "
1672                         "parameter \"video.allow_duplicates=1\""
1673                         "if the current driver doesn't work.\n");
1674                 if (!allow_duplicates)
1675                         return -ENODEV;
1676         }
1677
1678         video = kzalloc(sizeof(struct acpi_video_bus), GFP_KERNEL);
1679         if (!video)
1680                 return -ENOMEM;
1681
1682         /* a hack to fix the duplicate name "VID" problem on T61 */
1683         if (!strcmp(device->pnp.bus_id, "VID")) {
1684                 if (instance)
1685                         device->pnp.bus_id[3] = '0' + instance;
1686                 instance ++;
1687         }
1688         /* a hack to fix the duplicate name "VGA" problem on Pa 3553 */
1689         if (!strcmp(device->pnp.bus_id, "VGA")) {
1690                 if (instance)
1691                         device->pnp.bus_id[3] = '0' + instance;
1692                 instance++;
1693         }
1694
1695         video->device = device;
1696         strcpy(acpi_device_name(device), ACPI_VIDEO_BUS_NAME);
1697         strcpy(acpi_device_class(device), ACPI_VIDEO_CLASS);
1698         device->driver_data = video;
1699
1700         acpi_video_bus_find_cap(video);
1701         error = acpi_video_bus_check(video);
1702         if (error)
1703                 goto err_free_video;
1704
1705         mutex_init(&video->device_list_lock);
1706         INIT_LIST_HEAD(&video->video_device_list);
1707
1708         acpi_video_bus_get_devices(video, device);
1709         acpi_video_bus_start_devices(video);
1710
1711         video->input = input = input_allocate_device();
1712         if (!input) {
1713                 error = -ENOMEM;
1714                 goto err_stop_video;
1715         }
1716
1717         snprintf(video->phys, sizeof(video->phys),
1718                 "%s/video/input0", acpi_device_hid(video->device));
1719
1720         input->name = acpi_device_name(video->device);
1721         input->phys = video->phys;
1722         input->id.bustype = BUS_HOST;
1723         input->id.product = 0x06;
1724         input->dev.parent = &device->dev;
1725         input->evbit[0] = BIT(EV_KEY);
1726         set_bit(KEY_SWITCHVIDEOMODE, input->keybit);
1727         set_bit(KEY_VIDEO_NEXT, input->keybit);
1728         set_bit(KEY_VIDEO_PREV, input->keybit);
1729         set_bit(KEY_BRIGHTNESS_CYCLE, input->keybit);
1730         set_bit(KEY_BRIGHTNESSUP, input->keybit);
1731         set_bit(KEY_BRIGHTNESSDOWN, input->keybit);
1732         set_bit(KEY_BRIGHTNESS_ZERO, input->keybit);
1733         set_bit(KEY_DISPLAY_OFF, input->keybit);
1734
1735         error = input_register_device(input);
1736         if (error)
1737                 goto err_free_input_dev;
1738
1739         printk(KERN_INFO PREFIX "%s [%s] (multi-head: %s  rom: %s  post: %s)\n",
1740                ACPI_VIDEO_DEVICE_NAME, acpi_device_bid(device),
1741                video->flags.multihead ? "yes" : "no",
1742                video->flags.rom ? "yes" : "no",
1743                video->flags.post ? "yes" : "no");
1744
1745         video->pm_nb.notifier_call = acpi_video_resume;
1746         video->pm_nb.priority = 0;
1747         register_pm_notifier(&video->pm_nb);
1748
1749         return 0;
1750
1751  err_free_input_dev:
1752         input_free_device(input);
1753  err_stop_video:
1754         acpi_video_bus_stop_devices(video);
1755         acpi_video_bus_put_devices(video);
1756         kfree(video->attached_array);
1757  err_free_video:
1758         kfree(video);
1759         device->driver_data = NULL;
1760
1761         return error;
1762 }
1763
1764 static int acpi_video_bus_remove(struct acpi_device *device, int type)
1765 {
1766         struct acpi_video_bus *video = NULL;
1767
1768
1769         if (!device || !acpi_driver_data(device))
1770                 return -EINVAL;
1771
1772         video = acpi_driver_data(device);
1773
1774         unregister_pm_notifier(&video->pm_nb);
1775
1776         acpi_video_bus_stop_devices(video);
1777         acpi_video_bus_put_devices(video);
1778
1779         input_unregister_device(video->input);
1780         kfree(video->attached_array);
1781         kfree(video);
1782
1783         return 0;
1784 }
1785
1786 static int __init intel_opregion_present(void)
1787 {
1788 #if defined(CONFIG_DRM_I915) || defined(CONFIG_DRM_I915_MODULE)
1789         struct pci_dev *dev = NULL;
1790         u32 address;
1791
1792         for_each_pci_dev(dev) {
1793                 if ((dev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
1794                         continue;
1795                 if (dev->vendor != PCI_VENDOR_ID_INTEL)
1796                         continue;
1797                 pci_read_config_dword(dev, 0xfc, &address);
1798                 if (!address)
1799                         continue;
1800                 return 1;
1801         }
1802 #endif
1803         return 0;
1804 }
1805
1806 int acpi_video_register(void)
1807 {
1808         int result = 0;
1809         if (register_count) {
1810                 /*
1811                  * if the function of acpi_video_register is already called,
1812                  * don't register the acpi_vide_bus again and return no error.
1813                  */
1814                 return 0;
1815         }
1816
1817         result = acpi_bus_register_driver(&acpi_video_bus);
1818         if (result < 0)
1819                 return -ENODEV;
1820
1821         /*
1822          * When the acpi_video_bus is loaded successfully, increase
1823          * the counter reference.
1824          */
1825         register_count = 1;
1826
1827         return 0;
1828 }
1829 EXPORT_SYMBOL(acpi_video_register);
1830
1831 void acpi_video_unregister(void)
1832 {
1833         if (!register_count) {
1834                 /*
1835                  * If the acpi video bus is already unloaded, don't
1836                  * unload it again and return directly.
1837                  */
1838                 return;
1839         }
1840         acpi_bus_unregister_driver(&acpi_video_bus);
1841
1842         register_count = 0;
1843
1844         return;
1845 }
1846 EXPORT_SYMBOL(acpi_video_unregister);
1847
1848 /*
1849  * This is kind of nasty. Hardware using Intel chipsets may require
1850  * the video opregion code to be run first in order to initialise
1851  * state before any ACPI video calls are made. To handle this we defer
1852  * registration of the video class until the opregion code has run.
1853  */
1854
1855 static int __init acpi_video_init(void)
1856 {
1857         /*
1858          * Let the module load even if ACPI is disabled (e.g. due to
1859          * a broken BIOS) so that i915.ko can still be loaded on such
1860          * old systems without an AcpiOpRegion.
1861          *
1862          * acpi_video_register() will report -ENODEV later as well due
1863          * to acpi_disabled when i915.ko tries to register itself afterwards.
1864          */
1865         if (acpi_disabled)
1866                 return 0;
1867
1868         dmi_check_system(video_dmi_table);
1869
1870         if (intel_opregion_present())
1871                 return 0;
1872
1873         return acpi_video_register();
1874 }
1875
1876 static void __exit acpi_video_exit(void)
1877 {
1878         acpi_video_unregister();
1879
1880         return;
1881 }
1882
1883 module_init(acpi_video_init);
1884 module_exit(acpi_video_exit);