sys/dev/drm/i915/intel_bios.c

   1 /*
   2  * Copyright © 2006 Intel Corporation
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice (including the next
  12  * paragraph) shall be included in all copies or substantial portions of the
  13  * Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  20  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  21  * SOFTWARE.
  22  *
  23  * Authors:
  24  *    Eric Anholt <eric@anholt.net>
  25  *
  26  * $FreeBSD: src/sys/dev/drm2/i915/intel_bios.c,v 1.1 2012/05/22 11:07:44 kib Exp $
  27  */
  28 #include <drm/drmP.h>
  29 #include <drm/drm_dp_helper.h>
  30 #include <drm/i915_drm.h>
  31 #include "i915_drv.h"
  32 #include "intel_bios.h"
  33
  34 #define SLAVE_ADDR1     0x70
  35 #define SLAVE_ADDR2     0x72
  36
  37 static int panel_type;
  38
  39 static void *
  40 find_section(struct bdb_header *bdb, int section_id)
  41 {
  42         u8 *base = (u8 *)bdb;
  43         int index = 0;
  44         u16 total, current_size;
  45         u8 current_id;
  46
  47         /* skip to first section */
  48         index += bdb->header_size;
  49         total = bdb->bdb_size;
  50
  51         /* walk the sections looking for section_id */
  52         while (index < total) {
  53                 current_id = *(base + index);
  54                 index++;
  55                 current_size = *((u16 *)(base + index));
  56                 index += 2;
  57                 if (current_id == section_id)
  58                         return base + index;
  59                 index += current_size;
  60         }
  61
  62         return NULL;
  63 }
  64
  65 static u16
  66 get_blocksize(void *p)
  67 {
  68         u16 *block_ptr, block_size;
  69
  70         block_ptr = (u16 *)((char *)p - 2);
  71         block_size = *block_ptr;
  72         return block_size;
  73 }
  74
  75 static void
  76 fill_detail_timing_data(struct drm_display_mode *panel_fixed_mode,
  77                         const struct lvds_dvo_timing *dvo_timing)
  78 {
  79         panel_fixed_mode->hdisplay = (dvo_timing->hactive_hi << 8) |
  80                 dvo_timing->hactive_lo;
  81         panel_fixed_mode->hsync_start = panel_fixed_mode->hdisplay +
  82                 ((dvo_timing->hsync_off_hi << 8) | dvo_timing->hsync_off_lo);
  83         panel_fixed_mode->hsync_end = panel_fixed_mode->hsync_start +
  84                 dvo_timing->hsync_pulse_width;
  85         panel_fixed_mode->htotal = panel_fixed_mode->hdisplay +
  86                 ((dvo_timing->hblank_hi << 8) | dvo_timing->hblank_lo);
  87
  88         panel_fixed_mode->vdisplay = (dvo_timing->vactive_hi << 8) |
  89                 dvo_timing->vactive_lo;
  90         panel_fixed_mode->vsync_start = panel_fixed_mode->vdisplay +
  91                 dvo_timing->vsync_off;
  92         panel_fixed_mode->vsync_end = panel_fixed_mode->vsync_start +
  93                 dvo_timing->vsync_pulse_width;
  94         panel_fixed_mode->vtotal = panel_fixed_mode->vdisplay +
  95                 ((dvo_timing->vblank_hi << 8) | dvo_timing->vblank_lo);
  96         panel_fixed_mode->clock = dvo_timing->clock * 10;
  97         panel_fixed_mode->type = DRM_MODE_TYPE_PREFERRED;
  98
  99         if (dvo_timing->hsync_positive)
 100                 panel_fixed_mode->flags |= DRM_MODE_FLAG_PHSYNC;
 101         else
 102                 panel_fixed_mode->flags |= DRM_MODE_FLAG_NHSYNC;
 103
 104         if (dvo_timing->vsync_positive)
 105                 panel_fixed_mode->flags |= DRM_MODE_FLAG_PVSYNC;
 106         else
 107                 panel_fixed_mode->flags |= DRM_MODE_FLAG_NVSYNC;
 108
 109         /* Some VBTs have bogus h/vtotal values */
 110         if (panel_fixed_mode->hsync_end > panel_fixed_mode->htotal)
 111                 panel_fixed_mode->htotal = panel_fixed_mode->hsync_end + 1;
 112         if (panel_fixed_mode->vsync_end > panel_fixed_mode->vtotal)
 113                 panel_fixed_mode->vtotal = panel_fixed_mode->vsync_end + 1;
 114
 115         drm_mode_set_name(panel_fixed_mode);
 116 }
 117
 118 static bool
 119 lvds_dvo_timing_equal_size(const struct lvds_dvo_timing *a,
 120                            const struct lvds_dvo_timing *b)
 121 {
 122         if (a->hactive_hi != b->hactive_hi ||
 123             a->hactive_lo != b->hactive_lo)
 124                 return false;
 125
 126         if (a->hsync_off_hi != b->hsync_off_hi ||
 127             a->hsync_off_lo != b->hsync_off_lo)
 128                 return false;
 129
 130         if (a->hsync_pulse_width != b->hsync_pulse_width)
 131                 return false;
 132
 133         if (a->hblank_hi != b->hblank_hi ||
 134             a->hblank_lo != b->hblank_lo)
 135                 return false;
 136
 137         if (a->vactive_hi != b->vactive_hi ||
 138             a->vactive_lo != b->vactive_lo)
 139                 return false;
 140
 141         if (a->vsync_off != b->vsync_off)
 142                 return false;
 143
 144         if (a->vsync_pulse_width != b->vsync_pulse_width)
 145                 return false;
 146
 147         if (a->vblank_hi != b->vblank_hi ||
 148             a->vblank_lo != b->vblank_lo)
 149                 return false;
 150
 151         return true;
 152 }
 153
 154 static const struct lvds_dvo_timing *
 155 get_lvds_dvo_timing(const struct bdb_lvds_lfp_data *lvds_lfp_data,
 156                     const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs,
 157                     int index)
 158 {
 159         /*
 160          * the size of fp_timing varies on the different platform.
 161          * So calculate the DVO timing relative offset in LVDS data
 162          * entry to get the DVO timing entry
 163          */
 164
 165         int lfp_data_size =
 166                 lvds_lfp_data_ptrs->ptr[1].dvo_timing_offset -
 167                 lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset;
 168         int dvo_timing_offset =
 169                 lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset -
 170                 lvds_lfp_data_ptrs->ptr[0].fp_timing_offset;
 171         const char *entry = (const char *)lvds_lfp_data->data +
 172             lfp_data_size * index;
 173
 174         return (const struct lvds_dvo_timing *)(entry + dvo_timing_offset);
 175 }
 176
 177 /* Try to find integrated panel data */
 178 static void
 179 parse_lfp_panel_data(struct drm_i915_private *dev_priv,
 180                             struct bdb_header *bdb)
 181 {
 182         const struct bdb_lvds_options *lvds_options;
 183         const struct bdb_lvds_lfp_data *lvds_lfp_data;
 184         const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs;
 185         const struct lvds_dvo_timing *panel_dvo_timing;
 186         struct drm_display_mode *panel_fixed_mode;
 187         int i, downclock;
 188
 189         lvds_options = find_section(bdb, BDB_LVDS_OPTIONS);
 190         if (!lvds_options)
 191                 return;
 192
 193         dev_priv->lvds_dither = lvds_options->pixel_dither;
 194         if (lvds_options->panel_type == 0xff)
 195                 return;
 196
 197         panel_type = lvds_options->panel_type;
 198
 199         lvds_lfp_data = find_section(bdb, BDB_LVDS_LFP_DATA);
 200         if (!lvds_lfp_data)
 201                 return;
 202
 203         lvds_lfp_data_ptrs = find_section(bdb, BDB_LVDS_LFP_DATA_PTRS);
 204         if (!lvds_lfp_data_ptrs)
 205                 return;
 206
 207         dev_priv->lvds_vbt = 1;
 208
 209         panel_dvo_timing = get_lvds_dvo_timing(lvds_lfp_data,
 210                                                lvds_lfp_data_ptrs,
 211                                                lvds_options->panel_type);
 212
 213         panel_fixed_mode = kmalloc(sizeof(*panel_fixed_mode), DRM_MEM_KMS,
 214             M_WAITOK | M_ZERO);
 215
 216         fill_detail_timing_data(panel_fixed_mode, panel_dvo_timing);
 217
 218         dev_priv->lfp_lvds_vbt_mode = panel_fixed_mode;
 219
 220         DRM_DEBUG_KMS("Found panel mode in BIOS VBT tables:\n");
 221         drm_mode_debug_printmodeline(panel_fixed_mode);
 222
 223         /*
 224          * Iterate over the LVDS panel timing info to find the lowest clock
 225          * for the native resolution.
 226          */
 227         downclock = panel_dvo_timing->clock;
 228         for (i = 0; i < 16; i++) {
 229                 const struct lvds_dvo_timing *dvo_timing;
 230
 231                 dvo_timing = get_lvds_dvo_timing(lvds_lfp_data,
 232                                                  lvds_lfp_data_ptrs,
 233                                                  i);
 234                 if (lvds_dvo_timing_equal_size(dvo_timing, panel_dvo_timing) &&
 235                     dvo_timing->clock < downclock)
 236                         downclock = dvo_timing->clock;
 237         }
 238
 239         if (downclock < panel_dvo_timing->clock && i915_lvds_downclock) {
 240                 dev_priv->lvds_downclock_avail = 1;
 241                 dev_priv->lvds_downclock = downclock * 10;
 242                 DRM_DEBUG("LVDS downclock is found in VBT. "
 243                               "Normal Clock %dKHz, downclock %dKHz\n",
 244                           panel_fixed_mode->clock, 10 * downclock);
 245         }
 246 }
 247
 248 /* Try to find sdvo panel data */
 249 static void
 250 parse_sdvo_panel_data(struct drm_i915_private *dev_priv,
 251                       struct bdb_header *bdb)
 252 {
 253         struct lvds_dvo_timing *dvo_timing;
 254         struct drm_display_mode *panel_fixed_mode;
 255         int index;
 256
 257         index = i915_vbt_sdvo_panel_type;
 258         if (index == -1) {
 259                 struct bdb_sdvo_lvds_options *sdvo_lvds_options;
 260
 261                 sdvo_lvds_options = find_section(bdb, BDB_SDVO_LVDS_OPTIONS);
 262                 if (!sdvo_lvds_options)
 263                         return;
 264
 265                 index = sdvo_lvds_options->panel_type;
 266         }
 267
 268         dvo_timing = find_section(bdb, BDB_SDVO_PANEL_DTDS);
 269         if (!dvo_timing)
 270                 return;
 271
 272         panel_fixed_mode = kmalloc(sizeof(*panel_fixed_mode), DRM_MEM_KMS,
 273             M_WAITOK | M_ZERO);
 274
 275         fill_detail_timing_data(panel_fixed_mode, dvo_timing + index);
 276
 277         dev_priv->sdvo_lvds_vbt_mode = panel_fixed_mode;
 278
 279         DRM_DEBUG_KMS("Found SDVO panel mode in BIOS VBT tables:\n");
 280         drm_mode_debug_printmodeline(panel_fixed_mode);
 281 }
 282
 283 static int intel_bios_ssc_frequency(struct drm_device *dev,
 284                                     bool alternate)
 285 {
 286         switch (INTEL_INFO(dev)->gen) {
 287         case 2:
 288                 return alternate ? 66 : 48;
 289         case 3:
 290         case 4:
 291                 return alternate ? 100 : 96;
 292         default:
 293                 return alternate ? 100 : 120;
 294         }
 295 }
 296
 297 static void
 298 parse_general_features(struct drm_i915_private *dev_priv,
 299                        struct bdb_header *bdb)
 300 {
 301         struct drm_device *dev = dev_priv->dev;
 302         struct bdb_general_features *general;
 303
 304         general = find_section(bdb, BDB_GENERAL_FEATURES);
 305         if (general) {
 306                 dev_priv->int_tv_support = general->int_tv_support;
 307                 dev_priv->int_crt_support = general->int_crt_support;
 308                 dev_priv->lvds_use_ssc = general->enable_ssc;
 309                 dev_priv->lvds_ssc_freq =
 310                         intel_bios_ssc_frequency(dev, general->ssc_freq);
 311                 dev_priv->display_clock_mode = general->display_clock_mode;
 312                 DRM_DEBUG_KMS("BDB_GENERAL_FEATURES int_tv_support %d int_crt_support %d lvds_use_ssc %d lvds_ssc_freq %d display_clock_mode %d\n",
 313                               dev_priv->int_tv_support,
 314                               dev_priv->int_crt_support,
 315                               dev_priv->lvds_use_ssc,
 316                               dev_priv->lvds_ssc_freq,
 317                               dev_priv->display_clock_mode);
 318         }
 319 }
 320
 321 static void
 322 parse_general_definitions(struct drm_i915_private *dev_priv,
 323                           struct bdb_header *bdb)
 324 {
 325         struct bdb_general_definitions *general;
 326
 327         general = find_section(bdb, BDB_GENERAL_DEFINITIONS);
 328         if (general) {
 329                 u16 block_size = get_blocksize(general);
 330                 if (block_size >= sizeof(*general)) {
 331                         int bus_pin = general->crt_ddc_gmbus_pin;
 332                         DRM_DEBUG_KMS("crt_ddc_bus_pin: %d\n", bus_pin);
 333                         if (bus_pin >= 1 && bus_pin <= 6)
 334                                 dev_priv->crt_ddc_pin = bus_pin;
 335                 } else {
 336                         DRM_DEBUG_KMS("BDB_GD too small (%d). Invalid.\n",
 337                                   block_size);
 338                 }
 339         }
 340 }
 341
 342 static void
 343 parse_sdvo_device_mapping(struct drm_i915_private *dev_priv,
 344                           struct bdb_header *bdb)
 345 {
 346         struct sdvo_device_mapping *p_mapping;
 347         struct bdb_general_definitions *p_defs;
 348         struct child_device_config *p_child;
 349         int i, child_device_num, count;
 350         u16     block_size;
 351
 352         p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
 353         if (!p_defs) {
 354                 DRM_DEBUG_KMS("No general definition block is found, unable to construct sdvo mapping.\n");
 355                 return;
 356         }
 357         /* judge whether the size of child device meets the requirements.
 358          * If the child device size obtained from general definition block
 359          * is different with sizeof(struct child_device_config), skip the
 360          * parsing of sdvo device info
 361          */
 362         if (p_defs->child_dev_size != sizeof(*p_child)) {
 363                 /* different child dev size . Ignore it */
 364                 DRM_DEBUG_KMS("different child size is found. Invalid.\n");
 365                 return;
 366         }
 367         /* get the block size of general definitions */
 368         block_size = get_blocksize(p_defs);
 369         /* get the number of child device */
 370         child_device_num = (block_size - sizeof(*p_defs)) /
 371                                 sizeof(*p_child);
 372         count = 0;
 373         for (i = 0; i < child_device_num; i++) {
 374                 p_child = &(p_defs->devices[i]);
 375                 if (!p_child->device_type) {
 376                         /* skip the device block if device type is invalid */
 377                         continue;
 378                 }
 379                 if (p_child->slave_addr != SLAVE_ADDR1 &&
 380                         p_child->slave_addr != SLAVE_ADDR2) {
 381                         /*
 382                          * If the slave address is neither 0x70 nor 0x72,
 383                          * it is not a SDVO device. Skip it.
 384                          */
 385                         continue;
 386                 }
 387                 if (p_child->dvo_port != DEVICE_PORT_DVOB &&
 388                         p_child->dvo_port != DEVICE_PORT_DVOC) {
 389                         /* skip the incorrect SDVO port */
 390                         DRM_DEBUG_KMS("Incorrect SDVO port. Skip it\n");
 391                         continue;
 392                 }
 393                 DRM_DEBUG_KMS("the SDVO device with slave addr %2x is found on"
 394                                 " %s port\n",
 395                                 p_child->slave_addr,
 396                                 (p_child->dvo_port == DEVICE_PORT_DVOB) ?
 397                                         "SDVOB" : "SDVOC");
 398                 p_mapping = &(dev_priv->sdvo_mappings[p_child->dvo_port - 1]);
 399                 if (!p_mapping->initialized) {
 400                         p_mapping->dvo_port = p_child->dvo_port;
 401                         p_mapping->slave_addr = p_child->slave_addr;
 402                         p_mapping->dvo_wiring = p_child->dvo_wiring;
 403                         p_mapping->ddc_pin = p_child->ddc_pin;
 404                         p_mapping->i2c_pin = p_child->i2c_pin;
 405                         p_mapping->initialized = 1;
 406                         DRM_DEBUG_KMS("SDVO device: dvo=%x, addr=%x, wiring=%d, ddc_pin=%d, i2c_pin=%d\n",
 407                                       p_mapping->dvo_port,
 408                                       p_mapping->slave_addr,
 409                                       p_mapping->dvo_wiring,
 410                                       p_mapping->ddc_pin,
 411                                       p_mapping->i2c_pin);
 412                 } else {
 413                         DRM_DEBUG_KMS("Maybe one SDVO port is shared by "
 414                                          "two SDVO device.\n");
 415                 }
 416                 if (p_child->slave2_addr) {
 417                         /* Maybe this is a SDVO device with multiple inputs */
 418                         /* And the mapping info is not added */
 419                         DRM_DEBUG_KMS("there exists the slave2_addr. Maybe this"
 420                                 " is a SDVO device with multiple inputs.\n");
 421                 }
 422                 count++;
 423         }
 424
 425         if (!count) {
 426                 /* No SDVO device info is found */
 427                 DRM_DEBUG_KMS("No SDVO device info is found in VBT\n");
 428         }
 429         return;
 430 }
 431
 432 static void
 433 parse_driver_features(struct drm_i915_private *dev_priv,
 434                        struct bdb_header *bdb)
 435 {
 436         struct drm_device *dev = dev_priv->dev;
 437         struct bdb_driver_features *driver;
 438
 439         driver = find_section(bdb, BDB_DRIVER_FEATURES);
 440         if (!driver)
 441                 return;
 442
 443         if (SUPPORTS_EDP(dev) &&
 444             driver->lvds_config == BDB_DRIVER_FEATURE_EDP)
 445                 dev_priv->edp.support = 1;
 446
 447         if (driver->dual_frequency)
 448                 dev_priv->render_reclock_avail = true;
 449 }
 450
 451 static void
 452 parse_edp(struct drm_i915_private *dev_priv, struct bdb_header *bdb)
 453 {
 454         struct bdb_edp *edp;
 455         struct edp_power_seq *edp_pps;
 456         struct edp_link_params *edp_link_params;
 457
 458         edp = find_section(bdb, BDB_EDP);
 459         if (!edp) {
 460                 if (SUPPORTS_EDP(dev_priv->dev) && dev_priv->edp.support) {
 461                         DRM_DEBUG_KMS("No eDP BDB found but eDP panel "
 462                                       "supported, assume %dbpp panel color "
 463                                       "depth.\n",
 464                                       dev_priv->edp.bpp);
 465                 }
 466                 return;
 467         }
 468
 469         switch ((edp->color_depth >> (panel_type * 2)) & 3) {
 470         case EDP_18BPP:
 471                 dev_priv->edp.bpp = 18;
 472                 break;
 473         case EDP_24BPP:
 474                 dev_priv->edp.bpp = 24;
 475                 break;
 476         case EDP_30BPP:
 477                 dev_priv->edp.bpp = 30;
 478                 break;
 479         }
 480
 481         /* Get the eDP sequencing and link info */
 482         edp_pps = &edp->power_seqs[panel_type];
 483         edp_link_params = &edp->link_params[panel_type];
 484
 485         dev_priv->edp.pps = *edp_pps;
 486
 487         dev_priv->edp.rate = edp_link_params->rate ? DP_LINK_BW_2_7 :
 488                 DP_LINK_BW_1_62;
 489         switch (edp_link_params->lanes) {
 490         case 0:
 491                 dev_priv->edp.lanes = 1;
 492                 break;
 493         case 1:
 494                 dev_priv->edp.lanes = 2;
 495                 break;
 496         case 3:
 497         default:
 498                 dev_priv->edp.lanes = 4;
 499                 break;
 500         }
 501         switch (edp_link_params->preemphasis) {
 502         case 0:
 503                 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPHASIS_0;
 504                 break;
 505         case 1:
 506                 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPHASIS_3_5;
 507                 break;
 508         case 2:
 509                 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPHASIS_6;
 510                 break;
 511         case 3:
 512                 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPHASIS_9_5;
 513                 break;
 514         }
 515         switch (edp_link_params->vswing) {
 516         case 0:
 517                 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_400;
 518                 break;
 519         case 1:
 520                 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_600;
 521                 break;
 522         case 2:
 523                 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_800;
 524                 break;
 525         case 3:
 526                 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_1200;
 527                 break;
 528         }
 529 }
 530
 531 static void
 532 parse_device_mapping(struct drm_i915_private *dev_priv,
 533                        struct bdb_header *bdb)
 534 {
 535         struct bdb_general_definitions *p_defs;
 536         struct child_device_config *p_child, *child_dev_ptr;
 537         int i, child_device_num, count;
 538         u16     block_size;
 539
 540         p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
 541         if (!p_defs) {
 542                 DRM_DEBUG_KMS("No general definition block is found, no devices defined.\n");
 543                 return;
 544         }
 545         /* judge whether the size of child device meets the requirements.
 546          * If the child device size obtained from general definition block
 547          * is different with sizeof(struct child_device_config), skip the
 548          * parsing of sdvo device info
 549          */
 550         if (p_defs->child_dev_size != sizeof(*p_child)) {
 551                 /* different child dev size . Ignore it */
 552                 DRM_DEBUG_KMS("different child size is found. Invalid.\n");
 553                 return;
 554         }
 555         /* get the block size of general definitions */
 556         block_size = get_blocksize(p_defs);
 557         /* get the number of child device */
 558         child_device_num = (block_size - sizeof(*p_defs)) /
 559                                 sizeof(*p_child);
 560         count = 0;
 561         /* get the number of child device that is present */
 562         for (i = 0; i < child_device_num; i++) {
 563                 p_child = &(p_defs->devices[i]);
 564                 if (!p_child->device_type) {
 565                         /* skip the device block if device type is invalid */
 566                         continue;
 567                 }
 568                 count++;
 569         }
 570         if (!count) {
 571                 DRM_DEBUG_KMS("no child dev is parsed from VBT\n");
 572                 return;
 573         }
 574         dev_priv->child_dev = kmalloc(sizeof(*p_child) * count, DRM_MEM_KMS,
 575             M_WAITOK | M_ZERO);
 576
 577         dev_priv->child_dev_num = count;
 578         count = 0;
 579         for (i = 0; i < child_device_num; i++) {
 580                 p_child = &(p_defs->devices[i]);
 581                 if (!p_child->device_type) {
 582                         /* skip the device block if device type is invalid */
 583                         continue;
 584                 }
 585                 child_dev_ptr = dev_priv->child_dev + count;
 586                 count++;
 587                 memcpy((void *)child_dev_ptr, (void *)p_child,
 588                                         sizeof(*p_child));
 589         }
 590         return;
 591 }
 592
 593 static void
 594 init_vbt_defaults(struct drm_i915_private *dev_priv)
 595 {
 596         struct drm_device *dev = dev_priv->dev;
 597
 598         dev_priv->crt_ddc_pin = GMBUS_PORT_VGADDC;
 599
 600         /* LFP panel data */
 601         dev_priv->lvds_dither = 1;
 602         dev_priv->lvds_vbt = 0;
 603
 604         /* SDVO panel data */
 605         dev_priv->sdvo_lvds_vbt_mode = NULL;
 606
 607         /* general features */
 608         dev_priv->int_tv_support = 1;
 609         dev_priv->int_crt_support = 1;
 610
 611         /* Default to using SSC */
 612         dev_priv->lvds_use_ssc = 1;
 613         dev_priv->lvds_ssc_freq = intel_bios_ssc_frequency(dev, 1);
 614         DRM_DEBUG_KMS("Set default to SSC at %dMHz\n", dev_priv->lvds_ssc_freq);
 615
 616         /* eDP data */
 617         dev_priv->edp.bpp = 18;
 618 }
 619
 620 static int intel_no_opregion_vbt_callback(const struct dmi_system_id *id)
 621 {
 622         DRM_DEBUG_KMS("Falling back to manually reading VBT from "
 623                       "VBIOS ROM for %s\n",
 624                       id->ident);
 625         return 1;
 626 }
 627
 628 static const struct dmi_system_id intel_no_opregion_vbt[] = {
 629         {
 630                 .callback = intel_no_opregion_vbt_callback,
 631                 .ident = "ThinkCentre A57",
 632                 .matches = {
 633                         DMI_MATCH(DMI_SYS_VENDOR, "LENOVO"),
 634                         DMI_MATCH(DMI_PRODUCT_NAME, "97027RG"),
 635                 },
 636         },
 637         { }
 638 };
 639
 640 /**
 641  * intel_parse_bios - find VBT and initialize settings from the BIOS
 642  * @dev: DRM device
 643  *
 644  * Loads the Video BIOS and checks that the VBT exists.  Sets scratch registers
 645  * to appropriate values.
 646  *
 647  * Returns 0 on success, nonzero on failure.
 648  */
 649 bool
 650 intel_parse_bios(struct drm_device *dev)
 651 {
 652         struct drm_i915_private *dev_priv = dev->dev_private;
 653         struct bdb_header *bdb = NULL;
 654         u8 *bios;
 655
 656         init_vbt_defaults(dev_priv);
 657
 658         /* XXX Should this validation be moved to intel_opregion.c? */
 659         if (!dmi_check_system(intel_no_opregion_vbt) && dev_priv->opregion.vbt) {
 660                 struct vbt_header *vbt = dev_priv->opregion.vbt;
 661                 if (memcmp(vbt->signature, "$VBT", 4) == 0) {
 662                         DRM_DEBUG_KMS("Using VBT from OpRegion: %20s\n",
 663                                          vbt->signature);
 664                         bdb = (struct bdb_header *)((char *)vbt + vbt->bdb_offset);
 665                 } else
 666                         dev_priv->opregion.vbt = NULL;
 667         }
 668         bios = NULL;
 669
 670 #if 1
 671         if (bdb == NULL) {
 672                 KIB_NOTYET();
 673                 return (-1);
 674         }
 675 #else
 676         if (bdb == NULL) {
 677                 struct vbt_header *vbt = NULL;
 678                 size_t size;
 679                 int i;
 680
 681                 bios = pci_map_rom(pdev, &size);
 682                 if (!bios)
 683                         return -1;
 684
 685                 /* Scour memory looking for the VBT signature */
 686                 for (i = 0; i + 4 < size; i++) {
 687                         if (!memcmp(bios + i, "$VBT", 4)) {
 688                                 vbt = (struct vbt_header *)(bios + i);
 689                                 break;
 690                         }
 691                 }
 692
 693                 if (!vbt) {
 694                         DRM_DEBUG_DRIVER("VBT signature missing\n");
 695                         pci_unmap_rom(pdev, bios);
 696                         return -1;
 697                 }
 698
 699                 bdb = (struct bdb_header *)(bios + i + vbt->bdb_offset);
 700         }
 701 #endif
 702
 703         /* Grab useful general definitions */
 704         parse_general_features(dev_priv, bdb);
 705         parse_general_definitions(dev_priv, bdb);
 706         parse_lfp_panel_data(dev_priv, bdb);
 707         parse_sdvo_panel_data(dev_priv, bdb);
 708         parse_sdvo_device_mapping(dev_priv, bdb);
 709         parse_device_mapping(dev_priv, bdb);
 710         parse_driver_features(dev_priv, bdb);
 711         parse_edp(dev_priv, bdb);
 712
 713 #if 0
 714         if (bios)
 715                 pci_unmap_rom(pdev, bios);
 716 #endif
 717
 718         return 0;
 719 }
 720
 721 /* Ensure that vital registers have been initialised, even if the BIOS
 722  * is absent or just failing to do its job.
 723  */
 724 void intel_setup_bios(struct drm_device *dev)
 725 {
 726         struct drm_i915_private *dev_priv = dev->dev_private;
 727
 728          /* Set the Panel Power On/Off timings if uninitialized. */
 729         if ((I915_READ(PP_ON_DELAYS) == 0) && (I915_READ(PP_OFF_DELAYS) == 0)) {
 730                 /* Set T2 to 40ms and T5 to 200ms */
 731                 I915_WRITE(PP_ON_DELAYS, 0x019007d0);
 732
 733                 /* Set T3 to 35ms and Tx to 200ms */
 734                 I915_WRITE(PP_OFF_DELAYS, 0x015e07d0);
 735         }
 736 }