intel_bios.c 37.8 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
static int intel_bios_ssc_frequency(struct drm_i915_private *dev_priv,
336 337
				    bool alternate)
{
338
	switch (INTEL_INFO(dev_priv)->gen) {
339
	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
	const struct bdb_general_features *general;
J
Jesse Barnes 已提交
354 355 356

	general = find_section(bdb, BDB_GENERAL_FEATURES);
	if (general) {
357
		dev_priv->vbt.int_tv_support = general->int_tv_support;
358 359 360 361
		/* 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;
362 363
		dev_priv->vbt.lvds_use_ssc = general->enable_ssc;
		dev_priv->vbt.lvds_ssc_freq =
364
			intel_bios_ssc_frequency(dev_priv, general->ssc_freq);
365 366
		dev_priv->vbt.display_clock_mode = general->display_clock_mode;
		dev_priv->vbt.fdi_rx_polarity_inverted = general->fdi_rx_polarity_inverted;
367
		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",
368 369 370 371 372 373
			      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 已提交
374 375 376
	}
}

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

	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;
388
			DRM_DEBUG_KMS("crt_ddc_bus_pin: %d\n", bus_pin);
389
			if (intel_gmbus_is_valid_pin(dev_priv, bus_pin))
390
				dev_priv->vbt.crt_ddc_pin = bus_pin;
391
		} else {
392
			DRM_DEBUG_KMS("BDB_GD too small (%d). Invalid.\n",
393
				      block_size);
394 395 396 397
		}
	}
}

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

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

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

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

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

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

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

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

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

	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;
519 520
}

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

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

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

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

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

553 554 555 556 557 558 559 560 561 562 563 564 565
	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;
	}

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

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

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

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

623 624 625 626 627 628 629
		/* 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;
		}
630
	}
631 632
}

R
Rodrigo Vivi 已提交
633
static void
634
parse_psr(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
R
Rodrigo Vivi 已提交
635
{
636 637
	const struct bdb_psr *psr;
	const struct psr_table *psr_table;
R
Rodrigo Vivi 已提交
638 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

	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;
}

677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693
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
			 */
694 695
			tmp -= 5;
			if (tmp < 0)
696 697 698 699 700
				return NULL;

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

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

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

			data += 5;
			break;
		case MIPI_SEQ_ELEM_GPIO:
717 718
			tmp -= 3;
			if (tmp < 0)
719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743
				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;
}

744
static void
745
parse_mipi(struct drm_i915_private *dev_priv, const struct bdb_header *bdb)
746
{
747 748 749 750 751 752
	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;
753 754 755
	int i, panel_id, seq_size;
	u16 block_size;

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

760 761 762 763 764 765 766
	/* 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
	 */
767

768 769 770 771 772 773
	/* 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");
774 775 776
		return;
	}

777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798
	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 */
799
	dev_priv->vbt.dsi.panel_id = MIPI_DSI_GENERIC_PANEL_ID;
800 801 802 803 804 805 806 807

	/* 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;
	}

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

814 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
	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 */
898
	memset(dev_priv->vbt.dsi.sequence, 0, sizeof(dev_priv->vbt.dsi.sequence));
899 900
}

901 902 903 904 905 906 907 908 909 910 911
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];
}

912
static void parse_ddi_port(struct drm_i915_private *dev_priv, enum port port,
913
			   const struct bdb_header *bdb)
914 915 916 917 918
{
	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;
919
	bool is_dvi, is_hdmi, is_dp, is_edp, is_crt;
X
Xiong Zhang 已提交
920
	uint8_t aux_channel, ddc_pin;
921 922 923
	/* 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 已提交
924 925 926 927 928 929
	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},
930 931 932 933 934 935
	};

	/* 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 已提交
936
		for (j = 0; j < 3; j++) {
937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952
			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;

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

956 957 958 959 960
	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);
961

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

966 967 968 969 970 971 972 973 974 975 976 977
	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 已提交
978
		DRM_DEBUG_KMS("Port %c is TMDS compatible\n", port_name(port));
979 980 981 982 983
	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));
984 985

	if (is_dvi) {
X
Xiong Zhang 已提交
986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002
		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)
1003
			DRM_DEBUG_KMS("Unexpected DDC pin for port B\n");
X
Xiong Zhang 已提交
1004
		else if (ddc_pin == DDC_PIN_C && port != PORT_C)
1005
			DRM_DEBUG_KMS("Unexpected DDC pin for port C\n");
X
Xiong Zhang 已提交
1006
		else if (ddc_pin == DDC_PIN_D && port != PORT_D)
1007 1008 1009 1010
			DRM_DEBUG_KMS("Unexpected DDC pin for port D\n");
	}

	if (is_dp) {
1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026
		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)
1027
			DRM_DEBUG_KMS("Unexpected AUX channel for port A\n");
1028
		else if (aux_channel == DP_AUX_B && port != PORT_B)
1029
			DRM_DEBUG_KMS("Unexpected AUX channel for port B\n");
1030
		else if (aux_channel == DP_AUX_C && port != PORT_C)
1031
			DRM_DEBUG_KMS("Unexpected AUX channel for port C\n");
1032
		else if (aux_channel == DP_AUX_D && port != PORT_D)
1033 1034 1035
			DRM_DEBUG_KMS("Unexpected AUX channel for port D\n");
	}

1036 1037 1038
	if (bdb->version >= 158) {
		/* The VBT HDMI level shift values match the table we have. */
		hdmi_level_shift = child->raw[7] & 0xF;
1039 1040 1041 1042
		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;
1043
	}
