xref: /freebsd/sys/dev/drm2/drm_edid.c (revision b740c88bfb6453416926271c089262e7164dace3)
1 /*
2  * Copyright (c) 2006 Luc Verhaegen (quirks list)
3  * Copyright (c) 2007-2008 Intel Corporation
4  *   Jesse Barnes <jesse.barnes@intel.com>
5  * Copyright 2010 Red Hat, Inc.
6  *
7  * DDC probing routines (drm_ddc_read & drm_do_probe_ddc_edid) originally from
8  * FB layer.
9  *   Copyright (C) 2006 Dennis Munsie <dmunsie@cecropia.com>
10  *
11  * Permission is hereby granted, free of charge, to any person obtaining a
12  * copy of this software and associated documentation files (the "Software"),
13  * to deal in the Software without restriction, including without limitation
14  * the rights to use, copy, modify, merge, publish, distribute, sub license,
15  * and/or sell copies of the Software, and to permit persons to whom the
16  * Software is furnished to do so, subject to the following conditions:
17  *
18  * The above copyright notice and this permission notice (including the
19  * next paragraph) shall be included in all copies or substantial portions
20  * of the Software.
21  *
22  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
23  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
24  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
25  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
26  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
27  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
28  * DEALINGS IN THE SOFTWARE.
29  */
30 
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD$");
33 
34 #include <dev/drm2/drmP.h>
35 #include <dev/drm2/drm_edid.h>
36 #include "drm_edid_modes.h"
37 #include <dev/iicbus/iic.h>
38 #include <dev/iicbus/iiconf.h>
39 #include "iicbus_if.h"
40 
41 #define version_greater(edid, maj, min) \
42 	(((edid)->version > (maj)) || \
43 	 ((edid)->version == (maj) && (edid)->revision > (min)))
44 
45 #define EDID_EST_TIMINGS 16
46 #define EDID_STD_TIMINGS 8
47 #define EDID_DETAILED_TIMINGS 4
48 
49 /*
50  * EDID blocks out in the wild have a variety of bugs, try to collect
51  * them here (note that userspace may work around broken monitors first,
52  * but fixes should make their way here so that the kernel "just works"
53  * on as many displays as possible).
54  */
55 
56 /* First detailed mode wrong, use largest 60Hz mode */
57 #define EDID_QUIRK_PREFER_LARGE_60		(1 << 0)
58 /* Reported 135MHz pixel clock is too high, needs adjustment */
59 #define EDID_QUIRK_135_CLOCK_TOO_HIGH		(1 << 1)
60 /* Prefer the largest mode at 75 Hz */
61 #define EDID_QUIRK_PREFER_LARGE_75		(1 << 2)
62 /* Detail timing is in cm not mm */
63 #define EDID_QUIRK_DETAILED_IN_CM		(1 << 3)
64 /* Detailed timing descriptors have bogus size values, so just take the
65  * maximum size and use that.
66  */
67 #define EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE	(1 << 4)
68 /* Monitor forgot to set the first detailed is preferred bit. */
69 #define EDID_QUIRK_FIRST_DETAILED_PREFERRED	(1 << 5)
70 /* use +hsync +vsync for detailed mode */
71 #define EDID_QUIRK_DETAILED_SYNC_PP		(1 << 6)
72 /* Force reduced-blanking timings for detailed modes */
73 #define EDID_QUIRK_FORCE_REDUCED_BLANKING	(1 << 7)
74 
75 struct detailed_mode_closure {
76 	struct drm_connector *connector;
77 	struct edid *edid;
78 	bool preferred;
79 	u32 quirks;
80 	int modes;
81 };
82 
83 #define LEVEL_DMT	0
84 #define LEVEL_GTF	1
85 #define LEVEL_GTF2	2
86 #define LEVEL_CVT	3
87 
88 static struct edid_quirk {
89 	char vendor[4];
90 	int product_id;
91 	u32 quirks;
92 } edid_quirk_list[] = {
93 	/* Acer AL1706 */
94 	{ "ACR", 44358, EDID_QUIRK_PREFER_LARGE_60 },
95 	/* Acer F51 */
96 	{ "API", 0x7602, EDID_QUIRK_PREFER_LARGE_60 },
97 	/* Unknown Acer */
98 	{ "ACR", 2423, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
99 
100 	/* Belinea 10 15 55 */
101 	{ "MAX", 1516, EDID_QUIRK_PREFER_LARGE_60 },
102 	{ "MAX", 0x77e, EDID_QUIRK_PREFER_LARGE_60 },
103 
104 	/* Envision Peripherals, Inc. EN-7100e */
105 	{ "EPI", 59264, EDID_QUIRK_135_CLOCK_TOO_HIGH },
106 	/* Envision EN2028 */
107 	{ "EPI", 8232, EDID_QUIRK_PREFER_LARGE_60 },
108 
109 	/* Funai Electronics PM36B */
110 	{ "FCM", 13600, EDID_QUIRK_PREFER_LARGE_75 |
111 	  EDID_QUIRK_DETAILED_IN_CM },
112 
113 	/* LG Philips LCD LP154W01-A5 */
114 	{ "LPL", 0, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
115 	{ "LPL", 0x2a00, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
116 
117 	/* Philips 107p5 CRT */
118 	{ "PHL", 57364, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
119 
120 	/* Proview AY765C */
121 	{ "PTS", 765, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
122 
123 	/* Samsung SyncMaster 205BW.  Note: irony */
124 	{ "SAM", 541, EDID_QUIRK_DETAILED_SYNC_PP },
125 	/* Samsung SyncMaster 22[5-6]BW */
126 	{ "SAM", 596, EDID_QUIRK_PREFER_LARGE_60 },
127 	{ "SAM", 638, EDID_QUIRK_PREFER_LARGE_60 },
128 
129 	/* ViewSonic VA2026w */
130 	{ "VSC", 5020, EDID_QUIRK_FORCE_REDUCED_BLANKING },
131 };
132 
133 /*** DDC fetch and block validation ***/
134 
135 static const u8 edid_header[] = {
136 	0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00
137 };
138 
139  /*
140  * Sanity check the header of the base EDID block.  Return 8 if the header
141  * is perfect, down to 0 if it's totally wrong.
142  */
143 int drm_edid_header_is_valid(const u8 *raw_edid)
144 {
145 	int i, score = 0;
146 
147 	for (i = 0; i < sizeof(edid_header); i++)
148 		if (raw_edid[i] == edid_header[i])
149 			score++;
150 
151 	return score;
152 }
153 EXPORT_SYMBOL(drm_edid_header_is_valid);
154 
155 static int edid_fixup __read_mostly = 6;
156 module_param_named(edid_fixup, edid_fixup, int, 0400);
157 MODULE_PARM_DESC(edid_fixup,
158 		 "Minimum number of valid EDID header bytes (0-8, default 6)");
159 
160 /*
161  * Sanity check the EDID block (base or extension).  Return 0 if the block
162  * doesn't check out, or 1 if it's valid.
163  */
164 bool drm_edid_block_valid(u8 *raw_edid, int block, bool print_bad_edid)
165 {
166 	int i;
167 	u8 csum = 0;
168 	struct edid *edid = (struct edid *)raw_edid;
169 
170 	if (edid_fixup > 8 || edid_fixup < 0)
171 		edid_fixup = 6;
172 
173 	if (block == 0) {
174 		int score = drm_edid_header_is_valid(raw_edid);
175 		if (score == 8) ;
176 		else if (score >= edid_fixup) {
177 			DRM_DEBUG("Fixing EDID header, your hardware may be failing\n");
178 			memcpy(raw_edid, edid_header, sizeof(edid_header));
179 		} else {
180 			goto bad;
181 		}
182 	}
183 
184 	for (i = 0; i < EDID_LENGTH; i++)
185 		csum += raw_edid[i];
186 	if (csum) {
187 		if (print_bad_edid) {
188 			DRM_ERROR("EDID checksum is invalid, remainder is %d\n", csum);
189 		}
190 
191 		/* allow CEA to slide through, switches mangle this */
192 		if (raw_edid[0] != 0x02)
193 			goto bad;
194 	}
195 
196 	/* per-block-type checks */
197 	switch (raw_edid[0]) {
198 	case 0: /* base */
199 		if (edid->version != 1) {
200 			DRM_ERROR("EDID has major version %d, instead of 1\n", edid->version);
201 			goto bad;
202 		}
203 
204 		if (edid->revision > 4)
205 			DRM_DEBUG("EDID minor > 4, assuming backward compatibility\n");
206 		break;
207 
208 	default:
209 		break;
210 	}
211 
212 	return 1;
213 
214 bad:
215 	if (raw_edid && print_bad_edid) {
216 		DRM_DEBUG_KMS("Raw EDID:\n");
217 		for (i = 0; i < EDID_LENGTH; ) {
218 			printf("%02x", raw_edid[i]);
219 			i++;
220 			if (i % 16 == 0 || i == EDID_LENGTH)
221 				printf("\n");
222 			else if (i % 8 == 0)
223 				printf("  ");
224 			else
225 				printf(" ");
226 		}
227 	}
228 	return 0;
229 }
230 EXPORT_SYMBOL(drm_edid_block_valid);
231 
232 /**
233  * drm_edid_is_valid - sanity check EDID data
234  * @edid: EDID data
235  *
236  * Sanity-check an entire EDID record (including extensions)
237  */
238 bool drm_edid_is_valid(struct edid *edid)
239 {
240 	int i;
241 	u8 *raw = (u8 *)edid;
242 
243 	if (!edid)
244 		return false;
245 
246 	for (i = 0; i <= edid->extensions; i++)
247 		if (!drm_edid_block_valid(raw + i * EDID_LENGTH, i, true))
248 			return false;
249 
250 	return true;
251 }
252 EXPORT_SYMBOL(drm_edid_is_valid);
253 
254 #define DDC_SEGMENT_ADDR 0x30
255 /**
256  * Get EDID information via I2C.
257  *
258  * \param adapter : i2c device adaptor
259  * \param buf     : EDID data buffer to be filled
260  * \param len     : EDID data buffer length
261  * \return 0 on success or -1 on failure.
262  *
263  * Try to fetch EDID information by calling i2c driver function.
264  */
265 static int
266 drm_do_probe_ddc_edid(device_t adapter, unsigned char *buf,
267 		      int block, int len)
268 {
269 	unsigned char start = block * EDID_LENGTH;
270 	unsigned char segment = block >> 1;
271 	unsigned char xfers = segment ? 3 : 2;
272 	int ret, retries = 5;
273 
274 	/* The core i2c driver will automatically retry the transfer if the
275 	 * adapter reports EAGAIN. However, we find that bit-banging transfers
276 	 * are susceptible to errors under a heavily loaded machine and
277 	 * generate spurious NAKs and timeouts. Retrying the transfer
278 	 * of the individual block a few times seems to overcome this.
279 	 */
280 	do {
281 		struct iic_msg msgs[] = {
282 			{
283 				.slave	= DDC_SEGMENT_ADDR << 1,
284 				.flags	= 0,
285 				.len	= 1,
286 				.buf	= &segment,
287 			}, {
288 				.slave	= DDC_ADDR << 1,
289 				.flags	= 0,
290 				.len	= 1,
291 				.buf	= &start,
292 			}, {
293 				.slave	= DDC_ADDR << 1,
294 				.flags	= IIC_M_RD,
295 				.len	= len,
296 				.buf	= buf,
297 			}
298 		};
299 
300 	/*
301 	 * Avoid sending the segment addr to not upset non-compliant ddc
302 	 * monitors.
303 	 */
304 		ret = iicbus_transfer(adapter, &msgs[3 - xfers], xfers);
305 
306 		if (ret != 0)
307 			DRM_DEBUG_KMS("iicbus_transfer countdown %d error %d\n",
308 			    retries, ret);
309 	} while (ret != 0 && --retries);
310 
311 	return ret == 0 ? 0 : -1;
312 }
313 
314 static bool drm_edid_is_zero(u8 *in_edid, int length)
315 {
316 	int i;
317 	u32 *raw_edid = (u32 *)in_edid;
318 
319 	for (i = 0; i < length / 4; i++)
320 		if (*(raw_edid + i) != 0)
321 			return false;
322 
323 	return true;
324 }
325 
326 static u8 *
327 drm_do_get_edid(struct drm_connector *connector, device_t adapter)
328 {
329 	int i, j = 0, valid_extensions = 0;
330 	u8 *block, *new;
331 	bool print_bad_edid = !connector->bad_edid_counter || (drm_debug & DRM_DEBUGBITS_KMS);
332 
333 	if ((block = malloc(EDID_LENGTH, DRM_MEM_KMS, M_NOWAIT)) == NULL)
334 		return NULL;
335 
336 	/* base block fetch */
337 	for (i = 0; i < 4; i++) {
338 		if (drm_do_probe_ddc_edid(adapter, block, 0, EDID_LENGTH))
339 			goto out;
340 		if (drm_edid_block_valid(block, 0, print_bad_edid))
341 			break;
342 		if (i == 0 && drm_edid_is_zero(block, EDID_LENGTH)) {
343 			connector->null_edid_counter++;
344 			goto carp;
345 		}
346 	}
347 	if (i == 4)
348 		goto carp;
349 
350 	/* if there's no extensions, we're done */
351 	if (block[0x7e] == 0)
352 		return block;
353 
354 	new = reallocf(block, (block[0x7e] + 1) * EDID_LENGTH, DRM_MEM_KMS,
355 	    M_NOWAIT);
356 	if (!new)
357 		goto out;
358 	block = new;
359 
360 	for (j = 1; j <= block[0x7e]; j++) {
361 		for (i = 0; i < 4; i++) {
362 			if (drm_do_probe_ddc_edid(adapter,
363 				  block + (valid_extensions + 1) * EDID_LENGTH,
364 				  j, EDID_LENGTH))
365 				goto out;
366 			if (drm_edid_block_valid(block + (valid_extensions + 1) * EDID_LENGTH, j, print_bad_edid)) {
367 				valid_extensions++;
368 				break;
369 			}
370 		}
371 
372 		if (i == 4 && print_bad_edid) {
373 			dev_warn(connector->dev->dev,
374 			 "%s: Ignoring invalid EDID block %d.\n",
375 			 drm_get_connector_name(connector), j);
376 
377 			connector->bad_edid_counter++;
378 		}
379 	}
380 
381 	if (valid_extensions != block[0x7e]) {
382 		block[EDID_LENGTH-1] += block[0x7e] - valid_extensions;
383 		block[0x7e] = valid_extensions;
384 		new = reallocf(block, (valid_extensions + 1) * EDID_LENGTH,
385 		    DRM_MEM_KMS, M_NOWAIT);
386 		if (!new)
387 			goto out;
388 		block = new;
389 	}
390 
391 	return block;
392 
393 carp:
394 	if (print_bad_edid) {
395 		dev_warn(connector->dev->dev, "%s: EDID block %d invalid.\n",
396 			 drm_get_connector_name(connector), j);
397 	}
398 	connector->bad_edid_counter++;
399 
400 out:
401 	free(block, DRM_MEM_KMS);
402 	return NULL;
403 }
404 
405 /**
406  * Probe DDC presence.
407  *
408  * \param adapter : i2c device adaptor
409  * \return 1 on success
410  */
411 bool
412 drm_probe_ddc(device_t adapter)
413 {
414 	unsigned char out;
415 
416 	return (drm_do_probe_ddc_edid(adapter, &out, 0, 1) == 0);
417 }
418 EXPORT_SYMBOL(drm_probe_ddc);
419 
420 /**
421  * drm_get_edid - get EDID data, if available
422  * @connector: connector we're probing
423  * @adapter: i2c adapter to use for DDC
424  *
425  * Poke the given i2c channel to grab EDID data if possible.  If found,
426  * attach it to the connector.
427  *
428  * Return edid data or NULL if we couldn't find any.
429  */
430 struct edid *drm_get_edid(struct drm_connector *connector,
431 			  device_t adapter)
432 {
433 	struct edid *edid = NULL;
434 
435 	if (drm_probe_ddc(adapter))
436 		edid = (struct edid *)drm_do_get_edid(connector, adapter);
437 
438 	return edid;
439 }
440 EXPORT_SYMBOL(drm_get_edid);
441 
442 /*** EDID parsing ***/
443 
444 /**
445  * edid_vendor - match a string against EDID's obfuscated vendor field
446  * @edid: EDID to match
447  * @vendor: vendor string
448  *
449  * Returns true if @vendor is in @edid, false otherwise
450  */
451 static bool edid_vendor(struct edid *edid, char *vendor)
452 {
453 	char edid_vendor[3];
454 
455 	edid_vendor[0] = ((edid->mfg_id[0] & 0x7c) >> 2) + '@';
456 	edid_vendor[1] = (((edid->mfg_id[0] & 0x3) << 3) |
457 			  ((edid->mfg_id[1] & 0xe0) >> 5)) + '@';
458 	edid_vendor[2] = (edid->mfg_id[1] & 0x1f) + '@';
459 
460 	return !strncmp(edid_vendor, vendor, 3);
461 }
462 
463 /**
464  * edid_get_quirks - return quirk flags for a given EDID
465  * @edid: EDID to process
466  *
467  * This tells subsequent routines what fixes they need to apply.
468  */
469 static u32 edid_get_quirks(struct edid *edid)
470 {
471 	struct edid_quirk *quirk;
472 	int i;
473 
474 	for (i = 0; i < ARRAY_SIZE(edid_quirk_list); i++) {
475 		quirk = &edid_quirk_list[i];
476 
477 		if (edid_vendor(edid, quirk->vendor) &&
478 		    (EDID_PRODUCT_ID(edid) == quirk->product_id))
479 			return quirk->quirks;
480 	}
481 
482 	return 0;
483 }
484 
485 #define MODE_SIZE(m) ((m)->hdisplay * (m)->vdisplay)
486 #define MODE_REFRESH_DIFF(m,r) (abs((m)->vrefresh - target_refresh))
487 
488 /**
489  * edid_fixup_preferred - set preferred modes based on quirk list
490  * @connector: has mode list to fix up
491  * @quirks: quirks list
492  *
493  * Walk the mode list for @connector, clearing the preferred status
494  * on existing modes and setting it anew for the right mode ala @quirks.
495  */
496 static void edid_fixup_preferred(struct drm_connector *connector,
497 				 u32 quirks)
498 {
499 	struct drm_display_mode *t, *cur_mode, *preferred_mode;
500 	int target_refresh = 0;
501 
502 	if (list_empty(&connector->probed_modes))
503 		return;
504 
505 	if (quirks & EDID_QUIRK_PREFER_LARGE_60)
506 		target_refresh = 60;
507 	if (quirks & EDID_QUIRK_PREFER_LARGE_75)
508 		target_refresh = 75;
509 
510 	preferred_mode = list_first_entry(&connector->probed_modes,
511 					  struct drm_display_mode, head);
512 
513 	list_for_each_entry_safe(cur_mode, t, &connector->probed_modes, head) {
514 		cur_mode->type &= ~DRM_MODE_TYPE_PREFERRED;
515 
516 		if (cur_mode == preferred_mode)
517 			continue;
518 
519 		/* Largest mode is preferred */
520 		if (MODE_SIZE(cur_mode) > MODE_SIZE(preferred_mode))
521 			preferred_mode = cur_mode;
522 
523 		/* At a given size, try to get closest to target refresh */
524 		if ((MODE_SIZE(cur_mode) == MODE_SIZE(preferred_mode)) &&
525 		    MODE_REFRESH_DIFF(cur_mode, target_refresh) <
526 		    MODE_REFRESH_DIFF(preferred_mode, target_refresh)) {
527 			preferred_mode = cur_mode;
528 		}
529 	}
530 
531 	preferred_mode->type |= DRM_MODE_TYPE_PREFERRED;
532 }
533 
534 static bool
535 mode_is_rb(const struct drm_display_mode *mode)
536 {
537 	return (mode->htotal - mode->hdisplay == 160) &&
538 	       (mode->hsync_end - mode->hdisplay == 80) &&
539 	       (mode->hsync_end - mode->hsync_start == 32) &&
540 	       (mode->vsync_start - mode->vdisplay == 3);
541 }
542 
543 /*
544  * drm_mode_find_dmt - Create a copy of a mode if present in DMT
545  * @dev: Device to duplicate against
546  * @hsize: Mode width
547  * @vsize: Mode height
548  * @fresh: Mode refresh rate
549  * @rb: Mode reduced-blanking-ness
550  *
551  * Walk the DMT mode list looking for a match for the given parameters.
552  * Return a newly allocated copy of the mode, or NULL if not found.
553  */
554 struct drm_display_mode *drm_mode_find_dmt(struct drm_device *dev,
555 					   int hsize, int vsize, int fresh,
556 					   bool rb)
557 {
558 	int i;
559 
560 	for (i = 0; i < drm_num_dmt_modes; i++) {
561 		const struct drm_display_mode *ptr = &drm_dmt_modes[i];
562 		if (hsize != ptr->hdisplay)
563 			continue;
564 		if (vsize != ptr->vdisplay)
565 			continue;
566 		if (fresh != drm_mode_vrefresh(ptr))
567 			continue;
568 		if (rb != mode_is_rb(ptr))
569 			continue;
570 
571 		return drm_mode_duplicate(dev, ptr);
572 	}
573 
574 	return NULL;
575 }
576 EXPORT_SYMBOL(drm_mode_find_dmt);
577 
578 typedef void detailed_cb(struct detailed_timing *timing, void *closure);
579 
580 static void
581 cea_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
582 {
583 	int i, n = 0;
584 	u8 d = ext[0x02];
585 	u8 *det_base = ext + d;
586 
587 	n = (127 - d) / 18;
588 	for (i = 0; i < n; i++)
589 		cb((struct detailed_timing *)(det_base + 18 * i), closure);
590 }
591 
592 static void
593 vtb_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
594 {
595 	unsigned int i, n = min((int)ext[0x02], 6);
596 	u8 *det_base = ext + 5;
597 
598 	if (ext[0x01] != 1)
599 		return; /* unknown version */
600 
601 	for (i = 0; i < n; i++)
602 		cb((struct detailed_timing *)(det_base + 18 * i), closure);
603 }
604 
605 static void
606 drm_for_each_detailed_block(u8 *raw_edid, detailed_cb *cb, void *closure)
607 {
608 	int i;
609 	struct edid *edid = (struct edid *)raw_edid;
610 
611 	if (edid == NULL)
612 		return;
613 
614 	for (i = 0; i < EDID_DETAILED_TIMINGS; i++)
615 		cb(&(edid->detailed_timings[i]), closure);
616 
617 	for (i = 1; i <= raw_edid[0x7e]; i++) {
618 		u8 *ext = raw_edid + (i * EDID_LENGTH);
619 		switch (*ext) {
620 		case CEA_EXT:
621 			cea_for_each_detailed_block(ext, cb, closure);
622 			break;
623 		case VTB_EXT:
624 			vtb_for_each_detailed_block(ext, cb, closure);
625 			break;
626 		default:
627 			break;
628 		}
629 	}
630 }
631 
632 static void
633 is_rb(struct detailed_timing *t, void *data)
634 {
635 	u8 *r = (u8 *)t;
636 	if (r[3] == EDID_DETAIL_MONITOR_RANGE)
637 		if (r[15] & 0x10)
638 			*(bool *)data = true;
639 }
640 
641 /* EDID 1.4 defines this explicitly.  For EDID 1.3, we guess, badly. */
642 static bool
643 drm_monitor_supports_rb(struct edid *edid)
644 {
645 	if (edid->revision >= 4) {
646 		bool ret = false;
647 		drm_for_each_detailed_block((u8 *)edid, is_rb, &ret);
648 		return ret;
649 	}
650 
651 	return ((edid->input & DRM_EDID_INPUT_DIGITAL) != 0);
652 }
653 
654 static void
655 find_gtf2(struct detailed_timing *t, void *data)
656 {
657 	u8 *r = (u8 *)t;
658 	if (r[3] == EDID_DETAIL_MONITOR_RANGE && r[10] == 0x02)
659 		*(u8 **)data = r;
660 }
661 
662 /* Secondary GTF curve kicks in above some break frequency */
663 static int
664 drm_gtf2_hbreak(struct edid *edid)
665 {
666 	u8 *r = NULL;
667 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
668 	return r ? (r[12] * 2) : 0;
669 }
670 
671 static int
672 drm_gtf2_2c(struct edid *edid)
673 {
674 	u8 *r = NULL;
675 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
676 	return r ? r[13] : 0;
677 }
678 
679 static int
680 drm_gtf2_m(struct edid *edid)
681 {
682 	u8 *r = NULL;
683 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
684 	return r ? (r[15] << 8) + r[14] : 0;
685 }
686 
687 static int
688 drm_gtf2_k(struct edid *edid)
689 {
690 	u8 *r = NULL;
691 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
692 	return r ? r[16] : 0;
693 }
694 
695 static int
696 drm_gtf2_2j(struct edid *edid)
697 {
698 	u8 *r = NULL;
699 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
700 	return r ? r[17] : 0;
701 }
702 
703 /**
704  * standard_timing_level - get std. timing level(CVT/GTF/DMT)
705  * @edid: EDID block to scan
706  */
707 static int standard_timing_level(struct edid *edid)
708 {
709 	if (edid->revision >= 2) {
710 		if (edid->revision >= 4 && (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF))
711 			return LEVEL_CVT;
712 		if (drm_gtf2_hbreak(edid))
713 			return LEVEL_GTF2;
714 		return LEVEL_GTF;
715 	}
716 	return LEVEL_DMT;
717 }
718 
719 /*
720  * 0 is reserved.  The spec says 0x01 fill for unused timings.  Some old
721  * monitors fill with ascii space (0x20) instead.
722  */
723 static int
724 bad_std_timing(u8 a, u8 b)
725 {
726 	return (a == 0x00 && b == 0x00) ||
727 	       (a == 0x01 && b == 0x01) ||
728 	       (a == 0x20 && b == 0x20);
729 }
730 
731 /**
732  * drm_mode_std - convert standard mode info (width, height, refresh) into mode
733  * @t: standard timing params
734  * @timing_level: standard timing level
735  *
736  * Take the standard timing params (in this case width, aspect, and refresh)
737  * and convert them into a real mode using CVT/GTF/DMT.
738  */
739 static struct drm_display_mode *
740 drm_mode_std(struct drm_connector *connector, struct edid *edid,
741 	     struct std_timing *t, int revision)
742 {
743 	struct drm_device *dev = connector->dev;
744 	struct drm_display_mode *m, *mode = NULL;
745 	int hsize, vsize;
746 	int vrefresh_rate;
747 	unsigned aspect_ratio = (t->vfreq_aspect & EDID_TIMING_ASPECT_MASK)
748 		>> EDID_TIMING_ASPECT_SHIFT;
749 	unsigned vfreq = (t->vfreq_aspect & EDID_TIMING_VFREQ_MASK)
750 		>> EDID_TIMING_VFREQ_SHIFT;
751 	int timing_level = standard_timing_level(edid);
752 
753 	if (bad_std_timing(t->hsize, t->vfreq_aspect))
754 		return NULL;
755 
756 	/* According to the EDID spec, the hdisplay = hsize * 8 + 248 */
757 	hsize = t->hsize * 8 + 248;
758 	/* vrefresh_rate = vfreq + 60 */
759 	vrefresh_rate = vfreq + 60;
760 	/* the vdisplay is calculated based on the aspect ratio */
761 	if (aspect_ratio == 0) {
762 		if (revision < 3)
763 			vsize = hsize;
764 		else
765 			vsize = (hsize * 10) / 16;
766 	} else if (aspect_ratio == 1)
767 		vsize = (hsize * 3) / 4;
768 	else if (aspect_ratio == 2)
769 		vsize = (hsize * 4) / 5;
770 	else
771 		vsize = (hsize * 9) / 16;
772 
773 	/* HDTV hack, part 1 */
774 	if (vrefresh_rate == 60 &&
775 	    ((hsize == 1360 && vsize == 765) ||
776 	     (hsize == 1368 && vsize == 769))) {
777 		hsize = 1366;
778 		vsize = 768;
779 	}
780 
781 	/*
782 	 * If this connector already has a mode for this size and refresh
783 	 * rate (because it came from detailed or CVT info), use that
784 	 * instead.  This way we don't have to guess at interlace or
785 	 * reduced blanking.
786 	 */
787 	list_for_each_entry(m, &connector->probed_modes, head)
788 		if (m->hdisplay == hsize && m->vdisplay == vsize &&
789 		    drm_mode_vrefresh(m) == vrefresh_rate)
790 			return NULL;
791 
792 	/* HDTV hack, part 2 */
793 	if (hsize == 1366 && vsize == 768 && vrefresh_rate == 60) {
794 		mode = drm_cvt_mode(dev, 1366, 768, vrefresh_rate, 0, 0,
795 				    false);
796 		mode->hdisplay = 1366;
797 		mode->hsync_start = mode->hsync_start - 1;
798 		mode->hsync_end = mode->hsync_end - 1;
799 		return mode;
800 	}
801 
802 	/* check whether it can be found in default mode table */
803 	if (drm_monitor_supports_rb(edid)) {
804 		mode = drm_mode_find_dmt(dev, hsize, vsize, vrefresh_rate,
805 					 true);
806 		if (mode)
807 			return mode;
808 	}
809 	mode = drm_mode_find_dmt(dev, hsize, vsize, vrefresh_rate, false);
810 	if (mode)
811 		return mode;
812 
813 	/* okay, generate it */
814 	switch (timing_level) {
815 	case LEVEL_DMT:
816 		break;
817 	case LEVEL_GTF:
818 		mode = drm_gtf_mode(dev, hsize, vsize, vrefresh_rate, 0, 0);
819 		break;
820 	case LEVEL_GTF2:
821 		/*
822 		 * This is potentially wrong if there's ever a monitor with
823 		 * more than one ranges section, each claiming a different
824 		 * secondary GTF curve.  Please don't do that.
825 		 */
826 		mode = drm_gtf_mode(dev, hsize, vsize, vrefresh_rate, 0, 0);
827 		if (!mode)
828 			return NULL;
829 		if (drm_mode_hsync(mode) > drm_gtf2_hbreak(edid)) {
830 			drm_mode_destroy(dev, mode);
831 			mode = drm_gtf_mode_complex(dev, hsize, vsize,
832 						    vrefresh_rate, 0, 0,
833 						    drm_gtf2_m(edid),
834 						    drm_gtf2_2c(edid),
835 						    drm_gtf2_k(edid),
836 						    drm_gtf2_2j(edid));
837 		}
838 		break;
839 	case LEVEL_CVT:
840 		mode = drm_cvt_mode(dev, hsize, vsize, vrefresh_rate, 0, 0,
841 				    false);
842 		break;
843 	}
844 	return mode;
845 }
846 
847 /*
848  * EDID is delightfully ambiguous about how interlaced modes are to be
849  * encoded.  Our internal representation is of frame height, but some
850  * HDTV detailed timings are encoded as field height.
851  *
852  * The format list here is from CEA, in frame size.  Technically we
853  * should be checking refresh rate too.  Whatever.
854  */
855 static void
856 drm_mode_do_interlace_quirk(struct drm_display_mode *mode,
857 			    struct detailed_pixel_timing *pt)
858 {
859 	int i;
860 	static const struct {
861 		int w, h;
862 	} cea_interlaced[] = {
863 		{ 1920, 1080 },
864 		{  720,  480 },
865 		{ 1440,  480 },
866 		{ 2880,  480 },
867 		{  720,  576 },
868 		{ 1440,  576 },
869 		{ 2880,  576 },
870 	};
871 
872 	if (!(pt->misc & DRM_EDID_PT_INTERLACED))
873 		return;
874 
875 	for (i = 0; i < ARRAY_SIZE(cea_interlaced); i++) {
876 		if ((mode->hdisplay == cea_interlaced[i].w) &&
877 		    (mode->vdisplay == cea_interlaced[i].h / 2)) {
878 			mode->vdisplay *= 2;
879 			mode->vsync_start *= 2;
880 			mode->vsync_end *= 2;
881 			mode->vtotal *= 2;
882 			mode->vtotal |= 1;
883 		}
884 	}
885 
886 	mode->flags |= DRM_MODE_FLAG_INTERLACE;
887 }
888 
889 /**
890  * drm_mode_detailed - create a new mode from an EDID detailed timing section
891  * @dev: DRM device (needed to create new mode)
892  * @edid: EDID block
893  * @timing: EDID detailed timing info
894  * @quirks: quirks to apply
895  *
896  * An EDID detailed timing block contains enough info for us to create and
897  * return a new struct drm_display_mode.
898  */
899 static struct drm_display_mode *drm_mode_detailed(struct drm_device *dev,
900 						  struct edid *edid,
901 						  struct detailed_timing *timing,
902 						  u32 quirks)
903 {
904 	struct drm_display_mode *mode;
905 	struct detailed_pixel_timing *pt = &timing->data.pixel_data;
906 	unsigned hactive = (pt->hactive_hblank_hi & 0xf0) << 4 | pt->hactive_lo;
907 	unsigned vactive = (pt->vactive_vblank_hi & 0xf0) << 4 | pt->vactive_lo;
908 	unsigned hblank = (pt->hactive_hblank_hi & 0xf) << 8 | pt->hblank_lo;
909 	unsigned vblank = (pt->vactive_vblank_hi & 0xf) << 8 | pt->vblank_lo;
910 	unsigned hsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc0) << 2 | pt->hsync_offset_lo;
911 	unsigned hsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x30) << 4 | pt->hsync_pulse_width_lo;
912 	unsigned vsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc) << 2 | pt->vsync_offset_pulse_width_lo >> 4;
913 	unsigned vsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x3) << 4 | (pt->vsync_offset_pulse_width_lo & 0xf);
914 
915 	/* ignore tiny modes */
916 	if (hactive < 64 || vactive < 64)
917 		return NULL;
918 
919 	if (pt->misc & DRM_EDID_PT_STEREO) {
920 		printf("stereo mode not supported\n");
921 		return NULL;
922 	}
923 	if (!(pt->misc & DRM_EDID_PT_SEPARATE_SYNC)) {
924 		printf("composite sync not supported\n");
925 	}
926 
927 	/* it is incorrect if hsync/vsync width is zero */
928 	if (!hsync_pulse_width || !vsync_pulse_width) {
929 		DRM_DEBUG_KMS("Incorrect Detailed timing. "
930 				"Wrong Hsync/Vsync pulse width\n");
931 		return NULL;
932 	}
933 
934 	if (quirks & EDID_QUIRK_FORCE_REDUCED_BLANKING) {
935 		mode = drm_cvt_mode(dev, hactive, vactive, 60, true, false, false);
936 		if (!mode)
937 			return NULL;
938 
939 		goto set_size;
940 	}
941 
942 	mode = drm_mode_create(dev);
943 	if (!mode)
944 		return NULL;
945 
946 	if (quirks & EDID_QUIRK_135_CLOCK_TOO_HIGH)
947 		timing->pixel_clock = cpu_to_le16(1088);
948 
949 	mode->clock = le16_to_cpu(timing->pixel_clock) * 10;
950 
951 	mode->hdisplay = hactive;
952 	mode->hsync_start = mode->hdisplay + hsync_offset;
953 	mode->hsync_end = mode->hsync_start + hsync_pulse_width;
954 	mode->htotal = mode->hdisplay + hblank;
955 
956 	mode->vdisplay = vactive;
957 	mode->vsync_start = mode->vdisplay + vsync_offset;
958 	mode->vsync_end = mode->vsync_start + vsync_pulse_width;
959 	mode->vtotal = mode->vdisplay + vblank;
960 
961 	/* Some EDIDs have bogus h/vtotal values */
962 	if (mode->hsync_end > mode->htotal)
963 		mode->htotal = mode->hsync_end + 1;
964 	if (mode->vsync_end > mode->vtotal)
965 		mode->vtotal = mode->vsync_end + 1;
966 
967 	drm_mode_do_interlace_quirk(mode, pt);
968 
969 	if (quirks & EDID_QUIRK_DETAILED_SYNC_PP) {
970 		pt->misc |= DRM_EDID_PT_HSYNC_POSITIVE | DRM_EDID_PT_VSYNC_POSITIVE;
971 	}
972 
973 	mode->flags |= (pt->misc & DRM_EDID_PT_HSYNC_POSITIVE) ?
974 		DRM_MODE_FLAG_PHSYNC : DRM_MODE_FLAG_NHSYNC;
975 	mode->flags |= (pt->misc & DRM_EDID_PT_VSYNC_POSITIVE) ?
976 		DRM_MODE_FLAG_PVSYNC : DRM_MODE_FLAG_NVSYNC;
977 
978 set_size:
979 	mode->width_mm = pt->width_mm_lo | (pt->width_height_mm_hi & 0xf0) << 4;
980 	mode->height_mm = pt->height_mm_lo | (pt->width_height_mm_hi & 0xf) << 8;
981 
982 	if (quirks & EDID_QUIRK_DETAILED_IN_CM) {
983 		mode->width_mm *= 10;
984 		mode->height_mm *= 10;
985 	}
986 
987 	if (quirks & EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE) {
988 		mode->width_mm = edid->width_cm * 10;
989 		mode->height_mm = edid->height_cm * 10;
990 	}
991 
992 	mode->type = DRM_MODE_TYPE_DRIVER;
993 	mode->vrefresh = drm_mode_vrefresh(mode);
994 	drm_mode_set_name(mode);
995 
996 	return mode;
997 }
998 
999 static bool
1000 mode_in_hsync_range(const struct drm_display_mode *mode,
1001 		    struct edid *edid, u8 *t)
1002 {
1003 	int hsync, hmin, hmax;
1004 
1005 	hmin = t[7];
1006 	if (edid->revision >= 4)
1007 	    hmin += ((t[4] & 0x04) ? 255 : 0);
1008 	hmax = t[8];
1009 	if (edid->revision >= 4)
1010 	    hmax += ((t[4] & 0x08) ? 255 : 0);
1011 	hsync = drm_mode_hsync(mode);
1012 
1013 	return (hsync <= hmax && hsync >= hmin);
1014 }
1015 
1016 static bool
1017 mode_in_vsync_range(const struct drm_display_mode *mode,
1018 		    struct edid *edid, u8 *t)
1019 {
1020 	int vsync, vmin, vmax;
1021 
1022 	vmin = t[5];
1023 	if (edid->revision >= 4)
1024 	    vmin += ((t[4] & 0x01) ? 255 : 0);
1025 	vmax = t[6];
1026 	if (edid->revision >= 4)
1027 	    vmax += ((t[4] & 0x02) ? 255 : 0);
1028 	vsync = drm_mode_vrefresh(mode);
1029 
1030 	return (vsync <= vmax && vsync >= vmin);
1031 }
1032 
1033 static u32
1034 range_pixel_clock(struct edid *edid, u8 *t)
1035 {
1036 	/* unspecified */
1037 	if (t[9] == 0 || t[9] == 255)
1038 		return 0;
1039 
1040 	/* 1.4 with CVT support gives us real precision, yay */
1041 	if (edid->revision >= 4 && t[10] == 0x04)
1042 		return (t[9] * 10000) - ((t[12] >> 2) * 250);
1043 
1044 	/* 1.3 is pathetic, so fuzz up a bit */
1045 	return t[9] * 10000 + 5001;
1046 }
1047 
1048 static bool
1049 mode_in_range(const struct drm_display_mode *mode, struct edid *edid,
1050 	      struct detailed_timing *timing)
1051 {
1052 	u32 max_clock;
1053 	u8 *t = (u8 *)timing;
1054 
1055 	if (!mode_in_hsync_range(mode, edid, t))
1056 		return false;
1057 
1058 	if (!mode_in_vsync_range(mode, edid, t))
1059 		return false;
1060 
1061 	if ((max_clock = range_pixel_clock(edid, t)))
1062 		if (mode->clock > max_clock)
1063 			return false;
1064 
1065 	/* 1.4 max horizontal check */
1066 	if (edid->revision >= 4 && t[10] == 0x04)
1067 		if (t[13] && mode->hdisplay > 8 * (t[13] + (256 * (t[12]&0x3))))
1068 			return false;
1069 
1070 	if (mode_is_rb(mode) && !drm_monitor_supports_rb(edid))
1071 		return false;
1072 
1073 	return true;
1074 }
1075 
1076 static bool valid_inferred_mode(const struct drm_connector *connector,
1077 				const struct drm_display_mode *mode)
1078 {
1079 	struct drm_display_mode *m;
1080 	bool ok = false;
1081 
1082 	list_for_each_entry(m, &connector->probed_modes, head) {
1083 		if (mode->hdisplay == m->hdisplay &&
1084 		    mode->vdisplay == m->vdisplay &&
1085 		    drm_mode_vrefresh(mode) == drm_mode_vrefresh(m))
1086 			return false; /* duplicated */
1087 		if (mode->hdisplay <= m->hdisplay &&
1088 		    mode->vdisplay <= m->vdisplay)
1089 			ok = true;
1090 	}
1091 	return ok;
1092 }
1093 
1094 static int
1095 drm_dmt_modes_for_range(struct drm_connector *connector, struct edid *edid,
1096 			struct detailed_timing *timing)
1097 {
1098 	int i, modes = 0;
1099 	struct drm_display_mode *newmode;
1100 	struct drm_device *dev = connector->dev;
1101 
1102 	for (i = 0; i < drm_num_dmt_modes; i++) {
1103 		if (mode_in_range(drm_dmt_modes + i, edid, timing) &&
1104 		    valid_inferred_mode(connector, drm_dmt_modes + i)) {
1105 			newmode = drm_mode_duplicate(dev, &drm_dmt_modes[i]);
1106 			if (newmode) {
1107 				drm_mode_probed_add(connector, newmode);
1108 				modes++;
1109 			}
1110 		}
1111 	}
1112 
1113 	return modes;
1114 }
1115 
1116 /* fix up 1366x768 mode from 1368x768;
1117  * GFT/CVT can't express 1366 width which isn't dividable by 8
1118  */
1119 static void fixup_mode_1366x768(struct drm_display_mode *mode)
1120 {
1121 	if (mode->hdisplay == 1368 && mode->vdisplay == 768) {
1122 		mode->hdisplay = 1366;
1123 		mode->hsync_start--;
1124 		mode->hsync_end--;
1125 		drm_mode_set_name(mode);
1126 	}
1127 }
1128 
1129 static int
1130 drm_gtf_modes_for_range(struct drm_connector *connector, struct edid *edid,
1131 			struct detailed_timing *timing)
1132 {
1133 	int i, modes = 0;
1134 	struct drm_display_mode *newmode;
1135 	struct drm_device *dev = connector->dev;
1136 
1137 	for (i = 0; i < num_extra_modes; i++) {
1138 		const struct minimode *m = &extra_modes[i];
1139 		newmode = drm_gtf_mode(dev, m->w, m->h, m->r, 0, 0);
1140 		if (!newmode)
1141 			return modes;
1142 
1143 		fixup_mode_1366x768(newmode);
1144 		if (!mode_in_range(newmode, edid, timing) ||
1145 		    !valid_inferred_mode(connector, newmode)) {
1146 			drm_mode_destroy(dev, newmode);
1147 			continue;
1148 		}
1149 
1150 		drm_mode_probed_add(connector, newmode);
1151 		modes++;
1152 	}
1153 
1154 	return modes;
1155 }
1156 
1157 static int
1158 drm_cvt_modes_for_range(struct drm_connector *connector, struct edid *edid,
1159 			struct detailed_timing *timing)
1160 {
1161 	int i, modes = 0;
1162 	struct drm_display_mode *newmode;
1163 	struct drm_device *dev = connector->dev;
1164 	bool rb = drm_monitor_supports_rb(edid);
1165 
1166 	for (i = 0; i < num_extra_modes; i++) {
1167 		const struct minimode *m = &extra_modes[i];
1168 		newmode = drm_cvt_mode(dev, m->w, m->h, m->r, rb, 0, 0);
1169 		if (!newmode)
1170 			return modes;
1171 
1172 		fixup_mode_1366x768(newmode);
1173 		if (!mode_in_range(newmode, edid, timing) ||
1174 		    !valid_inferred_mode(connector, newmode)) {
1175 			drm_mode_destroy(dev, newmode);
1176 			continue;
1177 		}
1178 
1179 		drm_mode_probed_add(connector, newmode);
1180 		modes++;
1181 	}
1182 
1183 	return modes;
1184 }
1185 
1186 static void
1187 do_inferred_modes(struct detailed_timing *timing, void *c)
1188 {
1189 	struct detailed_mode_closure *closure = c;
1190 	struct detailed_non_pixel *data = &timing->data.other_data;
1191 	struct detailed_data_monitor_range *range = &data->data.range;
1192 
1193 	if (data->type != EDID_DETAIL_MONITOR_RANGE)
1194 		return;
1195 
1196 	closure->modes += drm_dmt_modes_for_range(closure->connector,
1197 						  closure->edid,
1198 						  timing);
1199 
1200 	if (!version_greater(closure->edid, 1, 1))
1201 		return; /* GTF not defined yet */
1202 
1203 	switch (range->flags) {
1204 	case 0x02: /* secondary gtf, XXX could do more */
1205 	case 0x00: /* default gtf */
1206 		closure->modes += drm_gtf_modes_for_range(closure->connector,
1207 							  closure->edid,
1208 							  timing);
1209 		break;
1210 	case 0x04: /* cvt, only in 1.4+ */
1211 		if (!version_greater(closure->edid, 1, 3))
1212 			break;
1213 
1214 		closure->modes += drm_cvt_modes_for_range(closure->connector,
1215 							  closure->edid,
1216 							  timing);
1217 		break;
1218 	case 0x01: /* just the ranges, no formula */
1219 	default:
1220 		break;
1221 	}
1222 }
1223 
1224 static int
1225 add_inferred_modes(struct drm_connector *connector, struct edid *edid)
1226 {
1227 	struct detailed_mode_closure closure = {
1228 		connector, edid, 0, 0, 0
1229 	};
1230 
1231 	if (version_greater(edid, 1, 0))
1232 		drm_for_each_detailed_block((u8 *)edid, do_inferred_modes,
1233 					    &closure);
1234 
1235 	return closure.modes;
1236 }
1237 
1238 static int
1239 drm_est3_modes(struct drm_connector *connector, struct detailed_timing *timing)
1240 {
1241 	int i, j, m, modes = 0;
1242 	struct drm_display_mode *mode;
1243 	u8 *est = ((u8 *)timing) + 5;
1244 
1245 	for (i = 0; i < 6; i++) {
1246 		for (j = 7; j > 0; j--) {
1247 			m = (i * 8) + (7 - j);
1248 			if (m >= ARRAY_SIZE(est3_modes))
1249 				break;
1250 			if (est[i] & (1 << j)) {
1251 				mode = drm_mode_find_dmt(connector->dev,
1252 							 est3_modes[m].w,
1253 							 est3_modes[m].h,
1254 							 est3_modes[m].r,
1255 							 est3_modes[m].rb);
1256 				if (mode) {
1257 					drm_mode_probed_add(connector, mode);
1258 					modes++;
1259 				}
1260 			}
1261 		}
1262 	}
1263 
1264 	return modes;
1265 }
1266 
1267 static void
1268 do_established_modes(struct detailed_timing *timing, void *c)
1269 {
1270 	struct detailed_mode_closure *closure = c;
1271 	struct detailed_non_pixel *data = &timing->data.other_data;
1272 
1273 	if (data->type == EDID_DETAIL_EST_TIMINGS)
1274 		closure->modes += drm_est3_modes(closure->connector, timing);
1275 }
1276 
1277 /**
1278  * add_established_modes - get est. modes from EDID and add them
1279  * @edid: EDID block to scan
1280  *
1281  * Each EDID block contains a bitmap of the supported "established modes" list
1282  * (defined above).  Tease them out and add them to the global modes list.
1283  */
1284 static int
1285 add_established_modes(struct drm_connector *connector, struct edid *edid)
1286 {
1287 	struct drm_device *dev = connector->dev;
1288 	unsigned long est_bits = edid->established_timings.t1 |
1289 		(edid->established_timings.t2 << 8) |
1290 		((edid->established_timings.mfg_rsvd & 0x80) << 9);
1291 	int i, modes = 0;
1292 	struct detailed_mode_closure closure = {
1293 		connector, edid, 0, 0, 0
1294 	};
1295 
1296 	for (i = 0; i <= EDID_EST_TIMINGS; i++) {
1297 		if (est_bits & (1<<i)) {
1298 			struct drm_display_mode *newmode;
1299 			newmode = drm_mode_duplicate(dev, &edid_est_modes[i]);
1300 			if (newmode) {
1301 				drm_mode_probed_add(connector, newmode);
1302 				modes++;
1303 			}
1304 		}
1305 	}
1306 
1307 	if (version_greater(edid, 1, 0))
1308 		    drm_for_each_detailed_block((u8 *)edid,
1309 						do_established_modes, &closure);
1310 
1311 	return modes + closure.modes;
1312 }
1313 
1314 static void
1315 do_standard_modes(struct detailed_timing *timing, void *c)
1316 {
1317 	struct detailed_mode_closure *closure = c;
1318 	struct detailed_non_pixel *data = &timing->data.other_data;
1319 	struct drm_connector *connector = closure->connector;
1320 	struct edid *edid = closure->edid;
1321 
1322 	if (data->type == EDID_DETAIL_STD_MODES) {
1323 		int i;
1324 		for (i = 0; i < 6; i++) {
1325 			struct std_timing *std;
1326 			struct drm_display_mode *newmode;
1327 
1328 			std = &data->data.timings[i];
1329 			newmode = drm_mode_std(connector, edid, std,
1330 					       edid->revision);
1331 			if (newmode) {
1332 				drm_mode_probed_add(connector, newmode);
1333 				closure->modes++;
1334 			}
1335 		}
1336 	}
1337 }
1338 
1339 /**
1340  * add_standard_modes - get std. modes from EDID and add them
1341  * @edid: EDID block to scan
1342  *
1343  * Standard modes can be calculated using the appropriate standard (DMT,
1344  * GTF or CVT. Grab them from @edid and add them to the list.
1345  */
1346 static int
1347 add_standard_modes(struct drm_connector *connector, struct edid *edid)
1348 {
1349 	int i, modes = 0;
1350 	struct detailed_mode_closure closure = {
1351 		connector, edid, 0, 0, 0
1352 	};
1353 
1354 	for (i = 0; i < EDID_STD_TIMINGS; i++) {
1355 		struct drm_display_mode *newmode;
1356 
1357 		newmode = drm_mode_std(connector, edid,
1358 				       &edid->standard_timings[i],
1359 				       edid->revision);
1360 		if (newmode) {
1361 			drm_mode_probed_add(connector, newmode);
1362 			modes++;
1363 		}
1364 	}
1365 
1366 	if (version_greater(edid, 1, 0))
1367 		drm_for_each_detailed_block((u8 *)edid, do_standard_modes,
1368 					    &closure);
1369 
1370 	/* XXX should also look for standard codes in VTB blocks */
1371 
1372 	return modes + closure.modes;
1373 }
1374 
1375 static int drm_cvt_modes(struct drm_connector *connector,
1376 			 struct detailed_timing *timing)
1377 {
1378 	int i, j, modes = 0;
1379 	struct drm_display_mode *newmode;
1380 	struct drm_device *dev = connector->dev;
1381 	struct cvt_timing *cvt;
1382 	const int rates[] = { 60, 85, 75, 60, 50 };
1383 	const u8 empty[3] = { 0, 0, 0 };
1384 
1385 	for (i = 0; i < 4; i++) {
1386 		int width = 0, height;
1387 		cvt = &(timing->data.other_data.data.cvt[i]);
1388 
1389 		if (!memcmp(cvt->code, empty, 3))
1390 			continue;
1391 
1392 		height = (cvt->code[0] + ((cvt->code[1] & 0xf0) << 4) + 1) * 2;
1393 		switch (cvt->code[1] & 0x0c) {
1394 		case 0x00:
1395 			width = height * 4 / 3;
1396 			break;
1397 		case 0x04:
1398 			width = height * 16 / 9;
1399 			break;
1400 		case 0x08:
1401 			width = height * 16 / 10;
1402 			break;
1403 		case 0x0c:
1404 			width = height * 15 / 9;
1405 			break;
1406 		}
1407 
1408 		for (j = 1; j < 5; j++) {
1409 			if (cvt->code[2] & (1 << j)) {
1410 				newmode = drm_cvt_mode(dev, width, height,
1411 						       rates[j], j == 0,
1412 						       false, false);
1413 				if (newmode) {
1414 					drm_mode_probed_add(connector, newmode);
1415 					modes++;
1416 				}
1417 			}
1418 		}
1419 	}
1420 
1421 	return modes;
1422 }
1423 
1424 static void
1425 do_cvt_mode(struct detailed_timing *timing, void *c)
1426 {
1427 	struct detailed_mode_closure *closure = c;
1428 	struct detailed_non_pixel *data = &timing->data.other_data;
1429 
1430 	if (data->type == EDID_DETAIL_CVT_3BYTE)
1431 		closure->modes += drm_cvt_modes(closure->connector, timing);
1432 }
1433 
1434 static int
1435 add_cvt_modes(struct drm_connector *connector, struct edid *edid)
1436 {
1437 	struct detailed_mode_closure closure = {
1438 		connector, edid, 0, 0, 0
1439 	};
1440 
1441 	if (version_greater(edid, 1, 2))
1442 		drm_for_each_detailed_block((u8 *)edid, do_cvt_mode, &closure);
1443 
1444 	/* XXX should also look for CVT codes in VTB blocks */
1445 
1446 	return closure.modes;
1447 }
1448 
1449 static void
1450 do_detailed_mode(struct detailed_timing *timing, void *c)
1451 {
1452 	struct detailed_mode_closure *closure = c;
1453 	struct drm_display_mode *newmode;
1454 
1455 	if (timing->pixel_clock) {
1456 		newmode = drm_mode_detailed(closure->connector->dev,
1457 					    closure->edid, timing,
1458 					    closure->quirks);
1459 		if (!newmode)
1460 			return;
1461 
1462 		if (closure->preferred)
1463 			newmode->type |= DRM_MODE_TYPE_PREFERRED;
1464 
1465 		drm_mode_probed_add(closure->connector, newmode);
1466 		closure->modes++;
1467 		closure->preferred = 0;
1468 	}
1469 }
1470 
1471 /*
1472  * add_detailed_modes - Add modes from detailed timings
1473  * @connector: attached connector
1474  * @edid: EDID block to scan
1475  * @quirks: quirks to apply
1476  */
1477 static int
1478 add_detailed_modes(struct drm_connector *connector, struct edid *edid,
1479 		   u32 quirks)
1480 {
1481 	struct detailed_mode_closure closure = {
1482 		connector,
1483 		edid,
1484 		1,
1485 		quirks,
1486 		0
1487 	};
1488 
1489 	if (closure.preferred && !version_greater(edid, 1, 3))
1490 		closure.preferred =
1491 		    (edid->features & DRM_EDID_FEATURE_PREFERRED_TIMING);
1492 
1493 	drm_for_each_detailed_block((u8 *)edid, do_detailed_mode, &closure);
1494 
1495 	return closure.modes;
1496 }
1497 
1498 #define HDMI_IDENTIFIER 0x000C03
1499 #define AUDIO_BLOCK	0x01
1500 #define VIDEO_BLOCK     0x02
1501 #define VENDOR_BLOCK    0x03
1502 #define SPEAKER_BLOCK	0x04
1503 #define EDID_BASIC_AUDIO	(1 << 6)
1504 #define EDID_CEA_YCRCB444	(1 << 5)
1505 #define EDID_CEA_YCRCB422	(1 << 4)
1506 
1507 /**
1508  * Search EDID for CEA extension block.
1509  */
1510 u8 *drm_find_cea_extension(struct edid *edid)
1511 {
1512 	u8 *edid_ext = NULL;
1513 	int i;
1514 
1515 	/* No EDID or EDID extensions */
1516 	if (edid == NULL || edid->extensions == 0)
1517 		return NULL;
1518 
1519 	/* Find CEA extension */
1520 	for (i = 0; i < edid->extensions; i++) {
1521 		edid_ext = (u8 *)edid + EDID_LENGTH * (i + 1);
1522 		if (edid_ext[0] == CEA_EXT)
1523 			break;
1524 	}
1525 
1526 	if (i == edid->extensions)
1527 		return NULL;
1528 
1529 	return edid_ext;
1530 }
1531 EXPORT_SYMBOL(drm_find_cea_extension);
1532 
1533 /*
1534  * Looks for a CEA mode matching given drm_display_mode.
1535  * Returns its CEA Video ID code, or 0 if not found.
1536  */
1537 u8 drm_match_cea_mode(struct drm_display_mode *to_match)
1538 {
1539 	const struct drm_display_mode *cea_mode;
1540 	u8 mode;
1541 
1542 	for (mode = 0; mode < drm_num_cea_modes; mode++) {
1543 		cea_mode = (const struct drm_display_mode *)&edid_cea_modes[mode];
1544 
1545 		if (drm_mode_equal(to_match, cea_mode))
1546 			return mode + 1;
1547 	}
1548 	return 0;
1549 }
1550 EXPORT_SYMBOL(drm_match_cea_mode);
1551 
1552 
1553 static int
1554 do_cea_modes (struct drm_connector *connector, u8 *db, u8 len)
1555 {
1556 	struct drm_device *dev = connector->dev;
1557 	u8 * mode, cea_mode;
1558 	int modes = 0;
1559 
1560 	for (mode = db; mode < db + len; mode++) {
1561 		cea_mode = (*mode & 127) - 1; /* CEA modes are numbered 1..127 */
1562 		if (cea_mode < drm_num_cea_modes) {
1563 			struct drm_display_mode *newmode;
1564 			newmode = drm_mode_duplicate(dev,
1565 						     &edid_cea_modes[cea_mode]);
1566 			if (newmode) {
1567 				drm_mode_probed_add(connector, newmode);
1568 				modes++;
1569 			}
1570 		}
1571 	}
1572 
1573 	return modes;
1574 }
1575 
1576 static int
1577 cea_db_payload_len(const u8 *db)
1578 {
1579 	return db[0] & 0x1f;
1580 }
1581 
1582 static int
1583 cea_db_tag(const u8 *db)
1584 {
1585 	return db[0] >> 5;
1586 }
1587 
1588 static int
1589 cea_revision(const u8 *cea)
1590 {
1591 	return cea[1];
1592 }
1593 
1594 static int
1595 cea_db_offsets(const u8 *cea, int *start, int *end)
1596 {
1597 	/* Data block offset in CEA extension block */
1598 	*start = 4;
1599 	*end = cea[2];
1600 	if (*end == 0)
1601 		*end = 127;
1602 	if (*end < 4 || *end > 127)
1603 		return -ERANGE;
1604 	return 0;
1605 }
1606 
1607 #define for_each_cea_db(cea, i, start, end) \
1608 	for ((i) = (start); (i) < (end) && (i) + cea_db_payload_len(&(cea)[(i)]) < (end); (i) += cea_db_payload_len(&(cea)[(i)]) + 1)
1609 
1610 static int
1611 add_cea_modes(struct drm_connector *connector, struct edid *edid)
1612 {
1613 	u8 * cea = drm_find_cea_extension(edid);
1614 	u8 * db, dbl;
1615 	int modes = 0;
1616 
1617 	if (cea && cea_revision(cea) >= 3) {
1618 		int i, start, end;
1619 
1620 		if (cea_db_offsets(cea, &start, &end))
1621 			return 0;
1622 
1623 		for_each_cea_db(cea, i, start, end) {
1624 			db = &cea[i];
1625 			dbl = cea_db_payload_len(db);
1626 
1627 			if (cea_db_tag(db) == VIDEO_BLOCK)
1628 				modes += do_cea_modes (connector, db+1, dbl);
1629 		}
1630 	}
1631 
1632 	return modes;
1633 }
1634 
1635 static void
1636 parse_hdmi_vsdb(struct drm_connector *connector, const u8 *db)
1637 {
1638 	u8 len = cea_db_payload_len(db);
1639 
1640 	if (len >= 6) {
1641 		connector->eld[5] |= (db[6] >> 7) << 1;  /* Supports_AI */
1642 		connector->dvi_dual = db[6] & 1;
1643 	}
1644 	if (len >= 7)
1645 		connector->max_tmds_clock = db[7] * 5;
1646 	if (len >= 8) {
1647 		connector->latency_present[0] = db[8] >> 7;
1648 		connector->latency_present[1] = (db[8] >> 6) & 1;
1649 	}
1650 	if (len >= 9)
1651 		connector->video_latency[0] = db[9];
1652 	if (len >= 10)
1653 		connector->audio_latency[0] = db[10];
1654 	if (len >= 11)
1655 		connector->video_latency[1] = db[11];
1656 	if (len >= 12)
1657 		connector->audio_latency[1] = db[12];
1658 
1659 	DRM_DEBUG_KMS("HDMI: DVI dual %d, "
1660 		    "max TMDS clock %d, "
1661 		    "latency present %d %d, "
1662 		    "video latency %d %d, "
1663 		    "audio latency %d %d\n",
1664 		    connector->dvi_dual,
1665 		    connector->max_tmds_clock,
1666 	      (int) connector->latency_present[0],
1667 	      (int) connector->latency_present[1],
1668 		    connector->video_latency[0],
1669 		    connector->video_latency[1],
1670 		    connector->audio_latency[0],
1671 		    connector->audio_latency[1]);
1672 }
1673 
1674 static void
1675 monitor_name(struct detailed_timing *t, void *data)
1676 {
1677 	if (t->data.other_data.type == EDID_DETAIL_MONITOR_NAME)
1678 		*(u8 **)data = t->data.other_data.data.str.str;
1679 }
1680 
1681 static bool cea_db_is_hdmi_vsdb(const u8 *db)
1682 {
1683 	int hdmi_id;
1684 
1685 	if (cea_db_tag(db) != VENDOR_BLOCK)
1686 		return false;
1687 
1688 	if (cea_db_payload_len(db) < 5)
1689 		return false;
1690 
1691 	hdmi_id = db[1] | (db[2] << 8) | (db[3] << 16);
1692 
1693 	return hdmi_id == HDMI_IDENTIFIER;
1694 }
1695 
1696 /**
1697  * drm_edid_to_eld - build ELD from EDID
1698  * @connector: connector corresponding to the HDMI/DP sink
1699  * @edid: EDID to parse
1700  *
1701  * Fill the ELD (EDID-Like Data) buffer for passing to the audio driver.
1702  * Some ELD fields are left to the graphics driver caller:
1703  * - Conn_Type
1704  * - HDCP
1705  * - Port_ID
1706  */
1707 void drm_edid_to_eld(struct drm_connector *connector, struct edid *edid)
1708 {
1709 	uint8_t *eld = connector->eld;
1710 	u8 *cea;
1711 	u8 *name;
1712 	u8 *db;
1713 	int sad_count = 0;
1714 	int mnl;
1715 	int dbl;
1716 
1717 	memset(eld, 0, sizeof(connector->eld));
1718 
1719 	cea = drm_find_cea_extension(edid);
1720 	if (!cea) {
1721 		DRM_DEBUG_KMS("ELD: no CEA Extension found\n");
1722 		return;
1723 	}
1724 
1725 	name = NULL;
1726 	drm_for_each_detailed_block((u8 *)edid, monitor_name, &name);
1727 	for (mnl = 0; name && mnl < 13; mnl++) {
1728 		if (name[mnl] == 0x0a)
1729 			break;
1730 		eld[20 + mnl] = name[mnl];
1731 	}
1732 	eld[4] = (cea[1] << 5) | mnl;
1733 	DRM_DEBUG_KMS("ELD monitor %s\n", eld + 20);
1734 
1735 	eld[0] = 2 << 3;		/* ELD version: 2 */
1736 
1737 	eld[16] = edid->mfg_id[0];
1738 	eld[17] = edid->mfg_id[1];
1739 	eld[18] = edid->prod_code[0];
1740 	eld[19] = edid->prod_code[1];
1741 
1742 	if (cea_revision(cea) >= 3) {
1743 		int i, start, end;
1744 
1745 		if (cea_db_offsets(cea, &start, &end)) {
1746 			start = 0;
1747 			end = 0;
1748 		}
1749 
1750 		for_each_cea_db(cea, i, start, end) {
1751 			db = &cea[i];
1752 			dbl = cea_db_payload_len(db);
1753 
1754 			switch (cea_db_tag(db)) {
1755 			case AUDIO_BLOCK:
1756 				/* Audio Data Block, contains SADs */
1757 				sad_count = dbl / 3;
1758 				if (dbl >= 1)
1759 					memcpy(eld + 20 + mnl, &db[1], dbl);
1760 				break;
1761 			case SPEAKER_BLOCK:
1762 				/* Speaker Allocation Data Block */
1763 				if (dbl >= 1)
1764 					eld[7] = db[1];
1765 				break;
1766 			case VENDOR_BLOCK:
1767 				/* HDMI Vendor-Specific Data Block */
1768 				if (cea_db_is_hdmi_vsdb(db))
1769 					parse_hdmi_vsdb(connector, db);
1770 				break;
1771 			default:
1772 				break;
1773 			}
1774 		}
1775 	}
1776 	eld[5] |= sad_count << 4;
1777 	eld[2] = (20 + mnl + sad_count * 3 + 3) / 4;
1778 
1779 	DRM_DEBUG_KMS("ELD size %d, SAD count %d\n", (int)eld[2], sad_count);
1780 }
1781 EXPORT_SYMBOL(drm_edid_to_eld);
1782 
1783 /**
1784  * drm_av_sync_delay - HDMI/DP sink audio-video sync delay in millisecond
1785  * @connector: connector associated with the HDMI/DP sink
1786  * @mode: the display mode
1787  */
1788 int drm_av_sync_delay(struct drm_connector *connector,
1789 		      struct drm_display_mode *mode)
1790 {
1791 	int i = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
1792 	int a, v;
1793 
1794 	if (!connector->latency_present[0])
1795 		return 0;
1796 	if (!connector->latency_present[1])
1797 		i = 0;
1798 
1799 	a = connector->audio_latency[i];
1800 	v = connector->video_latency[i];
1801 
1802 	/*
1803 	 * HDMI/DP sink doesn't support audio or video?
1804 	 */
1805 	if (a == 255 || v == 255)
1806 		return 0;
1807 
1808 	/*
1809 	 * Convert raw EDID values to millisecond.
1810 	 * Treat unknown latency as 0ms.
1811 	 */
1812 	if (a)
1813 		a = min(2 * (a - 1), 500);
1814 	if (v)
1815 		v = min(2 * (v - 1), 500);
1816 
1817 	return max(v - a, 0);
1818 }
1819 EXPORT_SYMBOL(drm_av_sync_delay);
1820 
1821 /**
1822  * drm_select_eld - select one ELD from multiple HDMI/DP sinks
1823  * @encoder: the encoder just changed display mode
1824  * @mode: the adjusted display mode
1825  *
1826  * It's possible for one encoder to be associated with multiple HDMI/DP sinks.
1827  * The policy is now hard coded to simply use the first HDMI/DP sink's ELD.
1828  */
1829 struct drm_connector *drm_select_eld(struct drm_encoder *encoder,
1830 				     struct drm_display_mode *mode)
1831 {
1832 	struct drm_connector *connector;
1833 	struct drm_device *dev = encoder->dev;
1834 
1835 	list_for_each_entry(connector, &dev->mode_config.connector_list, head)
1836 		if (connector->encoder == encoder && connector->eld[0])
1837 			return connector;
1838 
1839 	return NULL;
1840 }
1841 EXPORT_SYMBOL(drm_select_eld);
1842 
1843 /**
1844  * drm_detect_hdmi_monitor - detect whether monitor is hdmi.
1845  * @edid: monitor EDID information
1846  *
1847  * Parse the CEA extension according to CEA-861-B.
1848  * Return true if HDMI, false if not or unknown.
1849  */
1850 bool drm_detect_hdmi_monitor(struct edid *edid)
1851 {
1852 	u8 *edid_ext;
1853 	int i;
1854 	int start_offset, end_offset;
1855 
1856 	edid_ext = drm_find_cea_extension(edid);
1857 	if (!edid_ext)
1858 		return false;
1859 
1860 	if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
1861 		return false;
1862 
1863 	/*
1864 	 * Because HDMI identifier is in Vendor Specific Block,
1865 	 * search it from all data blocks of CEA extension.
1866 	 */
1867 	for_each_cea_db(edid_ext, i, start_offset, end_offset) {
1868 		if (cea_db_is_hdmi_vsdb(&edid_ext[i]))
1869 			return true;
1870 	}
1871 
1872 	return false;
1873 }
1874 EXPORT_SYMBOL(drm_detect_hdmi_monitor);
1875 
1876 /**
1877  * drm_detect_monitor_audio - check monitor audio capability
1878  *
1879  * Monitor should have CEA extension block.
1880  * If monitor has 'basic audio', but no CEA audio blocks, it's 'basic
1881  * audio' only. If there is any audio extension block and supported
1882  * audio format, assume at least 'basic audio' support, even if 'basic
1883  * audio' is not defined in EDID.
1884  *
1885  */
1886 bool drm_detect_monitor_audio(struct edid *edid)
1887 {
1888 	u8 *edid_ext;
1889 	int i, j;
1890 	bool has_audio = false;
1891 	int start_offset, end_offset;
1892 
1893 	edid_ext = drm_find_cea_extension(edid);
1894 	if (!edid_ext)
1895 		goto end;
1896 
1897 	has_audio = ((edid_ext[3] & EDID_BASIC_AUDIO) != 0);
1898 
1899 	if (has_audio) {
1900 		DRM_DEBUG_KMS("Monitor has basic audio support\n");
1901 		goto end;
1902 	}
1903 
1904 	if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
1905 		goto end;
1906 
1907 	for_each_cea_db(edid_ext, i, start_offset, end_offset) {
1908 		if (cea_db_tag(&edid_ext[i]) == AUDIO_BLOCK) {
1909 			has_audio = true;
1910 			for (j = 1; j < cea_db_payload_len(&edid_ext[i]) + 1; j += 3)
1911 				DRM_DEBUG_KMS("CEA audio format %d\n",
1912 					      (edid_ext[i + j] >> 3) & 0xf);
1913 			goto end;
1914 		}
1915 	}
1916 end:
1917 	return has_audio;
1918 }
1919 EXPORT_SYMBOL(drm_detect_monitor_audio);
1920 
1921 /**
1922  * drm_add_display_info - pull display info out if present
1923  * @edid: EDID data
1924  * @info: display info (attached to connector)
1925  *
1926  * Grab any available display info and stuff it into the drm_display_info
1927  * structure that's part of the connector.  Useful for tracking bpp and
1928  * color spaces.
1929  */
1930 static void drm_add_display_info(struct edid *edid,
1931 				 struct drm_display_info *info)
1932 {
1933 	u8 *edid_ext;
1934 
1935 	info->width_mm = edid->width_cm * 10;
1936 	info->height_mm = edid->height_cm * 10;
1937 
1938 	/* driver figures it out in this case */
1939 	info->bpc = 0;
1940 	info->color_formats = 0;
1941 
1942 	if (edid->revision < 3)
1943 		return;
1944 
1945 	if (!(edid->input & DRM_EDID_INPUT_DIGITAL))
1946 		return;
1947 
1948 	/* Get data from CEA blocks if present */
1949 	edid_ext = drm_find_cea_extension(edid);
1950 	if (edid_ext) {
1951 		info->cea_rev = edid_ext[1];
1952 
1953 		/* The existence of a CEA block should imply RGB support */
1954 		info->color_formats = DRM_COLOR_FORMAT_RGB444;
1955 		if (edid_ext[3] & EDID_CEA_YCRCB444)
1956 			info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
1957 		if (edid_ext[3] & EDID_CEA_YCRCB422)
1958 			info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
1959 	}
1960 
1961 	/* Only defined for 1.4 with digital displays */
1962 	if (edid->revision < 4)
1963 		return;
1964 
1965 	switch (edid->input & DRM_EDID_DIGITAL_DEPTH_MASK) {
1966 	case DRM_EDID_DIGITAL_DEPTH_6:
1967 		info->bpc = 6;
1968 		break;
1969 	case DRM_EDID_DIGITAL_DEPTH_8:
1970 		info->bpc = 8;
1971 		break;
1972 	case DRM_EDID_DIGITAL_DEPTH_10:
1973 		info->bpc = 10;
1974 		break;
1975 	case DRM_EDID_DIGITAL_DEPTH_12:
1976 		info->bpc = 12;
1977 		break;
1978 	case DRM_EDID_DIGITAL_DEPTH_14:
1979 		info->bpc = 14;
1980 		break;
1981 	case DRM_EDID_DIGITAL_DEPTH_16:
1982 		info->bpc = 16;
1983 		break;
1984 	case DRM_EDID_DIGITAL_DEPTH_UNDEF:
1985 	default:
1986 		info->bpc = 0;
1987 		break;
1988 	}
1989 
1990 	info->color_formats |= DRM_COLOR_FORMAT_RGB444;
1991 	if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB444)
1992 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
1993 	if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB422)
1994 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
1995 }
1996 
1997 /**
1998  * drm_add_edid_modes - add modes from EDID data, if available
1999  * @connector: connector we're probing
2000  * @edid: edid data
2001  *
2002  * Add the specified modes to the connector's mode list.
2003  *
2004  * Return number of modes added or 0 if we couldn't find any.
2005  */
2006 int drm_add_edid_modes(struct drm_connector *connector, struct edid *edid)
2007 {
2008 	int num_modes = 0;
2009 	u32 quirks;
2010 
2011 	if (edid == NULL) {
2012 		return 0;
2013 	}
2014 	if (!drm_edid_is_valid(edid)) {
2015 		dev_warn(connector->dev->dev, "%s: EDID invalid.\n",
2016 			 drm_get_connector_name(connector));
2017 		return 0;
2018 	}
2019 
2020 	quirks = edid_get_quirks(edid);
2021 
2022 	/*
2023 	 * EDID spec says modes should be preferred in this order:
2024 	 * - preferred detailed mode
2025 	 * - other detailed modes from base block
2026 	 * - detailed modes from extension blocks
2027 	 * - CVT 3-byte code modes
2028 	 * - standard timing codes
2029 	 * - established timing codes
2030 	 * - modes inferred from GTF or CVT range information
2031 	 *
2032 	 * We get this pretty much right.
2033 	 *
2034 	 * XXX order for additional mode types in extension blocks?
2035 	 */
2036 	num_modes += add_detailed_modes(connector, edid, quirks);
2037 	num_modes += add_cvt_modes(connector, edid);
2038 	num_modes += add_standard_modes(connector, edid);
2039 	num_modes += add_established_modes(connector, edid);
2040 	if (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF)
2041 		num_modes += add_inferred_modes(connector, edid);
2042 	num_modes += add_cea_modes(connector, edid);
2043 
2044 	if (quirks & (EDID_QUIRK_PREFER_LARGE_60 | EDID_QUIRK_PREFER_LARGE_75))
2045 		edid_fixup_preferred(connector, quirks);
2046 
2047 	drm_add_display_info(edid, &connector->display_info);
2048 
2049 	return num_modes;
2050 }
2051 EXPORT_SYMBOL(drm_add_edid_modes);
2052 
2053 /**
2054  * drm_add_modes_noedid - add modes for the connectors without EDID
2055  * @connector: connector we're probing
2056  * @hdisplay: the horizontal display limit
2057  * @vdisplay: the vertical display limit
2058  *
2059  * Add the specified modes to the connector's mode list. Only when the
2060  * hdisplay/vdisplay is not beyond the given limit, it will be added.
2061  *
2062  * Return number of modes added or 0 if we couldn't find any.
2063  */
2064 int drm_add_modes_noedid(struct drm_connector *connector,
2065 			int hdisplay, int vdisplay)
2066 {
2067 	int i, count, num_modes = 0;
2068 	struct drm_display_mode *mode;
2069 	struct drm_device *dev = connector->dev;
2070 
2071 	count = sizeof(drm_dmt_modes) / sizeof(struct drm_display_mode);
2072 	if (hdisplay < 0)
2073 		hdisplay = 0;
2074 	if (vdisplay < 0)
2075 		vdisplay = 0;
2076 
2077 	for (i = 0; i < count; i++) {
2078 		const struct drm_display_mode *ptr = &drm_dmt_modes[i];
2079 		if (hdisplay && vdisplay) {
2080 			/*
2081 			 * Only when two are valid, they will be used to check
2082 			 * whether the mode should be added to the mode list of
2083 			 * the connector.
2084 			 */
2085 			if (ptr->hdisplay > hdisplay ||
2086 					ptr->vdisplay > vdisplay)
2087 				continue;
2088 		}
2089 		if (drm_mode_vrefresh(ptr) > 61)
2090 			continue;
2091 		mode = drm_mode_duplicate(dev, ptr);
2092 		if (mode) {
2093 			drm_mode_probed_add(connector, mode);
2094 			num_modes++;
2095 		}
2096 	}
2097 	return num_modes;
2098 }
2099 EXPORT_SYMBOL(drm_add_modes_noedid);
2100 
2101 /**
2102  * drm_mode_cea_vic - return the CEA-861 VIC of a given mode
2103  * @mode: mode
2104  *
2105  * RETURNS:
2106  * The VIC number, 0 in case it's not a CEA-861 mode.
2107  */
2108 uint8_t drm_mode_cea_vic(const struct drm_display_mode *mode)
2109 {
2110 	uint8_t i;
2111 
2112 	for (i = 0; i < drm_num_cea_modes; i++)
2113 		if (drm_mode_equal(mode, &edid_cea_modes[i]))
2114 			return i + 1;
2115 
2116 	return 0;
2117 }
2118 EXPORT_SYMBOL(drm_mode_cea_vic);
2119