1 /* 2 * Copyright (c) 2006 Intel Corporation 3 * 4 * This program is free software; you can redistribute it and/or modify it 5 * under the terms and conditions of the GNU General Public License, 6 * version 2, as published by the Free Software Foundation. 7 * 8 * This program is distributed in the hope it will be useful, but WITHOUT 9 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 10 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 11 * more details. 12 * 13 * You should have received a copy of the GNU General Public License along with 14 * this program; if not, write to the Free Software Foundation, Inc., 15 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. 16 * 17 * Authors: 18 * Eric Anholt <eric@anholt.net> 19 * 20 */ 21 #include <drm/drmP.h> 22 #include <drm/drm.h> 23 #include <drm/gma_drm.h> 24 #include "psb_drv.h" 25 #include "psb_intel_drv.h" 26 #include "psb_intel_reg.h" 27 #include "intel_bios.h" 28 29 #define SLAVE_ADDR1 0x70 30 #define SLAVE_ADDR2 0x72 31 32 static void *find_section(struct bdb_header *bdb, int section_id) 33 { 34 u8 *base = (u8 *)bdb; 35 int index = 0; 36 u16 total, current_size; 37 u8 current_id; 38 39 /* skip to first section */ 40 index += bdb->header_size; 41 total = bdb->bdb_size; 42 43 /* walk the sections looking for section_id */ 44 while (index < total) { 45 current_id = *(base + index); 46 index++; 47 current_size = *((u16 *)(base + index)); 48 index += 2; 49 if (current_id == section_id) 50 return base + index; 51 index += current_size; 52 } 53 54 return NULL; 55 } 56 57 static void 58 parse_edp(struct drm_psb_private *dev_priv, struct bdb_header *bdb) 59 { 60 struct bdb_edp *edp; 61 struct edp_power_seq *edp_pps; 62 struct edp_link_params *edp_link_params; 63 uint8_t panel_type; 64 65 edp = find_section(bdb, BDB_EDP); 66 67 dev_priv->edp.bpp = 18; 68 if (!edp) { 69 if (dev_priv->edp.support) { 70 DRM_DEBUG_KMS("No eDP BDB found but eDP panel supported, assume %dbpp panel color depth.\n", 71 dev_priv->edp.bpp); 72 } 73 return; 74 } 75 76 panel_type = dev_priv->panel_type; 77 switch ((edp->color_depth >> (panel_type * 2)) & 3) { 78 case EDP_18BPP: 79 dev_priv->edp.bpp = 18; 80 break; 81 case EDP_24BPP: 82 dev_priv->edp.bpp = 24; 83 break; 84 case EDP_30BPP: 85 dev_priv->edp.bpp = 30; 86 break; 87 } 88 89 /* Get the eDP sequencing and link info */ 90 edp_pps = &edp->power_seqs[panel_type]; 91 edp_link_params = &edp->link_params[panel_type]; 92 93 dev_priv->edp.pps = *edp_pps; 94 95 DRM_DEBUG_KMS("EDP timing in vbt t1_t3 %d t8 %d t9 %d t10 %d t11_t12 %d\n", 96 dev_priv->edp.pps.t1_t3, dev_priv->edp.pps.t8, 97 dev_priv->edp.pps.t9, dev_priv->edp.pps.t10, 98 dev_priv->edp.pps.t11_t12); 99 100 dev_priv->edp.rate = edp_link_params->rate ? DP_LINK_BW_2_7 : 101 DP_LINK_BW_1_62; 102 switch (edp_link_params->lanes) { 103 case 0: 104 dev_priv->edp.lanes = 1; 105 break; 106 case 1: 107 dev_priv->edp.lanes = 2; 108 break; 109 case 3: 110 default: 111 dev_priv->edp.lanes = 4; 112 break; 113 } 114 DRM_DEBUG_KMS("VBT reports EDP: Lane_count %d, Lane_rate %d, Bpp %d\n", 115 dev_priv->edp.lanes, dev_priv->edp.rate, dev_priv->edp.bpp); 116 117 switch (edp_link_params->preemphasis) { 118 case 0: 119 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_0; 120 break; 121 case 1: 122 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_1; 123 break; 124 case 2: 125 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_2; 126 break; 127 case 3: 128 dev_priv->edp.preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_3; 129 break; 130 } 131 switch (edp_link_params->vswing) { 132 case 0: 133 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_0; 134 break; 135 case 1: 136 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_1; 137 break; 138 case 2: 139 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_2; 140 break; 141 case 3: 142 dev_priv->edp.vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_3; 143 break; 144 } 145 DRM_DEBUG_KMS("VBT reports EDP: VSwing %d, Preemph %d\n", 146 dev_priv->edp.vswing, dev_priv->edp.preemphasis); 147 } 148 149 static u16 150 get_blocksize(void *p) 151 { 152 u16 *block_ptr, block_size; 153 154 block_ptr = (u16 *)((char *)p - 2); 155 block_size = *block_ptr; 156 return block_size; 157 } 158 159 static void fill_detail_timing_data(struct drm_display_mode *panel_fixed_mode, 160 struct lvds_dvo_timing *dvo_timing) 161 { 162 panel_fixed_mode->hdisplay = (dvo_timing->hactive_hi << 8) | 163 dvo_timing->hactive_lo; 164 panel_fixed_mode->hsync_start = panel_fixed_mode->hdisplay + 165 ((dvo_timing->hsync_off_hi << 8) | dvo_timing->hsync_off_lo); 166 panel_fixed_mode->hsync_end = panel_fixed_mode->hsync_start + 167 dvo_timing->hsync_pulse_width; 168 panel_fixed_mode->htotal = panel_fixed_mode->hdisplay + 169 ((dvo_timing->hblank_hi << 8) | dvo_timing->hblank_lo); 170 171 panel_fixed_mode->vdisplay = (dvo_timing->vactive_hi << 8) | 172 dvo_timing->vactive_lo; 173 panel_fixed_mode->vsync_start = panel_fixed_mode->vdisplay + 174 dvo_timing->vsync_off; 175 panel_fixed_mode->vsync_end = panel_fixed_mode->vsync_start + 176 dvo_timing->vsync_pulse_width; 177 panel_fixed_mode->vtotal = panel_fixed_mode->vdisplay + 178 ((dvo_timing->vblank_hi << 8) | dvo_timing->vblank_lo); 179 panel_fixed_mode->clock = dvo_timing->clock * 10; 180 panel_fixed_mode->type = DRM_MODE_TYPE_PREFERRED; 181 182 if (dvo_timing->hsync_positive) 183 panel_fixed_mode->flags |= DRM_MODE_FLAG_PHSYNC; 184 else 185 panel_fixed_mode->flags |= DRM_MODE_FLAG_NHSYNC; 186 187 if (dvo_timing->vsync_positive) 188 panel_fixed_mode->flags |= DRM_MODE_FLAG_PVSYNC; 189 else 190 panel_fixed_mode->flags |= DRM_MODE_FLAG_NVSYNC; 191 192 /* Some VBTs have bogus h/vtotal values */ 193 if (panel_fixed_mode->hsync_end > panel_fixed_mode->htotal) 194 panel_fixed_mode->htotal = panel_fixed_mode->hsync_end + 1; 195 if (panel_fixed_mode->vsync_end > panel_fixed_mode->vtotal) 196 panel_fixed_mode->vtotal = panel_fixed_mode->vsync_end + 1; 197 198 drm_mode_set_name(panel_fixed_mode); 199 } 200 201 static void parse_backlight_data(struct drm_psb_private *dev_priv, 202 struct bdb_header *bdb) 203 { 204 struct bdb_lvds_backlight *vbt_lvds_bl = NULL; 205 struct bdb_lvds_backlight *lvds_bl; 206 u8 p_type = 0; 207 void *bl_start = NULL; 208 struct bdb_lvds_options *lvds_opts 209 = find_section(bdb, BDB_LVDS_OPTIONS); 210 211 dev_priv->lvds_bl = NULL; 212 213 if (lvds_opts) 214 p_type = lvds_opts->panel_type; 215 else 216 return; 217 218 bl_start = find_section(bdb, BDB_LVDS_BACKLIGHT); 219 vbt_lvds_bl = (struct bdb_lvds_backlight *)(bl_start + 1) + p_type; 220 221 lvds_bl = kmemdup(vbt_lvds_bl, sizeof(*vbt_lvds_bl), GFP_KERNEL); 222 if (!lvds_bl) { 223 dev_err(dev_priv->dev->dev, "out of memory for backlight data\n"); 224 return; 225 } 226 dev_priv->lvds_bl = lvds_bl; 227 } 228 229 /* Try to find integrated panel data */ 230 static void parse_lfp_panel_data(struct drm_psb_private *dev_priv, 231 struct bdb_header *bdb) 232 { 233 struct bdb_lvds_options *lvds_options; 234 struct bdb_lvds_lfp_data *lvds_lfp_data; 235 struct bdb_lvds_lfp_data_entry *entry; 236 struct lvds_dvo_timing *dvo_timing; 237 struct drm_display_mode *panel_fixed_mode; 238 239 /* Defaults if we can't find VBT info */ 240 dev_priv->lvds_dither = 0; 241 dev_priv->lvds_vbt = 0; 242 243 lvds_options = find_section(bdb, BDB_LVDS_OPTIONS); 244 if (!lvds_options) 245 return; 246 247 dev_priv->lvds_dither = lvds_options->pixel_dither; 248 dev_priv->panel_type = lvds_options->panel_type; 249 250 if (lvds_options->panel_type == 0xff) 251 return; 252 253 lvds_lfp_data = find_section(bdb, BDB_LVDS_LFP_DATA); 254 if (!lvds_lfp_data) 255 return; 256 257 258 entry = &lvds_lfp_data->data[lvds_options->panel_type]; 259 dvo_timing = &entry->dvo_timing; 260 261 panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), 262 GFP_KERNEL); 263 if (panel_fixed_mode == NULL) { 264 dev_err(dev_priv->dev->dev, "out of memory for fixed panel mode\n"); 265 return; 266 } 267 268 dev_priv->lvds_vbt = 1; 269 fill_detail_timing_data(panel_fixed_mode, dvo_timing); 270 271 if (panel_fixed_mode->htotal > 0 && panel_fixed_mode->vtotal > 0) { 272 dev_priv->lfp_lvds_vbt_mode = panel_fixed_mode; 273 drm_mode_debug_printmodeline(panel_fixed_mode); 274 } else { 275 dev_dbg(dev_priv->dev->dev, "ignoring invalid LVDS VBT\n"); 276 dev_priv->lvds_vbt = 0; 277 kfree(panel_fixed_mode); 278 } 279 return; 280 } 281 282 /* Try to find sdvo panel data */ 283 static void parse_sdvo_panel_data(struct drm_psb_private *dev_priv, 284 struct bdb_header *bdb) 285 { 286 struct bdb_sdvo_lvds_options *sdvo_lvds_options; 287 struct lvds_dvo_timing *dvo_timing; 288 struct drm_display_mode *panel_fixed_mode; 289 290 dev_priv->sdvo_lvds_vbt_mode = NULL; 291 292 sdvo_lvds_options = find_section(bdb, BDB_SDVO_LVDS_OPTIONS); 293 if (!sdvo_lvds_options) 294 return; 295 296 dvo_timing = find_section(bdb, BDB_SDVO_PANEL_DTDS); 297 if (!dvo_timing) 298 return; 299 300 panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL); 301 302 if (!panel_fixed_mode) 303 return; 304 305 fill_detail_timing_data(panel_fixed_mode, 306 dvo_timing + sdvo_lvds_options->panel_type); 307 308 dev_priv->sdvo_lvds_vbt_mode = panel_fixed_mode; 309 310 return; 311 } 312 313 static void parse_general_features(struct drm_psb_private *dev_priv, 314 struct bdb_header *bdb) 315 { 316 struct bdb_general_features *general; 317 318 /* Set sensible defaults in case we can't find the general block */ 319 dev_priv->int_tv_support = 1; 320 dev_priv->int_crt_support = 1; 321 322 general = find_section(bdb, BDB_GENERAL_FEATURES); 323 if (general) { 324 dev_priv->int_tv_support = general->int_tv_support; 325 dev_priv->int_crt_support = general->int_crt_support; 326 dev_priv->lvds_use_ssc = general->enable_ssc; 327 328 if (dev_priv->lvds_use_ssc) { 329 dev_priv->lvds_ssc_freq 330 = general->ssc_freq ? 100 : 96; 331 } 332 } 333 } 334 335 static void 336 parse_sdvo_device_mapping(struct drm_psb_private *dev_priv, 337 struct bdb_header *bdb) 338 { 339 struct sdvo_device_mapping *p_mapping; 340 struct bdb_general_definitions *p_defs; 341 struct child_device_config *p_child; 342 int i, child_device_num, count; 343 u16 block_size; 344 345 p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS); 346 if (!p_defs) { 347 DRM_DEBUG_KMS("No general definition block is found, unable to construct sdvo mapping.\n"); 348 return; 349 } 350 /* judge whether the size of child device meets the requirements. 351 * If the child device size obtained from general definition block 352 * is different with sizeof(struct child_device_config), skip the 353 * parsing of sdvo device info 354 */ 355 if (p_defs->child_dev_size != sizeof(*p_child)) { 356 /* different child dev size . Ignore it */ 357 DRM_DEBUG_KMS("different child size is found. Invalid.\n"); 358 return; 359 } 360 /* get the block size of general definitions */ 361 block_size = get_blocksize(p_defs); 362 /* get the number of child device */ 363 child_device_num = (block_size - sizeof(*p_defs)) / 364 sizeof(*p_child); 365 count = 0; 366 for (i = 0; i < child_device_num; i++) { 367 p_child = &(p_defs->devices[i]); 368 if (!p_child->device_type) { 369 /* skip the device block if device type is invalid */ 370 continue; 371 } 372 if (p_child->slave_addr != SLAVE_ADDR1 && 373 p_child->slave_addr != SLAVE_ADDR2) { 374 /* 375 * If the slave address is neither 0x70 nor 0x72, 376 * it is not a SDVO device. Skip it. 377 */ 378 continue; 379 } 380 if (p_child->dvo_port != DEVICE_PORT_DVOB && 381 p_child->dvo_port != DEVICE_PORT_DVOC) { 382 /* skip the incorrect SDVO port */ 383 DRM_DEBUG_KMS("Incorrect SDVO port. Skip it\n"); 384 continue; 385 } 386 DRM_DEBUG_KMS("the SDVO device with slave addr %2x is found on" 387 " %s port\n", 388 p_child->slave_addr, 389 (p_child->dvo_port == DEVICE_PORT_DVOB) ? 390 "SDVOB" : "SDVOC"); 391 p_mapping = &(dev_priv->sdvo_mappings[p_child->dvo_port - 1]); 392 if (!p_mapping->initialized) { 393 p_mapping->dvo_port = p_child->dvo_port; 394 p_mapping->slave_addr = p_child->slave_addr; 395 p_mapping->dvo_wiring = p_child->dvo_wiring; 396 p_mapping->ddc_pin = p_child->ddc_pin; 397 p_mapping->i2c_pin = p_child->i2c_pin; 398 p_mapping->initialized = 1; 399 DRM_DEBUG_KMS("SDVO device: dvo=%x, addr=%x, wiring=%d, ddc_pin=%d, i2c_pin=%d\n", 400 p_mapping->dvo_port, 401 p_mapping->slave_addr, 402 p_mapping->dvo_wiring, 403 p_mapping->ddc_pin, 404 p_mapping->i2c_pin); 405 } else { 406 DRM_DEBUG_KMS("Maybe one SDVO port is shared by " 407 "two SDVO device.\n"); 408 } 409 if (p_child->slave2_addr) { 410 /* Maybe this is a SDVO device with multiple inputs */ 411 /* And the mapping info is not added */ 412 DRM_DEBUG_KMS("there exists the slave2_addr. Maybe this" 413 " is a SDVO device with multiple inputs.\n"); 414 } 415 count++; 416 } 417 418 if (!count) { 419 /* No SDVO device info is found */ 420 DRM_DEBUG_KMS("No SDVO device info is found in VBT\n"); 421 } 422 return; 423 } 424 425 426 static void 427 parse_driver_features(struct drm_psb_private *dev_priv, 428 struct bdb_header *bdb) 429 { 430 struct bdb_driver_features *driver; 431 432 driver = find_section(bdb, BDB_DRIVER_FEATURES); 433 if (!driver) 434 return; 435 436 if (driver->lvds_config == BDB_DRIVER_FEATURE_EDP) 437 dev_priv->edp.support = 1; 438 439 dev_priv->lvds_enabled_in_vbt = driver->lvds_config != 0; 440 DRM_DEBUG_KMS("LVDS VBT config bits: 0x%x\n", driver->lvds_config); 441 442 /* This bit means to use 96Mhz for DPLL_A or not */ 443 if (driver->primary_lfp_id) 444 dev_priv->dplla_96mhz = true; 445 else 446 dev_priv->dplla_96mhz = false; 447 } 448 449 static void 450 parse_device_mapping(struct drm_psb_private *dev_priv, 451 struct bdb_header *bdb) 452 { 453 struct bdb_general_definitions *p_defs; 454 struct child_device_config *p_child, *child_dev_ptr; 455 int i, child_device_num, count; 456 u16 block_size; 457 458 p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS); 459 if (!p_defs) { 460 DRM_DEBUG_KMS("No general definition block is found, no devices defined.\n"); 461 return; 462 } 463 /* judge whether the size of child device meets the requirements. 464 * If the child device size obtained from general definition block 465 * is different with sizeof(struct child_device_config), skip the 466 * parsing of sdvo device info 467 */ 468 if (p_defs->child_dev_size != sizeof(*p_child)) { 469 /* different child dev size . Ignore it */ 470 DRM_DEBUG_KMS("different child size is found. Invalid.\n"); 471 return; 472 } 473 /* get the block size of general definitions */ 474 block_size = get_blocksize(p_defs); 475 /* get the number of child device */ 476 child_device_num = (block_size - sizeof(*p_defs)) / 477 sizeof(*p_child); 478 count = 0; 479 /* get the number of child devices that are present */ 480 for (i = 0; i < child_device_num; i++) { 481 p_child = &(p_defs->devices[i]); 482 if (!p_child->device_type) { 483 /* skip the device block if device type is invalid */ 484 continue; 485 } 486 count++; 487 } 488 if (!count) { 489 DRM_DEBUG_KMS("no child dev is parsed from VBT\n"); 490 return; 491 } 492 dev_priv->child_dev = kcalloc(count, sizeof(*p_child), GFP_KERNEL); 493 if (!dev_priv->child_dev) { 494 DRM_DEBUG_KMS("No memory space for child devices\n"); 495 return; 496 } 497 498 dev_priv->child_dev_num = count; 499 count = 0; 500 for (i = 0; i < child_device_num; i++) { 501 p_child = &(p_defs->devices[i]); 502 if (!p_child->device_type) { 503 /* skip the device block if device type is invalid */ 504 continue; 505 } 506 child_dev_ptr = dev_priv->child_dev + count; 507 count++; 508 memcpy((void *)child_dev_ptr, (void *)p_child, 509 sizeof(*p_child)); 510 } 511 return; 512 } 513 514 515 /** 516 * psb_intel_init_bios - initialize VBIOS settings & find VBT 517 * @dev: DRM device 518 * 519 * Loads the Video BIOS and checks that the VBT exists. Sets scratch registers 520 * to appropriate values. 521 * 522 * VBT existence is a sanity check that is relied on by other i830_bios.c code. 523 * Note that it would be better to use a BIOS call to get the VBT, as BIOSes may 524 * feed an updated VBT back through that, compared to what we'll fetch using 525 * this method of groping around in the BIOS data. 526 * 527 * Returns 0 on success, nonzero on failure. 528 */ 529 int psb_intel_init_bios(struct drm_device *dev) 530 { 531 struct drm_psb_private *dev_priv = dev->dev_private; 532 struct pci_dev *pdev = dev->pdev; 533 struct vbt_header *vbt = NULL; 534 struct bdb_header *bdb = NULL; 535 u8 __iomem *bios = NULL; 536 size_t size; 537 int i; 538 539 540 dev_priv->panel_type = 0xff; 541 542 /* XXX Should this validation be moved to intel_opregion.c? */ 543 if (dev_priv->opregion.vbt) { 544 struct vbt_header *vbt = dev_priv->opregion.vbt; 545 if (memcmp(vbt->signature, "$VBT", 4) == 0) { 546 DRM_DEBUG_KMS("Using VBT from OpRegion: %20s\n", 547 vbt->signature); 548 bdb = (struct bdb_header *)((char *)vbt + vbt->bdb_offset); 549 } else 550 dev_priv->opregion.vbt = NULL; 551 } 552 553 if (bdb == NULL) { 554 bios = pci_map_rom(pdev, &size); 555 if (!bios) 556 return -1; 557 558 /* Scour memory looking for the VBT signature */ 559 for (i = 0; i + 4 < size; i++) { 560 if (!memcmp(bios + i, "$VBT", 4)) { 561 vbt = (struct vbt_header *)(bios + i); 562 break; 563 } 564 } 565 566 if (!vbt) { 567 dev_err(dev->dev, "VBT signature missing\n"); 568 pci_unmap_rom(pdev, bios); 569 return -1; 570 } 571 bdb = (struct bdb_header *)(bios + i + vbt->bdb_offset); 572 } 573 574 /* Grab useful general dxefinitions */ 575 parse_general_features(dev_priv, bdb); 576 parse_driver_features(dev_priv, bdb); 577 parse_lfp_panel_data(dev_priv, bdb); 578 parse_sdvo_panel_data(dev_priv, bdb); 579 parse_sdvo_device_mapping(dev_priv, bdb); 580 parse_device_mapping(dev_priv, bdb); 581 parse_backlight_data(dev_priv, bdb); 582 parse_edp(dev_priv, bdb); 583 584 if (bios) 585 pci_unmap_rom(pdev, bios); 586 587 return 0; 588 } 589 590 /** 591 * Destroy and free VBT data 592 */ 593 void psb_intel_destroy_bios(struct drm_device *dev) 594 { 595 struct drm_psb_private *dev_priv = dev->dev_private; 596 597 kfree(dev_priv->sdvo_lvds_vbt_mode); 598 kfree(dev_priv->lfp_lvds_vbt_mode); 599 kfree(dev_priv->lvds_bl); 600 } 601