Pileus Git - ~andy/linux/blob - drivers/acpi/video.c

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