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

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