intel_bios.c 37.9 KB
Newer Older
J
Jesse Barnes 已提交
1
/*
2
 * Copyright © 2006 Intel Corporation
J
Jesse Barnes 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 *
 * Authors:
 *    Eric Anholt <eric@anholt.net>
 *
 */
27

28
#include <drm/drm_dp_helper.h>
29 30
#include <drm/drmP.h>
#include <drm/i915_drm.h>
J
Jesse Barnes 已提交
31 32 33
#include "i915_drv.h"
#include "intel_bios.h"

34 35
#define	SLAVE_ADDR1	0x70
#define	SLAVE_ADDR2	0x72
J
Jesse Barnes 已提交
36

37 38
static int panel_type;

39 40
static const void *
find_section(const void *_bdb, int section_id)
J
Jesse Barnes 已提交
41
{
42 43
	const struct bdb_header *bdb = _bdb;
	const u8 *base = _bdb;
J
Jesse Barnes 已提交
44
	int index = 0;
45
	u32 total, current_size;
J
Jesse Barnes 已提交
46 47 48 49 50 51 52
	u8 current_id;

	/* skip to first section */
	index += bdb->header_size;
	total = bdb->bdb_size;

	/* walk the sections looking for section_id */
53
	while (index + 3 < total) {
J
Jesse Barnes 已提交
54 55
		current_id = *(base + index);
		index++;
56

57
		current_size = *((const u16 *)(base + index));
J
Jesse Barnes 已提交
58
		index += 2;
59

60 61 62 63
		/* The MIPI Sequence Block v3+ has a separate size field. */
		if (current_id == BDB_MIPI_SEQUENCE && *(base + index) >= 3)
			current_size = *((const u32 *)(base + index + 1));

64 65 66
		if (index + current_size > total)
			return NULL;

J
Jesse Barnes 已提交
67 68
		if (current_id == section_id)
			return base + index;
69

J
Jesse Barnes 已提交
70 71 72 73 74 75
		index += current_size;
	}

	return NULL;
}

76
static u16
77
get_blocksize(const void *p)
78 79 80 81 82 83 84 85
{
	u16 *block_ptr, block_size;

	block_ptr = (u16 *)((char *)p - 2);
	block_size = *block_ptr;
	return block_size;
}

J
Jesse Barnes 已提交
86
static void
87
fill_detail_timing_data(struct drm_display_mode *panel_fixed_mode,
88
			const struct lvds_dvo_timing *dvo_timing)
89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109
{
	panel_fixed_mode->hdisplay = (dvo_timing->hactive_hi << 8) |
		dvo_timing->hactive_lo;
	panel_fixed_mode->hsync_start = panel_fixed_mode->hdisplay +
		((dvo_timing->hsync_off_hi << 8) | dvo_timing->hsync_off_lo);
	panel_fixed_mode->hsync_end = panel_fixed_mode->hsync_start +
		dvo_timing->hsync_pulse_width;
	panel_fixed_mode->htotal = panel_fixed_mode->hdisplay +
		((dvo_timing->hblank_hi << 8) | dvo_timing->hblank_lo);

	panel_fixed_mode->vdisplay = (dvo_timing->vactive_hi << 8) |
		dvo_timing->vactive_lo;
	panel_fixed_mode->vsync_start = panel_fixed_mode->vdisplay +
		dvo_timing->vsync_off;
	panel_fixed_mode->vsync_end = panel_fixed_mode->vsync_start +
		dvo_timing->vsync_pulse_width;
	panel_fixed_mode->vtotal = panel_fixed_mode->vdisplay +
		((dvo_timing->vblank_hi << 8) | dvo_timing->vblank_lo);
	panel_fixed_mode->clock = dvo_timing->clock * 10;
	panel_fixed_mode->type = DRM_MODE_TYPE_PREFERRED;

110 111 112 113 114 115 116 117 118 119
	if (dvo_timing->hsync_positive)
		panel_fixed_mode->flags |= DRM_MODE_FLAG_PHSYNC;
	else
		panel_fixed_mode->flags |= DRM_MODE_FLAG_NHSYNC;

	if (dvo_timing->vsync_positive)
		panel_fixed_mode->flags |= DRM_MODE_FLAG_PVSYNC;
	else
		panel_fixed_mode->flags |= DRM_MODE_FLAG_NVSYNC;

120 121 122 123 124 125 126 127 128
	/* Some VBTs have bogus h/vtotal values */
	if (panel_fixed_mode->hsync_end > panel_fixed_mode->htotal)
		panel_fixed_mode->htotal = panel_fixed_mode->hsync_end + 1;
	if (panel_fixed_mode->vsync_end > panel_fixed_mode->vtotal)
		panel_fixed_mode->vtotal = panel_fixed_mode->vsync_end + 1;

	drm_mode_set_name(panel_fixed_mode);
}

129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150
static const struct lvds_dvo_timing *
get_lvds_dvo_timing(const struct bdb_lvds_lfp_data *lvds_lfp_data,
		    const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs,
		    int index)
{
	/*
	 * the size of fp_timing varies on the different platform.
	 * So calculate the DVO timing relative offset in LVDS data
	 * entry to get the DVO timing entry
	 */

	int lfp_data_size =
		lvds_lfp_data_ptrs->ptr[1].dvo_timing_offset -
		lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset;
	int dvo_timing_offset =
		lvds_lfp_data_ptrs->ptr[0].dvo_timing_offset -
		lvds_lfp_data_ptrs->ptr[0].fp_timing_offset;
	char *entry = (char *)lvds_lfp_data->data + lfp_data_size * index;

	return (struct lvds_dvo_timing *)(entry + dvo_timing_offset);
}

151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172
/* get lvds_fp_timing entry
 * this function may return NULL if the corresponding entry is invalid
 */
static const struct lvds_fp_timing *
get_lvds_fp_timing(const struct bdb_header *bdb,
		   const struct bdb_lvds_lfp_data *data,
		   const struct bdb_lvds_lfp_data_ptrs *ptrs,
		   int index)
{
	size_t data_ofs = (const u8 *)data - (const u8 *)bdb;
	u16 data_size = ((const u16 *)data)[-1]; /* stored in header */
	size_t ofs;

	if (index >= ARRAY_SIZE(ptrs->ptr))
		return NULL;
	ofs = ptrs->ptr[index].fp_timing_offset;
	if (ofs < data_ofs ||
	    ofs + sizeof(struct lvds_fp_timing) > data_ofs + data_size)
		return NULL;
	return (const struct lvds_fp_timing *)((const u8 *)bdb + ofs);
}

173 174 175
/* Try to find integrated panel data */
static void
parse_lfp_panel_data(struct drm_i915_private *dev_priv,
176
		     const struct bdb_header *bdb)