1044 1045 1046 1047 1048 1049 1050 1051 1052 1053

	/* 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);
	}
1054 1055 1056
}

static void parse_ddi_ports(struct drm_i915_private *dev_priv,
1057
			    const struct bdb_header *bdb)
1058 1059 1060
{
	enum port port;

1061
	if (!HAS_DDI(dev_priv))
1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073
		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 已提交
1074 1075
static void
parse_device_mapping(struct drm_i915_private *dev_priv,
1076
		     const struct bdb_header *bdb)
Z
Zhao Yakui 已提交
1077
{
1078 1079 1080
	const struct bdb_general_definitions *p_defs;
	const union child_device_config *p_child;
	union child_device_config *child_dev_ptr;
Z
Zhao Yakui 已提交
1081
	int i, child_device_num, count;
1082 1083
	u8 expected_size;
	u16 block_size;
Z
Zhao Yakui 已提交
1084 1085 1086

	p_defs = find_section(bdb, BDB_GENERAL_DEFINITIONS);
	if (!p_defs) {
1087
		DRM_DEBUG_KMS("No general definition block is found, no devices defined.\n");
Z
Zhao Yakui 已提交
1088 1089
		return;
	}
1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
	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 已提交
1107 1108
		return;
	}
1109 1110 1111 1112 1113 1114

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

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

		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;
		}

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

		/*
		 * 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 已提交
1167 1168 1169
	}
	return;
}
1170

1171 1172 1173
static void
init_vbt_defaults(struct drm_i915_private *dev_priv)
{
1174
	enum port port;
1175

1176
	dev_priv->vbt.crt_ddc_pin = GMBUS_PIN_VGADDC;
1177

1178 1179 1180
	/* Default to having backlight */
	dev_priv->vbt.backlight.present = true;

1181
	/* LFP panel data */
1182 1183
	dev_priv->vbt.lvds_dither = 1;
	dev_priv->vbt.lvds_vbt = 0;
1184 1185

	/* SDVO panel data */
1186
	dev_priv->vbt.sdvo_lvds_vbt_mode = NULL;
1187 1188

	/* general features */
1189 1190
	dev_priv->vbt.int_tv_support = 1;
	dev_priv->vbt.int_crt_support = 1;
1191 1192

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

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

1206
		info->hdmi_level_shift = HDMI_LEVEL_SHIFT_UNKNOWN;
1207 1208 1209 1210

		info->supports_dvi = (port != PORT_A && port != PORT_E);
		info->supports_hdmi = info->supports_dvi;
		info->supports_dp = (port != PORT_E);
1211
	}
1212 1213
}

1214 1215 1216 1217 1218 1219 1220
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 已提交
1221 1222 1223 1224 1225 1226 1227 1228
/**
 * 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)
1229
{
J
Jani Nikula 已提交
1230
	const struct vbt_header *vbt = buf;
1231
	const struct bdb_header *bdb;
1232

1233
	if (!vbt)
J
Jani Nikula 已提交
1234
		return false;
1235

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

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

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

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

1257
	return vbt;
1258 1259
}

1260
static const struct vbt_header *find_vbt(void __iomem *bios, size_t size)
1261 1262 1263 1264 1265
{
	size_t i;

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

J
Jani Nikula 已提交
1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279
		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;
1280 1281
	}

J
Jani Nikula 已提交
1282
	return NULL;
1283 1284
}

J
Jesse Barnes 已提交
1285
/**
1286
 * intel_bios_init - find VBT and initialize settings from the BIOS
J
Jesse Barnes 已提交
1287 1288 1289 1290 1291 1292 1293
 * @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.
 */
1294
int
1295
intel_bios_init(struct drm_i915_private *dev_priv)
J
Jesse Barnes 已提交
1296
{
1297
	struct pci_dev *pdev = dev_priv->dev->pdev;
J
Jani Nikula 已提交
1298
	const struct vbt_header *vbt = dev_priv->opregion.vbt;
1299
	const struct bdb_header *bdb;
1300 1301
	u8 __iomem *bios = NULL;

1302
	if (HAS_PCH_NOP(dev_priv))
1303 1304
		return -ENODEV;

1305
	init_vbt_defaults(dev_priv);
1306

J
Jani Nikula 已提交
1307
	if (!vbt) {
1308
		size_t size;
J
Jesse Barnes 已提交
1309

1310 1311 1312 1313
		bios = pci_map_rom(pdev, &size);
		if (!bios)
			return -1;

1314 1315
		vbt = find_vbt(bios, size);
		if (!vbt) {
1316 1317 1318
			pci_unmap_rom(pdev, bios);
			return -1;
		}
1319 1320

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

1323 1324
	bdb = get_bdb_header(vbt);

1325 1326
	DRM_DEBUG_KMS("VBT signature \"%.*s\", BDB version %d\n",
		      (int)sizeof(vbt->signature), vbt->signature, bdb->version);
1327

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

1342 1343
	if (bios)
		pci_unmap_rom(pdev, bios);
J
Jesse Barnes 已提交
1344 1345 1346

	return 0;
}