J
Jesse Barnes 已提交
177
{
178 179 180 181
	const struct bdb_lvds_options *lvds_options;
	const struct bdb_lvds_lfp_data *lvds_lfp_data;
	const struct bdb_lvds_lfp_data_ptrs *lvds_lfp_data_ptrs;
	const struct lvds_dvo_timing *panel_dvo_timing;
182
	const struct lvds_fp_timing *fp_timing;
J
Jesse Barnes 已提交
183
	struct drm_display_mode *panel_fixed_mode;
184
	int drrs_mode;
J
Jesse Barnes 已提交
185 186 187 188 189

	lvds_options = find_section(bdb, BDB_LVDS_OPTIONS);
	if (!lvds_options)
		return;

190
	dev_priv->vbt.lvds_dither = lvds_options->pixel_dither;
J
Jesse Barnes 已提交
191 192
	if (lvds_options->panel_type == 0xff)
		return;
193

194
	panel_type = lvds_options->panel_type;
J
Jesse Barnes 已提交
195

196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217
	drrs_mode = (lvds_options->dps_panel_type_bits
				>> (panel_type * 2)) & MODE_MASK;
	/*
	 * VBT has static DRRS = 0 and seamless DRRS = 2.
	 * The below piece of code is required to adjust vbt.drrs_type
	 * to match the enum drrs_support_type.
	 */
	switch (drrs_mode) {
	case 0:
		dev_priv->vbt.drrs_type = STATIC_DRRS_SUPPORT;
		DRM_DEBUG_KMS("DRRS supported mode is static\n");
		break;
	case 2:
		dev_priv->vbt.drrs_type = SEAMLESS_DRRS_SUPPORT;
		DRM_DEBUG_KMS("DRRS supported mode is seamless\n");
		break;
	default:
		dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
		DRM_DEBUG_KMS("DRRS not supported (VBT input)\n");
		break;
	}

J
Jesse Barnes 已提交
218 219 220 221
	lvds_lfp_data = find_section(bdb, BDB_LVDS_LFP_DATA);
	if (!lvds_lfp_data)
		return;

J
Jesse Barnes 已提交
222 223 224 225
	lvds_lfp_data_ptrs = find_section(bdb, BDB_LVDS_LFP_DATA_PTRS);
	if (!lvds_lfp_data_ptrs)
		return;

226
	dev_priv->vbt.lvds_vbt = 1;
J
Jesse Barnes 已提交
227

228 229 230
	panel_dvo_timing = get_lvds_dvo_timing(lvds_lfp_data,
					       lvds_lfp_data_ptrs,
					       lvds_options->panel_type);
J
Jesse Barnes 已提交
231

232
	panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
233 234
	if (!panel_fixed_mode)
		return;
J
Jesse Barnes 已提交
235

236
	fill_detail_timing_data(panel_fixed_mode, panel_dvo_timing);
J
Jesse Barnes 已提交
237

238
	dev_priv->vbt.lfp_lvds_vbt_mode = panel_fixed_mode;
J
Jesse Barnes 已提交
239

240
	DRM_DEBUG_KMS("Found panel mode in BIOS VBT tables:\n");
241
	drm_mode_debug_printmodeline(panel_fixed_mode);
242

243 244 245 246 247 248 249
	fp_timing = get_lvds_fp_timing(bdb, lvds_lfp_data,
				       lvds_lfp_data_ptrs,
				       lvds_options->panel_type);
	if (fp_timing) {
		/* check the resolution, just to be sure */
		if (fp_timing->x_res == panel_fixed_mode->hdisplay &&
		    fp_timing->y_res == panel_fixed_mode->vdisplay) {
250
			dev_priv->vbt.bios_lvds_val = fp_timing->lvds_reg_val;
251
			DRM_DEBUG_KMS("VBT initial LVDS value %x\n",
252
				      dev_priv->vbt.bios_lvds_val);
253 254
		}
	}
255 256
}

257
static void
258 259
parse_lfp_backlight(struct drm_i915_private *dev_priv,
		    const struct bdb_header *bdb)
260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275
{
	const struct bdb_lfp_backlight_data *backlight_data;
	const struct bdb_lfp_backlight_data_entry *entry;

	backlight_data = find_section(bdb, BDB_LVDS_BACKLIGHT);
	if (!backlight_data)
		return;

	if (backlight_data->entry_size != sizeof(backlight_data->data[0])) {
		DRM_DEBUG_KMS("Unsupported backlight data entry size %u\n",
			      backlight_data->entry_size);
		return;
	}

	entry = &backlight_data->data[panel_type];

276 277 278 279 280 281 282
	dev_priv->vbt.backlight.present = entry->type == BDB_BACKLIGHT_TYPE_PWM;
	if (!dev_priv->vbt.backlight.present) {
		DRM_DEBUG_KMS("PWM backlight not present in VBT (type %u)\n",
			      entry->type);
		return;
	}

283 284
	dev_priv->vbt.backlight.pwm_freq_hz = entry->pwm_freq_hz;
	dev_priv->vbt.backlight.active_low_pwm = entry->active_low_pwm;
285
	dev_priv->vbt.backlight.min_brightness = entry->min_brightness;
286 287 288 289
	DRM_DEBUG_KMS("VBT backlight PWM modulation frequency %u Hz, "
		      "active %s, min brightness %u, level %u\n",
		      dev_priv->vbt.backlight.pwm_freq_hz,
		      dev_priv->vbt.backlight.active_low_pwm ? "low" : "high",
290
		      dev_priv->vbt.backlight.min_brightness,
291 292 293
		      backlight_data->level[panel_type]);
}

294 295 296
/* Try to find sdvo panel data */
static void
parse_sdvo_panel_data(struct drm_i915_private *dev_priv,
297
		      const struct bdb_header *bdb)
298
{
299
	const struct lvds_dvo_timing *dvo_timing;
300
	struct drm_display_mode *panel_fixed_mode;
301
	int index;
J
Jesse Barnes 已提交
302

303
	index = i915.vbt_sdvo_panel_type;
304 305 306 307 308
	if (index == -2) {
		DRM_DEBUG_KMS("Ignore SDVO panel mode from BIOS VBT tables.\n");
		return;
	}

309
	if (index == -1) {
310
		const struct bdb_sdvo_lvds_options *sdvo_lvds_options;
311 312 313 314 315 316 317

		sdvo_lvds_options = find_section(bdb, BDB_SDVO_LVDS_OPTIONS);
		if (!sdvo_lvds_options)
			return;

		index = sdvo_lvds_options->panel_type;
	}
318 319 320 321 322

	dvo_timing = find_section(bdb, BDB_SDVO_PANEL_DTDS);
	if (!dvo_timing)
		return;

323
	panel_fixed_mode = kzalloc(sizeof(*panel_fixed_mode), GFP_KERNEL);
324 325 326
	if (!panel_fixed_mode)
		return;

327
	fill_detail_timing_data(panel_fixed_mode, dvo_timing + index);
328

329
	dev_priv->vbt.sdvo_lvds_vbt_mode = panel_fixed_mode;
J
Jesse Barnes 已提交
330

331 332
	DRM_DEBUG_KMS("Found SDVO panel mode in BIOS VBT tables:\n");
	drm_mode_debug_printmodeline(panel_fixed_mode);
J
Jesse Barnes 已提交
333 334
}

335 336 337 338 339
static int intel_bios_ssc_frequency(struct drm_device *dev,
				    bool alternate)
{
	switch (INTEL_INFO(dev)->gen) {
	case 2:
340
		return alternate ? 66667 : 48000;
341 342
	case 3:
	case 4:
343
		return alternate ? 100000 : 96000;
344
	default:
345
		return alternate ? 100000 : 120000;
346 347 348
	}
}

J
Jesse Barnes 已提交
349 350
static void
parse_general_features(struct drm_i915_private *dev_priv,
351
		       const struct bdb_header *bdb)
J
Jesse Barnes 已提交
352
{
353
	struct drm_device *dev = dev_priv->dev;
354
	const struct bdb_general_features *general;
J
Jesse Barnes 已提交
355 356 357

	general = find_section(bdb, BDB_GENERAL_FEATURES);
	if (general) {
358
		dev_priv->vbt.int_tv_support = general->int_tv_support;
359 360 361 362
		/* int_crt_support can't be trusted on earlier platforms */
		if (bdb->version >= 155 &&
		    (HAS_DDI(dev_priv) || IS_VALLEYVIEW(dev_priv)))
			dev_priv->vbt.int_crt_support = general->int_crt_support;
363 364
		dev_priv->vbt.lvds_use_ssc = general->enable_ssc;
		dev_priv->vbt.lvds_ssc_freq =
365
			intel_bios_ssc_frequency(dev, general->ssc_freq);
366 367
		dev_priv->vbt.display_clock_mode = general->display_clock_mode;
		dev_priv->vbt.fdi_rx_polarity_inverted = general->fdi_rx_polarity_inverted;
368
		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 fdi_rx_polarity_inverted %d\n",
369 370 371 372 373 374
			      dev_priv->vbt.int_tv_support,
			      dev_priv->vbt.int_crt_support,
			      dev_priv->vbt.lvds_use_ssc,
			      dev_priv->vbt.lvds_ssc_freq,
			      dev_priv->vbt.display_clock_mode,
			      dev_priv->vbt.fdi_rx_polarity_inverted);
J
Jesse Barnes 已提交
375 376 377
	}
}

378 379
static void
parse_general_definitions(struct drm_i915_private *dev_priv,
380
			  const struct bdb_header *bdb)
381
{
382
	const struct bdb_general_definitions *general;
383 384 385 386 387 388

	general = find_section(bdb, BDB_GENERAL_DEFINITIONS);
	if (general) {
		u16 block_size = get_blocksize(general);
		if (block_size >= sizeof(*general)) {
			int bus_pin = general->crt_ddc_gmbus_pin;
389
			DRM_DEBUG_KMS("crt_ddc_bus_pin: %d\n", bus_pin);
390
			if (intel_gmbus_is_valid_pin(dev_priv, bus_pin))
391
				dev_priv->vbt.crt_ddc_pin = bus_pin;
392
		} else {
393
			DRM_DEBUG_KMS("BDB_GD too small (%d). Invalid.\n",
394
				      block_size);
395 396 397 398
		}
	}
}

399 400
static const union child_device_config *
child_device_ptr(const struct bdb_general_definitions *p_defs, int i)
401
{
402
	return (const void *) &p_defs->devices[i * p_defs->child_dev_size];
403 404
}

405 406
static void
parse_sdvo_device_mapping(struct drm_i915_private *dev_priv,
407
			  const struct bdb_header *bdb)
408 409
{
	struct sdvo_device_mapping *p_mapping;
410
	const struct bdb_general_definitions *p_defs;
411
	const struct old_child_dev_config *child; /* legacy */
412
	int i, child_device_num, count;
413
	u16	block_size;
414 415 416

	p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
	if (!p_defs) {
417
		DRM_DEBUG_KMS("No general definition block is found, unable to construct sdvo mapping.\n");
418 419
		return;
	}
420 421 422 423 424

	/*
	 * Only parse SDVO mappings when the general definitions block child
	 * device size matches that of the *legacy* child device config
	 * struct. Thus, SDVO mapping will be skipped for newer VBT.
425
	 */
426 427
	if (p_defs->child_dev_size != sizeof(*child)) {
		DRM_DEBUG_KMS("Unsupported child device size for SDVO mapping.\n");
428 429 430
		return;
	}
	/* get the block size of general definitions */
431
	block_size = get_blocksize(p_defs);
432 433
	/* get the number of child device */
	child_device_num = (block_size - sizeof(*p_defs)) /
434
		p_defs->child_dev_size;
435 436
	count = 0;
	for (i = 0; i < child_device_num; i++) {
437 438
		child = &child_device_ptr(p_defs, i)->old;
		if (!child->device_type) {
439 440 441
			/* skip the device block if device type is invalid */
			continue;
		}
442 443
		if (child->slave_addr != SLAVE_ADDR1 &&
		    child->slave_addr != SLAVE_ADDR2) {
444 445 446 447 448 449
			/*
			 * If the slave address is neither 0x70 nor 0x72,
			 * it is not a SDVO device. Skip it.
			 */
			continue;
		}
450 451
		if (child->dvo_port != DEVICE_PORT_DVOB &&
		    child->dvo_port != DEVICE_PORT_DVOC) {
452
			/* skip the incorrect SDVO port */
453
			DRM_DEBUG_KMS("Incorrect SDVO port. Skip it\n");
454 455
			continue;
		}
456
		DRM_DEBUG_KMS("the SDVO device with slave addr %2x is found on"
457 458 459 460 461
			      " %s port\n",
			      child->slave_addr,
			      (child->dvo_port == DEVICE_PORT_DVOB) ?
			      "SDVOB" : "SDVOC");
		p_mapping = &(dev_priv->sdvo_mappings[child->dvo_port - 1]);
462
		if (!p_mapping->initialized) {
463 464 465 466 467
			p_mapping->dvo_port = child->dvo_port;
			p_mapping->slave_addr = child->slave_addr;
			p_mapping->dvo_wiring = child->dvo_wiring;
			p_mapping->ddc_pin = child->ddc_pin;
			p_mapping->i2c_pin = child->i2c_pin;
468
			p_mapping->initialized = 1;
469
			DRM_DEBUG_KMS("SDVO device: dvo=%x, addr=%x, wiring=%d, ddc_pin=%d, i2c_pin=%d\n",
C
Chris Wilson 已提交
470 471 472 473
				      p_mapping->dvo_port,
				      p_mapping->slave_addr,
				      p_mapping->dvo_wiring,
				      p_mapping->ddc_pin,
474
				      p_mapping->i2c_pin);
475
		} else {
476
			DRM_DEBUG_KMS("Maybe one SDVO port is shared by "
477 478
					 "two SDVO device.\n");
		}
479
		if (child->slave2_addr) {
480 481
			/* Maybe this is a SDVO device with multiple inputs */
			/* And the mapping info is not added */
482 483
			DRM_DEBUG_KMS("there exists the slave2_addr. Maybe this"
				" is a SDVO device with multiple inputs.\n");
484 485 486 487 488 489
		}
		count++;
	}

	if (!count) {
		/* No SDVO device info is found */
490
		DRM_DEBUG_KMS("No SDVO device info is found in VBT\n");
491 492 493
	}
	return;
}
494 495 496

static void
parse_driver_features(struct drm_i915_private *dev_priv,
497
		      const struct bdb_header *bdb)
498
{
499
	const struct bdb_driver_features *driver;
500 501

	driver = find_section(bdb, BDB_DRIVER_FEATURES);
502 503 504
	if (!driver)
		return;

D
Daniel Vetter 已提交
505
	if (driver->lvds_config == BDB_DRIVER_FEATURE_EDP)
506
		dev_priv->vbt.edp_support = 1;
507

508
	if (driver->dual_frequency)
509
		dev_priv->render_reclock_avail = true;
510 511 512 513 514 515 516 517 518 519

	DRM_DEBUG_KMS("DRRS State Enabled:%d\n", driver->drrs_enabled);
	/*
	 * If DRRS is not supported, drrs_type has to be set to 0.
	 * This is because, VBT is configured in such a way that
	 * static DRRS is 0 and DRRS not supported is represented by
	 * driver->drrs_enabled=false
	 */
	if (!driver->drrs_enabled)
		dev_priv->vbt.drrs_type = DRRS_NOT_SUPPORTED;
520 521
}

522
static void
523
parse_edp(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
524
{
525 526 527
	const struct bdb_edp *edp;
	const struct edp_power_seq *edp_pps;
	const struct edp_link_params *edp_link_params;
528 529 530

	edp = find_section(bdb, BDB_EDP);
	if (!edp) {
D
Daniel Vetter 已提交
531
		if (dev_priv->vbt.edp_support)
532
			DRM_DEBUG_KMS("No eDP BDB found but eDP panel supported.\n");
533 534 535 536 537
		return;
	}

	switch ((edp->color_depth >> (panel_type * 2)) & 3) {
	case EDP_18BPP:
538
		dev_priv->vbt.edp_bpp = 18;
539 540
		break;
	case EDP_24BPP:
541
		dev_priv->vbt.edp_bpp = 24;
542 543
		break;
	case EDP_30BPP:
544
		dev_priv->vbt.edp_bpp = 30;
545 546
		break;
	}
547

548 549 550
	/* Get the eDP sequencing and link info */
	edp_pps = &edp->power_seqs[panel_type];
	edp_link_params = &edp->link_params[panel_type];
551

552
	dev_priv->vbt.edp_pps = *edp_pps;
553

554 555 556 557 558 559 560 561 562 563 564 565 566
	switch (edp_link_params->rate) {
	case EDP_RATE_1_62:
		dev_priv->vbt.edp_rate = DP_LINK_BW_1_62;
		break;
	case EDP_RATE_2_7:
		dev_priv->vbt.edp_rate = DP_LINK_BW_2_7;
		break;
	default:
		DRM_DEBUG_KMS("VBT has unknown eDP link rate value %u\n",
			      edp_link_params->rate);
		break;
	}

567
	switch (edp_link_params->lanes) {
568
	case EDP_LANE_1:
569
		dev_priv->vbt.edp_lanes = 1;
570
		break;
571
	case EDP_LANE_2:
572
		dev_priv->vbt.edp_lanes = 2;
573
		break;
574
	case EDP_LANE_4:
575
		dev_priv->vbt.edp_lanes = 4;
576
		break;
577 578 579 580
	default:
		DRM_DEBUG_KMS("VBT has unknown eDP lane count value %u\n",
			      edp_link_params->lanes);
		break;
581
	}
582

583
	switch (edp_link_params->preemphasis) {
584
	case EDP_PREEMPHASIS_NONE:
585
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_0;
586
		break;
587
	case EDP_PREEMPHASIS_3_5dB:
588
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_1;
589
		break;
590
	case EDP_PREEMPHASIS_6dB:
591
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_2;
592
		break;
593
	case EDP_PREEMPHASIS_9_5dB:
594
		dev_priv->vbt.edp_preemphasis = DP_TRAIN_PRE_EMPH_LEVEL_3;
595
		break;
596 597 598 599
	default:
		DRM_DEBUG_KMS("VBT has unknown eDP pre-emphasis value %u\n",
			      edp_link_params->preemphasis);
		break;
600
	}
601

602
	switch (edp_link_params->vswing) {
603
	case EDP_VSWING_0_4V:
604
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_0;
605
		break;
606
	case EDP_VSWING_0_6V:
607
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_1;
608
		break;
609
	case EDP_VSWING_0_8V:
610
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_2;
611
		break;
612
	case EDP_VSWING_1_2V:
613
		dev_priv->vbt.edp_vswing = DP_TRAIN_VOLTAGE_SWING_LEVEL_3;
614
		break;
615 616 617 618
	default:
		DRM_DEBUG_KMS("VBT has unknown eDP voltage swing value %u\n",
			      edp_link_params->vswing);
		break;
619
	}
620 621 622 623

	if (bdb->version >= 173) {
		uint8_t vswing;

624 625 626 627 628 629 630
		/* Don't read from VBT if module parameter has valid value*/
		if (i915.edp_vswing) {
			dev_priv->edp_low_vswing = i915.edp_vswing == 1;
		} else {
			vswing = (edp->edp_vswing_preemph >> (panel_type * 4)) & 0xF;
			dev_priv->edp_low_vswing = vswing == 0;
		}
631
	}
632 633
}

R
Rodrigo Vivi 已提交
634
static void
635
parse_psr(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
R
Rodrigo Vivi 已提交
636
{
637 638
	const struct bdb_psr *psr;
	const struct psr_table *psr_table;
R
Rodrigo Vivi 已提交
639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677

	psr = find_section(bdb, BDB_PSR);
	if (!psr) {
		DRM_DEBUG_KMS("No PSR BDB found.\n");
		return;
	}

	psr_table = &psr->psr_table[panel_type];

	dev_priv->vbt.psr.full_link = psr_table->full_link;
	dev_priv->vbt.psr.require_aux_wakeup = psr_table->require_aux_to_wakeup;

	/* Allowed VBT values goes from 0 to 15 */
	dev_priv->vbt.psr.idle_frames = psr_table->idle_frames < 0 ? 0 :
		psr_table->idle_frames > 15 ? 15 : psr_table->idle_frames;

	switch (psr_table->lines_to_wait) {
	case 0:
		dev_priv->vbt.psr.lines_to_wait = PSR_0_LINES_TO_WAIT;
		break;
	case 1:
		dev_priv->vbt.psr.lines_to_wait = PSR_1_LINE_TO_WAIT;
		break;
	case 2:
		dev_priv->vbt.psr.lines_to_wait = PSR_4_LINES_TO_WAIT;
		break;
	case 3:
		dev_priv->vbt.psr.lines_to_wait = PSR_8_LINES_TO_WAIT;
		break;
	default:
		DRM_DEBUG_KMS("VBT has unknown PSR lines to wait %u\n",
			      psr_table->lines_to_wait);
		break;
	}

	dev_priv->vbt.psr.tp1_wakeup_time = psr_table->tp1_wakeup_time;
	dev_priv->vbt.psr.tp2_tp3_wakeup_time = psr_table->tp2_tp3_wakeup_time;
}

678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694
static u8 *goto_next_sequence(u8 *data, int *size)
{
	u16 len;
	int tmp = *size;

	if (--tmp < 0)
		return NULL;

	/* goto first element */
	data++;
	while (1) {
		switch (*data) {
		case MIPI_SEQ_ELEM_SEND_PKT:
			/*
			 * skip by this element payload size
			 * skip elem id, command flag and data type
			 */
695 696
			tmp -= 5;
			if (tmp < 0)
697 698 699 700 701
				return NULL;

			data += 3;
			len = *((u16 *)data);

702 703
			tmp -= len;
			if (tmp < 0)
704 705 706 707 708 709 710
				return NULL;

			/* skip by len */
			data = data + 2 + len;
			break;
		case MIPI_SEQ_ELEM_DELAY:
			/* skip by elem id, and delay is 4 bytes */
711 712
			tmp -= 5;
			if (tmp < 0)
713 714 715 716 717
				return NULL;

			data += 5;
			break;
		case MIPI_SEQ_ELEM_GPIO:
718 719
			tmp -= 3;
			if (tmp < 0)
720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744
				return NULL;

			data += 3;
			break;
		default:
			DRM_ERROR("Unknown element\n");
			return NULL;
		}

		/* end of sequence ? */
		if (*data == 0)
			break;
	}

	/* goto next sequence or end of block byte */
	if (--tmp < 0)
		return NULL;

	data++;

	/* update amount of data left for the sequence block to be parsed */
	*size = tmp;
	return data;
}

745
static void
746
parse_mipi(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
747
{
748 749 750 751 752 753
	const struct bdb_mipi_config *start;
	const struct bdb_mipi_sequence *sequence;
	const struct mipi_config *config;
	const struct mipi_pps_data *pps;
	u8 *data;
	const u8 *seq_data;
754 755 756
	int i, panel_id, seq_size;
	u16 block_size;

757 758 759 760
	/* parse MIPI blocks only if LFP type is MIPI */
	if (!dev_priv->vbt.has_mipi)
		return;

761 762 763 764 765 766 767
	/* Initialize this to undefined indicating no generic MIPI support */
	dev_priv->vbt.dsi.panel_id = MIPI_DSI_UNDEFINED_PANEL_ID;

	/* Block #40 is already parsed and panel_fixed_mode is
	 * stored in dev_priv->lfp_lvds_vbt_mode
	 * resuse this when needed
	 */
768

769 770 771 772 773 774
	/* Parse #52 for panel index used from panel_type already
	 * parsed
	 */
	start = find_section(bdb, BDB_MIPI_CONFIG);
	if (!start) {
		DRM_DEBUG_KMS("No MIPI config BDB found");
775 776 777
		return;
	}

778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799
	DRM_DEBUG_DRIVER("Found MIPI Config block, panel index = %d\n",
								panel_type);

	/*
	 * get hold of the correct configuration block and pps data as per
	 * the panel_type as index
	 */
	config = &start->config[panel_type];
	pps = &start->pps[panel_type];

	/* store as of now full data. Trim when we realise all is not needed */
	dev_priv->vbt.dsi.config = kmemdup(config, sizeof(struct mipi_config), GFP_KERNEL);
	if (!dev_priv->vbt.dsi.config)
		return;

	dev_priv->vbt.dsi.pps = kmemdup(pps, sizeof(struct mipi_pps_data), GFP_KERNEL);
	if (!dev_priv->vbt.dsi.pps) {
		kfree(dev_priv->vbt.dsi.config);
		return;
	}

	/* We have mandatory mipi config blocks. Initialize as generic panel */
800
	dev_priv->vbt.dsi.panel_id = MIPI_DSI_GENERIC_PANEL_ID;
801 802 803 804 805 806 807 808

	/* Check if we have sequence block as well */
	sequence = find_section(bdb, BDB_MIPI_SEQUENCE);
	if (!sequence) {
		DRM_DEBUG_KMS("No MIPI Sequence found, parsing complete\n");
		return;
	}

809 810 811 812 813 814
	/* Fail gracefully for forward incompatible sequence block. */
	if (sequence->version >= 3) {
		DRM_ERROR("Unable to parse MIPI Sequence Block v3+\n");
		return;
	}

815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898
	DRM_DEBUG_DRIVER("Found MIPI sequence block\n");

	block_size = get_blocksize(sequence);

	/*
	 * parse the sequence block for individual sequences
	 */
	dev_priv->vbt.dsi.seq_version = sequence->version;

	seq_data = &sequence->data[0];

	/*
	 * sequence block is variable length and hence we need to parse and
	 * get the sequence data for specific panel id
	 */
	for (i = 0; i < MAX_MIPI_CONFIGURATIONS; i++) {
		panel_id = *seq_data;
		seq_size = *((u16 *) (seq_data + 1));
		if (panel_id == panel_type)
			break;

		/* skip the sequence including seq header of 3 bytes */
		seq_data = seq_data + 3 + seq_size;
		if ((seq_data - &sequence->data[0]) > block_size) {
			DRM_ERROR("Sequence start is beyond sequence block size, corrupted sequence block\n");
			return;
		}
	}

	if (i == MAX_MIPI_CONFIGURATIONS) {
		DRM_ERROR("Sequence block detected but no valid configuration\n");
		return;
	}

	/* check if found sequence is completely within the sequence block
	 * just being paranoid */
	if (seq_size > block_size) {
		DRM_ERROR("Corrupted sequence/size, bailing out\n");
		return;
	}

	/* skip the panel id(1 byte) and seq size(2 bytes) */
	dev_priv->vbt.dsi.data = kmemdup(seq_data + 3, seq_size, GFP_KERNEL);
	if (!dev_priv->vbt.dsi.data)
		return;

	/*
	 * loop into the sequence data and split into multiple sequneces
	 * There are only 5 types of sequences as of now
	 */
	data = dev_priv->vbt.dsi.data;
	dev_priv->vbt.dsi.size = seq_size;

	/* two consecutive 0x00 indicate end of all sequences */
	while (1) {
		int seq_id = *data;
		if (MIPI_SEQ_MAX > seq_id && seq_id > MIPI_SEQ_UNDEFINED) {
			dev_priv->vbt.dsi.sequence[seq_id] = data;
			DRM_DEBUG_DRIVER("Found mipi sequence - %d\n", seq_id);
		} else {
			DRM_ERROR("undefined sequence\n");
			goto err;
		}

		/* partial parsing to skip elements */
		data = goto_next_sequence(data, &seq_size);

		if (data == NULL) {
			DRM_ERROR("Sequence elements going beyond block itself. Sequence block parsing failed\n");
			goto err;
		}

		if (*data == 0)
			break; /* end of sequence reached */
	}

	DRM_DEBUG_DRIVER("MIPI related vbt parsing complete\n");
	return;
err:
	kfree(dev_priv->vbt.dsi.data);
	dev_priv->vbt.dsi.data = NULL;

	/* error during parsing so set all pointers to null
	 * because of partial parsing */
899
	memset(dev_priv->vbt.dsi.sequence, 0, sizeof(dev_priv->vbt.dsi.sequence));
900 901
}

902 903 904 905 906 907 908 909 910 911 912
static u8 translate_iboost(u8 val)
{
	static const u8 mapping[] = { 1, 3, 7 }; /* See VBT spec */

	if (val >= ARRAY_SIZE(mapping)) {
		DRM_DEBUG_KMS("Unsupported I_boost value found in VBT (%d), display may not work properly\n", val);
		return 0;
	}
	return mapping[val];
}

913
static void parse_ddi_port(struct drm_i915_private *dev_priv, enum port port,
914
			   const struct bdb_header *bdb)
915 916 917 918 919
{
	union child_device_config *it, *child = NULL;
	struct ddi_vbt_port_info *info = &dev_priv->vbt.ddi_port_info[port];
	uint8_t hdmi_level_shift;
	int i, j;
920
	bool is_dvi, is_hdmi, is_dp, is_edp, is_crt;
X
Xiong Zhang 已提交
921
	uint8_t aux_channel, ddc_pin;
922 923 924
	/* Each DDI port can have more than one value on the "DVO Port" field,
	 * so look for all the possible values for each port and abort if more
	 * than one is found. */
R
Rodrigo Vivi 已提交
925 926 927 928 929 930
	int dvo_ports[][3] = {
		{DVO_PORT_HDMIA, DVO_PORT_DPA, -1},
		{DVO_PORT_HDMIB, DVO_PORT_DPB, -1},
		{DVO_PORT_HDMIC, DVO_PORT_DPC, -1},
		{DVO_PORT_HDMID, DVO_PORT_DPD, -1},
		{DVO_PORT_CRT, DVO_PORT_HDMIE, DVO_PORT_DPE},
931 932 933 934 935 936
	};

	/* Find the child device to use, abort if more than one found. */
	for (i = 0; i < dev_priv->vbt.child_dev_num; i++) {
		it = dev_priv->vbt.child_dev + i;

R
Rodrigo Vivi 已提交
937
		for (j = 0; j < 3; j++) {
938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953
			if (dvo_ports[port][j] == -1)
				break;

			if (it->common.dvo_port == dvo_ports[port][j]) {
				if (child) {
					DRM_DEBUG_KMS("More than one child device for port %c in VBT.\n",
						      port_name(port));
					return;
				}
				child = it;
			}
		}
	}
	if (!child)
		return;

954
	aux_channel = child->raw[25];
X
Xiong Zhang 已提交
955
	ddc_pin = child->common.ddc_pin;
956

957 958 959 960 961
	is_dvi = child->common.device_type & DEVICE_TYPE_TMDS_DVI_SIGNALING;
	is_dp = child->common.device_type & DEVICE_TYPE_DISPLAYPORT_OUTPUT;
	is_crt = child->common.device_type & DEVICE_TYPE_ANALOG_OUTPUT;
	is_hdmi = is_dvi && (child->common.device_type & DEVICE_TYPE_NOT_HDMI_OUTPUT) == 0;
	is_edp = is_dp && (child->common.device_type & DEVICE_TYPE_INTERNAL_CONNECTOR);
962

963 964 965 966
	info->supports_dvi = is_dvi;
	info->supports_hdmi = is_hdmi;
	info->supports_dp = is_dp;

967 968 969 970 971 972 973 974 975 976 977 978
	DRM_DEBUG_KMS("Port %c VBT info: DP:%d HDMI:%d DVI:%d EDP:%d CRT:%d\n",
		      port_name(port), is_dp, is_hdmi, is_dvi, is_edp, is_crt);

	if (is_edp && is_dvi)
		DRM_DEBUG_KMS("Internal DP port %c is TMDS compatible\n",
			      port_name(port));
	if (is_crt && port != PORT_E)
		DRM_DEBUG_KMS("Port %c is analog\n", port_name(port));
	if (is_crt && (is_dvi || is_dp))
		DRM_DEBUG_KMS("Analog port %c is also DP or TMDS compatible\n",
			      port_name(port));
	if (is_dvi && (port == PORT_A || port == PORT_E))
M
Masanari Iida 已提交
979
		DRM_DEBUG_KMS("Port %c is TMDS compatible\n", port_name(port));
980 981 982 983 984
	if (!is_dvi && !is_dp && !is_crt)
		DRM_DEBUG_KMS("Port %c is not DP/TMDS/CRT compatible\n",
			      port_name(port));
	if (is_edp && (port == PORT_B || port == PORT_C || port == PORT_E))
		DRM_DEBUG_KMS("Port %c is internal DP\n", port_name(port));
985 986

	if (is_dvi) {
X
Xiong Zhang 已提交
987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003
		if (port == PORT_E) {
			info->alternate_ddc_pin = ddc_pin;
			/* if DDIE share ddc pin with other port, then
			 * dvi/hdmi couldn't exist on the shared port.
			 * Otherwise they share the same ddc bin and system
			 * couldn't communicate with them seperately. */
			if (ddc_pin == DDC_PIN_B) {
				dev_priv->vbt.ddi_port_info[PORT_B].supports_dvi = 0;
				dev_priv->vbt.ddi_port_info[PORT_B].supports_hdmi = 0;
			} else if (ddc_pin == DDC_PIN_C) {
				dev_priv->vbt.ddi_port_info[PORT_C].supports_dvi = 0;
				dev_priv->vbt.ddi_port_info[PORT_C].supports_hdmi = 0;
			} else if (ddc_pin == DDC_PIN_D) {
				dev_priv->vbt.ddi_port_info[PORT_D].supports_dvi = 0;
				dev_priv->vbt.ddi_port_info[PORT_D].supports_hdmi = 0;
			}
		} else if (ddc_pin == DDC_PIN_B && port != PORT_B)
1004
			DRM_DEBUG_KMS("Unexpected DDC pin for port B\n");
X
Xiong Zhang 已提交
1005
		else if (ddc_pin == DDC_PIN_C && port != PORT_C)
1006
			DRM_DEBUG_KMS("Unexpected DDC pin for port C\n");
X
Xiong Zhang 已提交
1007
		else if (ddc_pin == DDC_PIN_D && port != PORT_D)
1008 1009 1010 1011
			DRM_DEBUG_KMS("Unexpected DDC pin for port D\n");
	}

	if (is_dp) {
1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027
		if (port == PORT_E) {
			info->alternate_aux_channel = aux_channel;
			/* if DDIE share aux channel with other port, then
			 * DP couldn't exist on the shared port. Otherwise
			 * they share the same aux channel and system
			 * couldn't communicate with them seperately. */
			if (aux_channel == DP_AUX_A)
				dev_priv->vbt.ddi_port_info[PORT_A].supports_dp = 0;
			else if (aux_channel == DP_AUX_B)
				dev_priv->vbt.ddi_port_info[PORT_B].supports_dp = 0;
			else if (aux_channel == DP_AUX_C)
				dev_priv->vbt.ddi_port_info[PORT_C].supports_dp = 0;
			else if (aux_channel == DP_AUX_D)
				dev_priv->vbt.ddi_port_info[PORT_D].supports_dp = 0;
		}
		else if (aux_channel == DP_AUX_A && port != PORT_A)
1028
			DRM_DEBUG_KMS("Unexpected AUX channel for port A\n");
1029
		else if (aux_channel == DP_AUX_B && port != PORT_B)
1030
			DRM_DEBUG_KMS("Unexpected AUX channel for port B\n");
1031
		else if (aux_channel == DP_AUX_C && port != PORT_C)
1032
			DRM_DEBUG_KMS("Unexpected AUX channel for port C\n");
1033
		else if (aux_channel == DP_AUX_D && port != PORT_D)
1034 1035 1036
			DRM_DEBUG_KMS("Unexpected AUX channel for port D\n");
	}

1037 1038 1039
	if (bdb->version >= 158) {
		/* The VBT HDMI level shift values match the table we have. */
		hdmi_level_shift = child->raw[7] & 0xF;
1040 1041 1042 1043
		DRM_DEBUG_KMS("VBT HDMI level shift for port %c: %d\n",
			      port_name(port),
			      hdmi_level_shift);
		info->hdmi_level_shift = hdmi_level_shift;
1044
	}
1045 1046 1047 1048 1049 1050 1051 1052 1053 1054

	/* Parse the I_boost config for SKL and above */
	if (bdb->version >= 196 && (child->common.flags_1 & IBOOST_ENABLE)) {
		info->dp_boost_level = translate_iboost(child->common.iboost_level & 0xF);
		DRM_DEBUG_KMS("VBT (e)DP boost level for port %c: %d\n",
			      port_name(port), info->dp_boost_level);
		info->hdmi_boost_level = translate_iboost(child->common.iboost_level >> 4);
		DRM_DEBUG_KMS("VBT HDMI boost level for port %c: %d\n",
			      port_name(port), info->hdmi_boost_level);
	}
1055 1056 1057
}

static void parse_ddi_ports(struct drm_i915_private *dev_priv,
1058
			    const struct bdb_header *bdb)
1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075
{
	struct drm_device *dev = dev_priv->dev;
	enum port port;

	if (!HAS_DDI(dev))
		return;

	if (!dev_priv->vbt.child_dev_num)
		return;

	if (bdb->version < 155)
		return;

	for (port = PORT_A; port < I915_MAX_PORTS; port++)
		parse_ddi_port(dev_priv, port, bdb);
}

Z
Zhao Yakui 已提交
1076 1077
static void
parse_device_mapping(struct drm_i915_private *dev_priv,
1078
		     const struct bdb_header *bdb)
Z
Zhao Yakui 已提交
1079
{
1080 1081 1082
	const struct bdb_general_definitions *p_defs;
	const union child_device_config *p_child;
	union child_device_config *child_dev_ptr;
Z
Zhao Yakui 已提交
1083
	int i, child_device_num, count;
1084 1085
	u8 expected_size;
	u16 block_size;
Z
Zhao Yakui 已提交
1086 1087 1088

	p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
	if (!p_defs) {
1089
		DRM_DEBUG_KMS("No general definition block is found, no devices defined.\n");
Z
Zhao Yakui 已提交
1090 1091
		return;
	}
1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108
	if (bdb->version < 195) {
		expected_size = sizeof(struct old_child_dev_config);
	} else if (bdb->version == 195) {
		expected_size = 37;
	} else if (bdb->version <= 197) {
		expected_size = 38;
	} else {
		expected_size = 38;
		BUILD_BUG_ON(sizeof(*p_child) < 38);
		DRM_DEBUG_DRIVER("Expected child device config size for VBT version %u not known; assuming %u\n",
				 bdb->version, expected_size);
	}

	/* The legacy sized child device config is the minimum we need. */
	if (p_defs->child_dev_size < sizeof(struct old_child_dev_config)) {
		DRM_ERROR("Child device config size %u is too small.\n",
			  p_defs->child_dev_size);
Z
Zhao Yakui 已提交
1109 1110
		return;
	}
1111 1112 1113 1114 1115 1116

	/* Flag an error for unexpected size, but continue anyway. */
	if (p_defs->child_dev_size != expected_size)
		DRM_ERROR("Unexpected child device config size %u (expected %u for VBT version %u)\n",
			  p_defs->child_dev_size, expected_size, bdb->version);

Z
Zhao Yakui 已提交
1117 1118 1119 1120
	/* get the block size of general definitions */
	block_size = get_blocksize(p_defs);
	/* get the number of child device */
	child_device_num = (block_size - sizeof(*p_defs)) /
1121
				p_defs->child_dev_size;
Z
Zhao Yakui 已提交
1122 1123 1124
	count = 0;
	/* get the number of child device that is present */
	for (i = 0; i < child_device_num; i++) {
1125
		p_child = child_device_ptr(p_defs, i);
1126
		if (!p_child->common.device_type) {
Z
Zhao Yakui 已提交
1127 1128 1129 1130 1131 1132
			/* skip the device block if device type is invalid */
			continue;
		}
		count++;
	}
	if (!count) {
1133
		DRM_DEBUG_KMS("no child dev is parsed from VBT\n");
Z
Zhao Yakui 已提交
1134 1135
		return;
	}
1136 1137
	dev_priv->vbt.child_dev = kcalloc(count, sizeof(*p_child), GFP_KERNEL);
	if (!dev_priv->vbt.child_dev) {
Z
Zhao Yakui 已提交
1138 1139 1140 1141
		DRM_DEBUG_KMS("No memory space for child device\n");
		return;
	}

1142
	dev_priv->vbt.child_dev_num = count;
Z
Zhao Yakui 已提交
1143 1144
	count = 0;
	for (i = 0; i < child_device_num; i++) {
1145
		p_child = child_device_ptr(p_defs, i);
1146
		if (!p_child->common.device_type) {
Z
Zhao Yakui 已提交
1147 1148 1149
			/* skip the device block if device type is invalid */
			continue;
		}
1150 1151 1152 1153 1154 1155 1156 1157 1158

		if (p_child->common.dvo_port >= DVO_PORT_MIPIA
		    && p_child->common.dvo_port <= DVO_PORT_MIPID
		    &&p_child->common.device_type & DEVICE_TYPE_MIPI_OUTPUT) {
			DRM_DEBUG_KMS("Found MIPI as LFP\n");
			dev_priv->vbt.has_mipi = 1;
			dev_priv->vbt.dsi.port = p_child->common.dvo_port;
		}

1159
		child_dev_ptr = dev_priv->vbt.child_dev + count;
Z
Zhao Yakui 已提交
1160
		count++;
1161 1162 1163 1164 1165 1166 1167 1168

		/*
		 * Copy as much as we know (sizeof) and is available
		 * (child_dev_size) of the child device. Accessing the data must
		 * depend on VBT version.
		 */
		memcpy(child_dev_ptr, p_child,
		       min_t(size_t, p_defs->child_dev_size, sizeof(*p_child)));
Z
Zhao Yakui 已提交
1169 1170 1171
	}
	return;
}
1172

1173 1174 1175
static void
init_vbt_defaults(struct drm_i915_private *dev_priv)
{
1176
	struct drm_device *dev = dev_priv->dev;
1177
	enum port port;
1178

1179
	dev_priv->vbt.crt_ddc_pin = GMBUS_PIN_VGADDC;
1180

1181 1182 1183
	/* Default to having backlight */
	dev_priv->vbt.backlight.present = true;

1184
	/* LFP panel data */
1185 1186
	dev_priv->vbt.lvds_dither = 1;
	dev_priv->vbt.lvds_vbt = 0;
1187 1188

	/* SDVO panel data */
1189
	dev_priv->vbt.sdvo_lvds_vbt_mode = NULL;
1190 1191

	/* general features */
1192 1193
	dev_priv->vbt.int_tv_support = 1;
	dev_priv->vbt.int_crt_support = 1;
1194 1195

	/* Default to using SSC */
1196
	dev_priv->vbt.lvds_use_ssc = 1;
1197 1198 1199 1200 1201 1202
	/*
	 * Core/SandyBridge/IvyBridge use alternative (120MHz) reference
	 * clock for LVDS.
	 */
	dev_priv->vbt.lvds_ssc_freq = intel_bios_ssc_frequency(dev,
			!HAS_PCH_SPLIT(dev));
1203
	DRM_DEBUG_KMS("Set default to SSC at %d kHz\n", dev_priv->vbt.lvds_ssc_freq);
1204 1205

	for (port = PORT_A; port < I915_MAX_PORTS; port++) {
1206 1207 1208
		struct ddi_vbt_port_info *info =
			&dev_priv->vbt.ddi_port_info[port];

1209
		info->hdmi_level_shift = HDMI_LEVEL_SHIFT_UNKNOWN;
1210 1211 1212 1213

		info->supports_dvi = (port != PORT_A && port != PORT_E);
		info->supports_hdmi = info->supports_dvi;
		info->supports_dp = (port != PORT_E);
1214
	}
1215 1216
}

1217 1218 1219 1220 1221 1222 1223
static const struct bdb_header *get_bdb_header(const struct vbt_header *vbt)
{
	const void *_vbt = vbt;

	return _vbt + vbt->bdb_offset;
}

J
Jani Nikula 已提交
1224 1225 1226 1227 1228 1229 1230 1231
/**
 * intel_bios_is_valid_vbt - does the given buffer contain a valid VBT
 * @buf:	pointer to a buffer to validate
 * @size:	size of the buffer
 *
 * Returns true on valid VBT.
 */
bool intel_bios_is_valid_vbt(const void *buf, size_t size)
1232
{
J
Jani Nikula 已提交
1233
	const struct vbt_header *vbt = buf;
1234
	const struct bdb_header *bdb;
1235

1236
	if (!vbt)
J
Jani Nikula 已提交
1237
		return false;
1238

J
Jani Nikula 已提交
1239
	if (sizeof(struct vbt_header) > size) {
1240
		DRM_DEBUG_DRIVER("VBT header incomplete\n");
J
Jani Nikula 已提交
1241
		return false;
1242 1243 1244 1245
	}

	if (memcmp(vbt->signature, "$VBT", 4)) {
		DRM_DEBUG_DRIVER("VBT invalid signature\n");
J
Jani Nikula 已提交
1246
		return false;
1247 1248
	}

J
Jani Nikula 已提交
1249
	if (vbt->bdb_offset + sizeof(struct bdb_header) > size) {
1250
		DRM_DEBUG_DRIVER("BDB header incomplete\n");
J
Jani Nikula 已提交
1251
		return false;
1252 1253
	}

1254
	bdb = get_bdb_header(vbt);
J
Jani Nikula 已提交
1255
	if (vbt->bdb_offset + bdb->bdb_size > size) {
1256
		DRM_DEBUG_DRIVER("BDB incomplete\n");
J
Jani Nikula 已提交
1257
		return false;
1258 1259
	}

1260
	return vbt;
1261 1262
}

1263
static const struct vbt_header *find_vbt(void __iomem *bios, size_t size)
1264 1265 1266 1267 1268
{
	size_t i;

	/* Scour memory looking for the VBT signature. */
	for (i = 0; i + 4 < size; i++) {
J
Jani Nikula 已提交
1269
		void *vbt;
1270

J
Jani Nikula 已提交
1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282
		if (ioread32(bios + i) != *((const u32 *) "$VBT"))
			continue;

		/*
		 * This is the one place where we explicitly discard the address
		 * space (__iomem) of the BIOS/VBT.
		 */
		vbt = (void __force *) bios + i;
		if (intel_bios_is_valid_vbt(vbt, size - i))
			return vbt;

		break;
1283 1284
	}

J
Jani Nikula 已提交
1285
	return NULL;
1286 1287
}

J
Jesse Barnes 已提交
1288
/**
1289
 * intel_bios_init - find VBT and initialize settings from the BIOS
J
Jesse Barnes 已提交
1290 1291 1292 1293 1294 1295 1296
 * @dev: DRM device
 *
 * Loads the Video BIOS and checks that the VBT exists.  Sets scratch registers
 * to appropriate values.
 *
 * Returns 0 on success, nonzero on failure.
 */
1297
int
1298
intel_bios_init(struct drm_device *dev)
J
Jesse Barnes 已提交
1299 1300 1301
{
	struct drm_i915_private *dev_priv = dev->dev_private;
	struct pci_dev *pdev = dev->pdev;
J
Jani Nikula 已提交
1302
	const struct vbt_header *vbt = dev_priv->opregion.vbt;
1303
	const struct bdb_header *bdb;
1304 1305
	u8 __iomem *bios = NULL;

1306 1307 1308
	if (HAS_PCH_NOP(dev))
		return -ENODEV;

1309
	init_vbt_defaults(dev_priv);
1310

J
Jani Nikula 已提交
1311
	if (!vbt) {
1312
		size_t size;
J
Jesse Barnes 已提交
1313

1314 1315 1316 1317
		bios = pci_map_rom(pdev, &size);
		if (!bios)
			return -1;

1318 1319
		vbt = find_vbt(bios, size);
		if (!vbt) {
1320 1321 1322
			pci_unmap_rom(pdev, bios);
			return -1;
		}
1323 1324

		DRM_DEBUG_KMS("Found valid VBT in PCI ROM\n");
1325
	}
J
Jesse Barnes 已提交
1326

1327 1328
	bdb = get_bdb_header(vbt);

1329 1330 1331
	DRM_DEBUG_KMS("VBT signature \"%20s\", BDB version %d\n",
		      vbt->signature, bdb->version);

J
Jesse Barnes 已提交
1332 1333
	/* Grab useful general definitions */
	parse_general_features(dev_priv, bdb);
1334
	parse_general_definitions(dev_priv, bdb);
1335
	parse_lfp_panel_data(dev_priv, bdb);
1336
	parse_lfp_backlight(dev_priv, bdb);
1337
	parse_sdvo_panel_data(dev_priv, bdb);
1338
	parse_sdvo_device_mapping(dev_priv, bdb);
Z
Zhao Yakui 已提交
1339
	parse_device_mapping(dev_priv, bdb);
1340
	parse_driver_features(dev_priv, bdb);
1341
	parse_edp(dev_priv, bdb);
R
Rodrigo Vivi 已提交
1342
	parse_psr(dev_priv, bdb);
1343
	parse_mipi(dev_priv, bdb);
1344
	parse_ddi_ports(dev_priv, bdb);
1345

1346 1347
	if (bios)
		pci_unmap_rom(pdev, bios);
J
Jesse Barnes 已提交
1348 1349 1350

	return 0;
}