xref: /OK3568_Linux_fs/u-boot/common/edid.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Copyright (c) 2012 The Chromium OS Authors.
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * (C) Copyright 2010
5*4882a593Smuzhiyun  * Petr Stetiar <ynezz@true.cz>
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * SPDX-License-Identifier:	GPL-2.0+
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * Contains stolen code from ddcprobe project which is:
10*4882a593Smuzhiyun  * Copyright (C) Nalin Dahyabhai <bigfun@pobox.com>
11*4882a593Smuzhiyun  * (C) Copyright 2008-2017 Fuzhou Rockchip Electronics Co., Ltd
12*4882a593Smuzhiyun  */
13*4882a593Smuzhiyun 
14*4882a593Smuzhiyun #include <common.h>
15*4882a593Smuzhiyun #include <compiler.h>
16*4882a593Smuzhiyun #include <div64.h>
17*4882a593Smuzhiyun #include <drm_modes.h>
18*4882a593Smuzhiyun #include <edid.h>
19*4882a593Smuzhiyun #include <errno.h>
20*4882a593Smuzhiyun #include <fdtdec.h>
21*4882a593Smuzhiyun #include <hexdump.h>
22*4882a593Smuzhiyun #include <malloc.h>
23*4882a593Smuzhiyun #include <linux/compat.h>
24*4882a593Smuzhiyun #include <linux/ctype.h>
25*4882a593Smuzhiyun #include <linux/fb.h>
26*4882a593Smuzhiyun #include <linux/hdmi.h>
27*4882a593Smuzhiyun #include <linux/string.h>
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #define EDID_EST_TIMINGS 16
30*4882a593Smuzhiyun #define EDID_STD_TIMINGS 8
31*4882a593Smuzhiyun #define EDID_DETAILED_TIMINGS 4
32*4882a593Smuzhiyun #define BIT_WORD(nr)             ((nr) / BITS_PER_LONG)
33*4882a593Smuzhiyun #define BITMAP_FIRST_WORD_MASK(start) (~0UL << ((start) & (BITS_PER_LONG - 1)))
34*4882a593Smuzhiyun #define BITMAP_LAST_WORD_MASK(nbits) (~0UL >> (-(nbits) & (BITS_PER_LONG - 1)))
35*4882a593Smuzhiyun #define EDID_PRODUCT_ID(e) ((e)->prod_code[0] | ((e)->prod_code[1] << 8))
36*4882a593Smuzhiyun #define version_greater(edid, maj, min) \
37*4882a593Smuzhiyun 	(((edid)->version > (maj)) || \
38*4882a593Smuzhiyun 	 ((edid)->version == (maj) && (edid)->revision > (min)))
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun /*
41*4882a593Smuzhiyun  * EDID blocks out in the wild have a variety of bugs, try to collect
42*4882a593Smuzhiyun  * them here (note that userspace may work around broken monitors first,
43*4882a593Smuzhiyun  * but fixes should make their way here so that the kernel "just works"
44*4882a593Smuzhiyun  * on as many displays as possible).
45*4882a593Smuzhiyun  */
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun /* First detailed mode wrong, use largest 60Hz mode */
48*4882a593Smuzhiyun #define EDID_QUIRK_PREFER_LARGE_60		BIT(0)
49*4882a593Smuzhiyun /* Reported 135MHz pixel clock is too high, needs adjustment */
50*4882a593Smuzhiyun #define EDID_QUIRK_135_CLOCK_TOO_HIGH		BIT(1)
51*4882a593Smuzhiyun /* Prefer the largest mode at 75 Hz */
52*4882a593Smuzhiyun #define EDID_QUIRK_PREFER_LARGE_75		BIT(2)
53*4882a593Smuzhiyun /* Detail timing is in cm not mm */
54*4882a593Smuzhiyun #define EDID_QUIRK_DETAILED_IN_CM		BIT(3)
55*4882a593Smuzhiyun /* Detailed timing descriptors have bogus size values, so just take the
56*4882a593Smuzhiyun  * maximum size and use that.
57*4882a593Smuzhiyun  */
58*4882a593Smuzhiyun #define EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE	BIT(4)
59*4882a593Smuzhiyun /* Monitor forgot to set the first detailed is preferred bit. */
60*4882a593Smuzhiyun #define EDID_QUIRK_FIRST_DETAILED_PREFERRED	BIT(5)
61*4882a593Smuzhiyun /* use +hsync +vsync for detailed mode */
62*4882a593Smuzhiyun #define EDID_QUIRK_DETAILED_SYNC_PP		BIT(6)
63*4882a593Smuzhiyun /* Force reduced-blanking timings for detailed modes */
64*4882a593Smuzhiyun #define EDID_QUIRK_FORCE_REDUCED_BLANKING	BIT(7)
65*4882a593Smuzhiyun /* Force 8bpc */
66*4882a593Smuzhiyun #define EDID_QUIRK_FORCE_8BPC			BIT(8)
67*4882a593Smuzhiyun /* Force 12bpc */
68*4882a593Smuzhiyun #define EDID_QUIRK_FORCE_12BPC			BIT(9)
69*4882a593Smuzhiyun /* Force 6bpc */
70*4882a593Smuzhiyun #define EDID_QUIRK_FORCE_6BPC			BIT(10)
71*4882a593Smuzhiyun /* Force 10bpc */
72*4882a593Smuzhiyun #define EDID_QUIRK_FORCE_10BPC			BIT(11)
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun struct detailed_mode_closure {
75*4882a593Smuzhiyun 	struct edid *edid;
76*4882a593Smuzhiyun 	struct hdmi_edid_data *data;
77*4882a593Smuzhiyun 	bool preferred;
78*4882a593Smuzhiyun 	u32 quirks;
79*4882a593Smuzhiyun 	int modes;
80*4882a593Smuzhiyun };
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun #define LEVEL_DMT	0
83*4882a593Smuzhiyun #define LEVEL_GTF	1
84*4882a593Smuzhiyun #define LEVEL_GTF2	2
85*4882a593Smuzhiyun #define LEVEL_CVT	3
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun static struct edid_quirk {
88*4882a593Smuzhiyun 	char vendor[4];
89*4882a593Smuzhiyun 	int product_id;
90*4882a593Smuzhiyun 	u32 quirks;
91*4882a593Smuzhiyun } edid_quirk_list[] = {
92*4882a593Smuzhiyun 	/* Acer AL1706 */
93*4882a593Smuzhiyun 	{ "ACR", 44358, EDID_QUIRK_PREFER_LARGE_60 },
94*4882a593Smuzhiyun 	/* Acer F51 */
95*4882a593Smuzhiyun 	{ "API", 0x7602, EDID_QUIRK_PREFER_LARGE_60 },
96*4882a593Smuzhiyun 	/* Unknown Acer */
97*4882a593Smuzhiyun 	{ "ACR", 2423, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun 	/* AEO model 0 reports 8 bpc, but is a 6 bpc panel */
100*4882a593Smuzhiyun 	{ "AEO", 0, EDID_QUIRK_FORCE_6BPC },
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun 	/* Belinea 10 15 55 */
103*4882a593Smuzhiyun 	{ "MAX", 1516, EDID_QUIRK_PREFER_LARGE_60 },
104*4882a593Smuzhiyun 	{ "MAX", 0x77e, EDID_QUIRK_PREFER_LARGE_60 },
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 	/* Envision Peripherals, Inc. EN-7100e */
107*4882a593Smuzhiyun 	{ "EPI", 59264, EDID_QUIRK_135_CLOCK_TOO_HIGH },
108*4882a593Smuzhiyun 	/* Envision EN2028 */
109*4882a593Smuzhiyun 	{ "EPI", 8232, EDID_QUIRK_PREFER_LARGE_60 },
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun 	/* Funai Electronics PM36B */
112*4882a593Smuzhiyun 	{ "FCM", 13600, EDID_QUIRK_PREFER_LARGE_75 |
113*4882a593Smuzhiyun 	  EDID_QUIRK_DETAILED_IN_CM },
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun 	/* LGD panel of HP zBook 17 G2, eDP 10 bpc, but reports unknown bpc */
116*4882a593Smuzhiyun 	{ "LGD", 764, EDID_QUIRK_FORCE_10BPC },
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun 	/* LG Philips LCD LP154W01-A5 */
119*4882a593Smuzhiyun 	{ "LPL", 0, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
120*4882a593Smuzhiyun 	{ "LPL", 0x2a00, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 	/* Philips 107p5 CRT */
123*4882a593Smuzhiyun 	{ "PHL", 57364, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun 	/* Proview AY765C */
126*4882a593Smuzhiyun 	{ "PTS", 765, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun 	/* Samsung SyncMaster 205BW.  Note: irony */
129*4882a593Smuzhiyun 	{ "SAM", 541, EDID_QUIRK_DETAILED_SYNC_PP },
130*4882a593Smuzhiyun 	/* Samsung SyncMaster 22[5-6]BW */
131*4882a593Smuzhiyun 	{ "SAM", 596, EDID_QUIRK_PREFER_LARGE_60 },
132*4882a593Smuzhiyun 	{ "SAM", 638, EDID_QUIRK_PREFER_LARGE_60 },
133*4882a593Smuzhiyun 
134*4882a593Smuzhiyun 	/* Sony PVM-2541A does up to 12 bpc, but only reports max 8 bpc */
135*4882a593Smuzhiyun 	{ "SNY", 0x2541, EDID_QUIRK_FORCE_12BPC },
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun 	/* ViewSonic VA2026w */
138*4882a593Smuzhiyun 	{ "VSC", 5020, EDID_QUIRK_FORCE_REDUCED_BLANKING },
139*4882a593Smuzhiyun 
140*4882a593Smuzhiyun 	/* Medion MD 30217 PG */
141*4882a593Smuzhiyun 	{ "MED", 0x7b8, EDID_QUIRK_PREFER_LARGE_75 },
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 	/* Panel in Samsung NP700G7A-S01PL notebook reports 6bpc */
144*4882a593Smuzhiyun 	{ "SEC", 0xd033, EDID_QUIRK_FORCE_8BPC },
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun 	/* Rotel RSX-1058 forwards sink's EDID but only does HDMI 1.1*/
147*4882a593Smuzhiyun 	{ "ETR", 13896, EDID_QUIRK_FORCE_8BPC },
148*4882a593Smuzhiyun };
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun /*
151*4882a593Smuzhiyun  * Probably taken from CEA-861 spec.
152*4882a593Smuzhiyun  * This table is converted from xorg's hw/xfree86/modes/xf86EdidModes.c.
153*4882a593Smuzhiyun  *
154*4882a593Smuzhiyun  * Index using the VIC.
155*4882a593Smuzhiyun  */
156*4882a593Smuzhiyun /*
157*4882a593Smuzhiyun  * From CEA/CTA-861 spec.
158*4882a593Smuzhiyun  * Do not access directly, instead always use cea_mode_for_vic().
159*4882a593Smuzhiyun  */
160*4882a593Smuzhiyun static const struct drm_display_mode edid_cea_modes_1[] = {
161*4882a593Smuzhiyun 	/* 1 - 640x480@60Hz */
162*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
163*4882a593Smuzhiyun 		   752, 800, 480, 490, 492, 525, 0,
164*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
165*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
166*4882a593Smuzhiyun 	/* 2 - 720x480@60Hz */
167*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
168*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
169*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
170*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
171*4882a593Smuzhiyun 	/* 3 - 720x480@60Hz */
172*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
173*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
174*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
175*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
176*4882a593Smuzhiyun 	/* 4 - 1280x720@60Hz */
177*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 1390,
178*4882a593Smuzhiyun 		   1430, 1650, 720, 725, 730, 750, 0,
179*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
180*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
181*4882a593Smuzhiyun 	/* 5 - 1920x1080i@60Hz */
182*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
183*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1094, 1125, 0,
184*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
185*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
186*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
187*4882a593Smuzhiyun 	/* 6 - 720(1440)x480i@60Hz */
188*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
189*4882a593Smuzhiyun 		   801, 858, 480, 488, 494, 525, 0,
190*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
191*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
192*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
193*4882a593Smuzhiyun 	/* 7 - 720(1440)x480i@60Hz */
194*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
195*4882a593Smuzhiyun 		   801, 858, 480, 488, 494, 525, 0,
196*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
197*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
198*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
199*4882a593Smuzhiyun 	/* 8 - 720(1440)x240@60Hz */
200*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
201*4882a593Smuzhiyun 		   801, 858, 240, 244, 247, 262, 0,
202*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
203*4882a593Smuzhiyun 			DRM_MODE_FLAG_DBLCLK),
204*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
205*4882a593Smuzhiyun 	/* 9 - 720(1440)x240@60Hz */
206*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
207*4882a593Smuzhiyun 		   801, 858, 240, 244, 247, 262, 0,
208*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
209*4882a593Smuzhiyun 			DRM_MODE_FLAG_DBLCLK),
210*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
211*4882a593Smuzhiyun 	/* 10 - 2880x480i@60Hz */
212*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
213*4882a593Smuzhiyun 		   3204, 3432, 480, 488, 494, 525, 0,
214*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
215*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
216*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
217*4882a593Smuzhiyun 	/* 11 - 2880x480i@60Hz */
218*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
219*4882a593Smuzhiyun 		   3204, 3432, 480, 488, 494, 525, 0,
220*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
221*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
222*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
223*4882a593Smuzhiyun 	/* 12 - 2880x240@60Hz */
224*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
225*4882a593Smuzhiyun 		   3204, 3432, 240, 244, 247, 262, 0,
226*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
227*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
228*4882a593Smuzhiyun 	/* 13 - 2880x240@60Hz */
229*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
230*4882a593Smuzhiyun 		   3204, 3432, 240, 244, 247, 262, 0,
231*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
232*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
233*4882a593Smuzhiyun 	/* 14 - 1440x480@60Hz */
234*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 1440, 1472,
235*4882a593Smuzhiyun 		   1596, 1716, 480, 489, 495, 525, 0,
236*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
237*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
238*4882a593Smuzhiyun 	/* 15 - 1440x480@60Hz */
239*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 1440, 1472,
240*4882a593Smuzhiyun 		   1596, 1716, 480, 489, 495, 525, 0,
241*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
242*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
243*4882a593Smuzhiyun 	/* 16 - 1920x1080@60Hz */
244*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
245*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
246*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
247*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
248*4882a593Smuzhiyun 	/* 17 - 720x576@50Hz */
249*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
250*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
251*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
252*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
253*4882a593Smuzhiyun 	/* 18 - 720x576@50Hz */
254*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
255*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
256*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
257*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
258*4882a593Smuzhiyun 	/* 19 - 1280x720@50Hz */
259*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 1720,
260*4882a593Smuzhiyun 		   1760, 1980, 720, 725, 730, 750, 0,
261*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
262*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
263*4882a593Smuzhiyun 	/* 20 - 1920x1080i@50Hz */
264*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
265*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1094, 1125, 0,
266*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
267*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
268*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
269*4882a593Smuzhiyun 	/* 21 - 720(1440)x576i@50Hz */
270*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
271*4882a593Smuzhiyun 		   795, 864, 576, 580, 586, 625, 0,
272*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
273*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
274*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
275*4882a593Smuzhiyun 	/* 22 - 720(1440)x576i@50Hz */
276*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
277*4882a593Smuzhiyun 		   795, 864, 576, 580, 586, 625, 0,
278*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
279*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
280*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
281*4882a593Smuzhiyun 	/* 23 - 720(1440)x288@50Hz */
282*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
283*4882a593Smuzhiyun 		   795, 864, 288, 290, 293, 312, 0,
284*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
285*4882a593Smuzhiyun 			DRM_MODE_FLAG_DBLCLK),
286*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
287*4882a593Smuzhiyun 	/* 24 - 720(1440)x288@50Hz */
288*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
289*4882a593Smuzhiyun 		   795, 864, 288, 290, 293, 312, 0,
290*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
291*4882a593Smuzhiyun 			DRM_MODE_FLAG_DBLCLK),
292*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
293*4882a593Smuzhiyun 	/* 25 - 2880x576i@50Hz */
294*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
295*4882a593Smuzhiyun 		   3180, 3456, 576, 580, 586, 625, 0,
296*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
297*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
298*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
299*4882a593Smuzhiyun 	/* 26 - 2880x576i@50Hz */
300*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
301*4882a593Smuzhiyun 		   3180, 3456, 576, 580, 586, 625, 0,
302*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
303*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
304*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
305*4882a593Smuzhiyun 	/* 27 - 2880x288@50Hz */
306*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
307*4882a593Smuzhiyun 		   3180, 3456, 288, 290, 293, 312, 0,
308*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
309*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
310*4882a593Smuzhiyun 	/* 28 - 2880x288@50Hz */
311*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
312*4882a593Smuzhiyun 		   3180, 3456, 288, 290, 293, 312, 0,
313*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
314*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
315*4882a593Smuzhiyun 	/* 29 - 1440x576@50Hz */
316*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
317*4882a593Smuzhiyun 		   1592, 1728, 576, 581, 586, 625, 0,
318*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
319*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
320*4882a593Smuzhiyun 	/* 30 - 1440x576@50Hz */
321*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
322*4882a593Smuzhiyun 		   1592, 1728, 576, 581, 586, 625, 0,
323*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
324*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
325*4882a593Smuzhiyun 	/* 31 - 1920x1080@50Hz */
326*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
327*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
328*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
329*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
330*4882a593Smuzhiyun 	/* 32 - 1920x1080@24Hz */
331*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2558,
332*4882a593Smuzhiyun 		   2602, 2750, 1080, 1084, 1089, 1125, 0,
333*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
334*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
335*4882a593Smuzhiyun 	/* 33 - 1920x1080@25Hz */
336*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
337*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
338*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
339*4882a593Smuzhiyun 	  .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
340*4882a593Smuzhiyun 	/* 34 - 1920x1080@30Hz */
341*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
342*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
343*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
344*4882a593Smuzhiyun 	  .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
345*4882a593Smuzhiyun 	/* 35 - 2880x480@60Hz */
346*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 2880, 2944,
347*4882a593Smuzhiyun 		   3192, 3432, 480, 489, 495, 525, 0,
348*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
349*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
350*4882a593Smuzhiyun 	/* 36 - 2880x480@60Hz */
351*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 2880, 2944,
352*4882a593Smuzhiyun 		   3192, 3432, 480, 489, 495, 525, 0,
353*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
354*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
355*4882a593Smuzhiyun 	/* 37 - 2880x576@50Hz */
356*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 2880, 2928,
357*4882a593Smuzhiyun 		   3184, 3456, 576, 581, 586, 625, 0,
358*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
359*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
360*4882a593Smuzhiyun 	/* 38 - 2880x576@50Hz */
361*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 2880, 2928,
362*4882a593Smuzhiyun 		   3184, 3456, 576, 581, 586, 625, 0,
363*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
364*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
365*4882a593Smuzhiyun 	/* 39 - 1920x1080i@50Hz */
366*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 72000, 1920, 1952,
367*4882a593Smuzhiyun 		   2120, 2304, 1080, 1126, 1136, 1250, 0,
368*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC |
369*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
370*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
371*4882a593Smuzhiyun 	/* 40 - 1920x1080i@100Hz */
372*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
373*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1094, 1125, 0,
374*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
375*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
376*4882a593Smuzhiyun 	  .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
377*4882a593Smuzhiyun 	/* 41 - 1280x720@100Hz */
378*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1280, 1720,
379*4882a593Smuzhiyun 		   1760, 1980, 720, 725, 730, 750, 0,
380*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
381*4882a593Smuzhiyun 	  .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
382*4882a593Smuzhiyun 	/* 42 - 720x576@100Hz */
383*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
384*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
385*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
386*4882a593Smuzhiyun 	  .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
387*4882a593Smuzhiyun 	/* 43 - 720x576@100Hz */
388*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
389*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
390*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
391*4882a593Smuzhiyun 	  .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
392*4882a593Smuzhiyun 	/* 44 - 720(1440)x576i@100Hz */
393*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
394*4882a593Smuzhiyun 		   795, 864, 576, 580, 586, 625, 0,
395*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
396*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
397*4882a593Smuzhiyun 	  .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
398*4882a593Smuzhiyun 	/* 45 - 720(1440)x576i@100Hz */
399*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
400*4882a593Smuzhiyun 		   795, 864, 576, 580, 586, 625, 0,
401*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
402*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
403*4882a593Smuzhiyun 	  .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
404*4882a593Smuzhiyun 	/* 46 - 1920x1080i@120Hz */
405*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
406*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1094, 1125, 0,
407*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
408*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE),
409*4882a593Smuzhiyun 	  .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
410*4882a593Smuzhiyun 	/* 47 - 1280x720@120Hz */
411*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1280, 1390,
412*4882a593Smuzhiyun 		   1430, 1650, 720, 725, 730, 750, 0,
413*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
414*4882a593Smuzhiyun 	  .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
415*4882a593Smuzhiyun 	/* 48 - 720x480@120Hz */
416*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 736,
417*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
418*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
419*4882a593Smuzhiyun 	  .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
420*4882a593Smuzhiyun 	/* 49 - 720x480@120Hz */
421*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 736,
422*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
423*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
424*4882a593Smuzhiyun 	  .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
425*4882a593Smuzhiyun 	/* 50 - 720(1440)x480i@120Hz */
426*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 739,
427*4882a593Smuzhiyun 		   801, 858, 480, 488, 494, 525, 0,
428*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
429*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
430*4882a593Smuzhiyun 	  .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
431*4882a593Smuzhiyun 	/* 51 - 720(1440)x480i@120Hz */
432*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 739,
433*4882a593Smuzhiyun 		   801, 858, 480, 488, 494, 525, 0,
434*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
435*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
436*4882a593Smuzhiyun 	  .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
437*4882a593Smuzhiyun 	/* 52 - 720x576@200Hz */
438*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 720, 732,
439*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
440*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
441*4882a593Smuzhiyun 	  .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
442*4882a593Smuzhiyun 	/* 53 - 720x576@200Hz */
443*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 720, 732,
444*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
445*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
446*4882a593Smuzhiyun 	  .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
447*4882a593Smuzhiyun 	/* 54 - 720(1440)x576i@200Hz */
448*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
449*4882a593Smuzhiyun 		   795, 864, 576, 580, 586, 625, 0,
450*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
451*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
452*4882a593Smuzhiyun 	  .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
453*4882a593Smuzhiyun 	/* 55 - 720(1440)x576i@200Hz */
454*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
455*4882a593Smuzhiyun 		   795, 864, 576, 580, 586, 625, 0,
456*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
457*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
458*4882a593Smuzhiyun 	  .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
459*4882a593Smuzhiyun 	/* 56 - 720x480@240Hz */
460*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 720, 736,
461*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
462*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
463*4882a593Smuzhiyun 	  .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
464*4882a593Smuzhiyun 	/* 57 - 720x480@240Hz */
465*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 720, 736,
466*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
467*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
468*4882a593Smuzhiyun 	  .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
469*4882a593Smuzhiyun 	/* 58 - 720(1440)x480i@240 */
470*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 739,
471*4882a593Smuzhiyun 		   801, 858, 480, 488, 494, 525, 0,
472*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
473*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
474*4882a593Smuzhiyun 	  .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
475*4882a593Smuzhiyun 	/* 59 - 720(1440)x480i@240 */
476*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 54000, 720, 739,
477*4882a593Smuzhiyun 		   801, 858, 480, 488, 494, 525, 0,
478*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
479*4882a593Smuzhiyun 			DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
480*4882a593Smuzhiyun 	  .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
481*4882a593Smuzhiyun 	/* 60 - 1280x720@24Hz */
482*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 59400, 1280, 3040,
483*4882a593Smuzhiyun 		   3080, 3300, 720, 725, 730, 750, 0,
484*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
485*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
486*4882a593Smuzhiyun 	/* 61 - 1280x720@25Hz */
487*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 3700,
488*4882a593Smuzhiyun 		   3740, 3960, 720, 725, 730, 750, 0,
489*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
490*4882a593Smuzhiyun 	  .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
491*4882a593Smuzhiyun 	/* 62 - 1280x720@30Hz */
492*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 3040,
493*4882a593Smuzhiyun 		   3080, 3300, 720, 725, 730, 750, 0,
494*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
495*4882a593Smuzhiyun 	  .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
496*4882a593Smuzhiyun 	/* 63 - 1920x1080@120Hz */
497*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 1920, 2008,
498*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
499*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
500*4882a593Smuzhiyun 	 .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
501*4882a593Smuzhiyun 	/* 64 - 1920x1080@100Hz */
502*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 1920, 2448,
503*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
504*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
505*4882a593Smuzhiyun 	 .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
506*4882a593Smuzhiyun 	/* 65 - 1280x720@24Hz */
507*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 59400, 1280, 3040,
508*4882a593Smuzhiyun 		   3080, 3300, 720, 725, 730, 750, 0,
509*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
510*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
511*4882a593Smuzhiyun 	/* 66 - 1280x720@25Hz */
512*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 3700,
513*4882a593Smuzhiyun 		   3740, 3960, 720, 725, 730, 750, 0,
514*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
515*4882a593Smuzhiyun 	  .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
516*4882a593Smuzhiyun 	/* 67 - 1280x720@30Hz */
517*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 3040,
518*4882a593Smuzhiyun 		   3080, 3300, 720, 725, 730, 750, 0,
519*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
520*4882a593Smuzhiyun 	  .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
521*4882a593Smuzhiyun 	/* 68 - 1280x720@50Hz */
522*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 1720,
523*4882a593Smuzhiyun 		   1760, 1980, 720, 725, 730, 750, 0,
524*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
525*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
526*4882a593Smuzhiyun 	/* 69 - 1280x720@60Hz */
527*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 1390,
528*4882a593Smuzhiyun 		   1430, 1650, 720, 725, 730, 750, 0,
529*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
530*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
531*4882a593Smuzhiyun 	/* 70 - 1280x720@100Hz */
532*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1280, 1720,
533*4882a593Smuzhiyun 		   1760, 1980, 720, 725, 730, 750, 0,
534*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
535*4882a593Smuzhiyun 	  .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
536*4882a593Smuzhiyun 	/* 71 - 1280x720@120Hz */
537*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1280, 1390,
538*4882a593Smuzhiyun 		   1430, 1650, 720, 725, 730, 750, 0,
539*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
540*4882a593Smuzhiyun 	  .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
541*4882a593Smuzhiyun 	/* 72 - 1920x1080@24Hz */
542*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2558,
543*4882a593Smuzhiyun 		   2602, 2750, 1080, 1084, 1089, 1125, 0,
544*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
545*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
546*4882a593Smuzhiyun 	/* 73 - 1920x1080@25Hz */
547*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
548*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
549*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
550*4882a593Smuzhiyun 	  .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
551*4882a593Smuzhiyun 	/* 74 - 1920x1080@30Hz */
552*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
553*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
554*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
555*4882a593Smuzhiyun 	  .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
556*4882a593Smuzhiyun 	/* 75 - 1920x1080@50Hz */
557*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
558*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
559*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
560*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
561*4882a593Smuzhiyun 	/* 76 - 1920x1080@60Hz */
562*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
563*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
564*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
565*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
566*4882a593Smuzhiyun 	/* 77 - 1920x1080@100Hz */
567*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 1920, 2448,
568*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
569*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
570*4882a593Smuzhiyun 	 .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
571*4882a593Smuzhiyun 	/* 78 - 1920x1080@120Hz */
572*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 1920, 2008,
573*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
574*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
575*4882a593Smuzhiyun 	 .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
576*4882a593Smuzhiyun 	/* 79 - 1680x720@24Hz */
577*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 59400, 1680, 3040,
578*4882a593Smuzhiyun 		   3080, 3300, 720, 725, 730, 750, 0,
579*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
580*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
581*4882a593Smuzhiyun 	/* 80 - 1680x720@25Hz */
582*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 59400, 1680, 2908,
583*4882a593Smuzhiyun 		   2948, 3168, 720, 725, 730, 750, 0,
584*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
585*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
586*4882a593Smuzhiyun 	/* 81 - 1680x720@30Hz */
587*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 59400, 1680, 2380,
588*4882a593Smuzhiyun 		   2420, 2640, 720, 725, 730, 750, 0,
589*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
590*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
591*4882a593Smuzhiyun 	/* 82 - 1680x720@50Hz */
592*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 82500, 1680, 1940,
593*4882a593Smuzhiyun 		   1980, 2200, 720, 725, 730, 750, 0,
594*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
595*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
596*4882a593Smuzhiyun 	/* 83 - 1680x720@60Hz */
597*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 99000, 1680, 1940,
598*4882a593Smuzhiyun 		   1980, 2200, 720, 725, 730, 750, 0,
599*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
600*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
601*4882a593Smuzhiyun 	/* 84 - 1680x720@100Hz */
602*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 165000, 1680, 1740,
603*4882a593Smuzhiyun 		   1780, 2000, 720, 725, 730, 825, 0,
604*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
605*4882a593Smuzhiyun 	.vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
606*4882a593Smuzhiyun 	/* 85 - 1680x720@120Hz */
607*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 198000, 1680, 1740,
608*4882a593Smuzhiyun 		   1780, 2000, 720, 725, 730, 825, 0,
609*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
610*4882a593Smuzhiyun 	.vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
611*4882a593Smuzhiyun 	/* 86 - 2560x1080@24Hz */
612*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 99000, 2560, 3558,
613*4882a593Smuzhiyun 		   3602, 3750, 1080, 1084, 1089, 1100, 0,
614*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
615*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
616*4882a593Smuzhiyun 	/* 87 - 2560x1080@25Hz */
617*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 90000, 2560, 3008,
618*4882a593Smuzhiyun 		   3052, 3200, 1080, 1084, 1089, 1125, 0,
619*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
620*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
621*4882a593Smuzhiyun 	/* 88 - 2560x1080@30Hz */
622*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 118800, 2560, 3328,
623*4882a593Smuzhiyun 		   3372, 3520, 1080, 1084, 1089, 1125, 0,
624*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
625*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
626*4882a593Smuzhiyun 	/* 89 - 2560x1080@50Hz */
627*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 185625, 2560, 3108,
628*4882a593Smuzhiyun 		   3152, 3300, 1080, 1084, 1089, 1125, 0,
629*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
630*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
631*4882a593Smuzhiyun 	/* 90 - 2560x1080@60Hz */
632*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 198000, 2560, 2808,
633*4882a593Smuzhiyun 		   2852, 3000, 1080, 1084, 1089, 1100, 0,
634*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
635*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
636*4882a593Smuzhiyun 	/* 91 - 2560x1080@100Hz */
637*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 371250, 2560, 2778,
638*4882a593Smuzhiyun 		   2822, 2970, 1080, 1084, 1089, 1250, 0,
639*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
640*4882a593Smuzhiyun 	.vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
641*4882a593Smuzhiyun 	/* 92 - 2560x1080@120Hz */
642*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 495000, 2560, 3108,
643*4882a593Smuzhiyun 		   3152, 3300, 1080, 1084, 1089, 1250, 0,
644*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
645*4882a593Smuzhiyun 	.vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
646*4882a593Smuzhiyun 	/* 93 - 3840x2160p@24Hz 16:9 */
647*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 5116,
648*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
649*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
650*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
651*4882a593Smuzhiyun 	/* 94 - 3840x2160p@25Hz 16:9 */
652*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 4896,
653*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
654*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
655*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
656*4882a593Smuzhiyun 	/* 95 - 3840x2160p@30Hz 16:9 */
657*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 4016,
658*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
659*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
660*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
661*4882a593Smuzhiyun 	/* 96 - 3840x2160p@50Hz 16:9 */
662*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 4896,
663*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
664*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
665*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
666*4882a593Smuzhiyun 	/* 97 - 3840x2160p@60Hz 16:9 */
667*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 4016,
668*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
669*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
670*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
671*4882a593Smuzhiyun 	/* 98 - 4096x2160p@24Hz 256:135 */
672*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 4096, 5116,
673*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
674*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
675*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
676*4882a593Smuzhiyun 	/* 99 - 4096x2160p@25Hz 256:135 */
677*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 4096, 5064,
678*4882a593Smuzhiyun 		   5152, 5280, 2160, 2168, 2178, 2250, 0,
679*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
680*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
681*4882a593Smuzhiyun 	/* 100 - 4096x2160p@30Hz 256:135 */
682*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 4096, 4184,
683*4882a593Smuzhiyun 		   4272, 4400, 2160, 2168, 2178, 2250, 0,
684*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
685*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
686*4882a593Smuzhiyun 	/* 101 - 4096x2160p@50Hz 256:135 */
687*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 4096, 5064,
688*4882a593Smuzhiyun 		   5152, 5280, 2160, 2168, 2178, 2250, 0,
689*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
690*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
691*4882a593Smuzhiyun 	/* 102 - 4096x2160p@60Hz 256:135 */
692*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 4096, 4184,
693*4882a593Smuzhiyun 		   4272, 4400, 2160, 2168, 2178, 2250, 0,
694*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
695*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
696*4882a593Smuzhiyun 	/* 103 - 3840x2160p@24Hz 64:27 */
697*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 5116,
698*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
699*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
700*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
701*4882a593Smuzhiyun 	/* 104 - 3840x2160p@25Hz 64:27 */
702*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 4016,
703*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
704*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
705*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
706*4882a593Smuzhiyun 	/* 105 - 3840x2160p@30Hz 64:27 */
707*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 4016,
708*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
709*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
710*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
711*4882a593Smuzhiyun 	/* 106 - 3840x2160p@50Hz 64:27 */
712*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 4896,
713*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
714*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
715*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
716*4882a593Smuzhiyun 	/* 107 - 3840x2160p@60Hz 64:27 */
717*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 4016,
718*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
719*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
720*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
721*4882a593Smuzhiyun 	/* 108 - 1280x720@48Hz 16:9 */
722*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 90000, 1280, 2240,
723*4882a593Smuzhiyun 		   2280, 2500, 720, 725, 730, 750, 0,
724*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
725*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
726*4882a593Smuzhiyun 	/* 109 - 1280x720@48Hz 64:27 */
727*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 90000, 1280, 2240,
728*4882a593Smuzhiyun 		   2280, 2500, 720, 725, 730, 750, 0,
729*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
730*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
731*4882a593Smuzhiyun 	/* 110 - 1680x720@48Hz 64:27 */
732*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 99000, 1680, 2490,
733*4882a593Smuzhiyun 		   2530, 2750, 720, 725, 730, 750, 0,
734*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
735*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
736*4882a593Smuzhiyun 	/* 111 - 1920x1080@48Hz 16:9 */
737*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2558,
738*4882a593Smuzhiyun 		   2602, 2750, 1080, 1084, 1089, 1125, 0,
739*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
740*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
741*4882a593Smuzhiyun 	/* 112 - 1920x1080@48Hz 64:27 */
742*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2558,
743*4882a593Smuzhiyun 		   2602, 2750, 1080, 1084, 1089, 1125, 0,
744*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
745*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
746*4882a593Smuzhiyun 	/* 113 - 2560x1080@48Hz 64:27 */
747*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 198000, 2560, 3558,
748*4882a593Smuzhiyun 		   3602, 3750, 1080, 1084, 1089, 1100, 0,
749*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
750*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
751*4882a593Smuzhiyun 	/* 114 - 3840x2160@48Hz 16:9 */
752*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 5116,
753*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
754*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
755*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
756*4882a593Smuzhiyun 	/* 115 - 4096x2160@48Hz 256:135 */
757*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 4096, 5116,
758*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
759*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
760*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
761*4882a593Smuzhiyun 	/* 116 - 3840x2160@48Hz 64:27 */
762*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 5116,
763*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
764*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
765*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
766*4882a593Smuzhiyun 	/* 117 - 3840x2160@100Hz 16:9 */
767*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 3840, 4896,
768*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
769*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
770*4882a593Smuzhiyun 	.vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
771*4882a593Smuzhiyun 	/* 118 - 3840x2160@120Hz 16:9 */
772*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 3840, 4016,
773*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
774*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
775*4882a593Smuzhiyun 	.vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
776*4882a593Smuzhiyun 	/* 119 - 3840x2160@100Hz 64:27 */
777*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 3840, 4896,
778*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
779*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
780*4882a593Smuzhiyun 	.vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
781*4882a593Smuzhiyun 	/* 120 - 3840x2160@120Hz 64:27 */
782*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 3840, 4016,
783*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
784*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
785*4882a593Smuzhiyun 	.vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
786*4882a593Smuzhiyun 	/* 121 - 5120x2160@24Hz 64:27 */
787*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 396000, 5120, 7116,
788*4882a593Smuzhiyun 		   7204, 7500, 2160, 2168, 2178, 2200, 0,
789*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
790*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
791*4882a593Smuzhiyun 	/* 122 - 5120x2160@25Hz 64:27 */
792*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 396000, 5120, 6816,
793*4882a593Smuzhiyun 		   6904, 7200, 2160, 2168, 2178, 2200, 0,
794*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
795*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
796*4882a593Smuzhiyun 	/* 123 - 5120x2160@30Hz 64:27 */
797*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 396000, 5120, 5784,
798*4882a593Smuzhiyun 		   5872, 6000, 2160, 2168, 2178, 2200, 0,
799*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
800*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
801*4882a593Smuzhiyun 	/* 124 - 5120x2160@48Hz 64:27 */
802*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 742500, 5120, 5866,
803*4882a593Smuzhiyun 		   5954, 6250, 2160, 2168, 2178, 2475, 0,
804*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
805*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
806*4882a593Smuzhiyun 	/* 125 - 5120x2160@50Hz 64:27 */
807*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 742500, 5120, 6216,
808*4882a593Smuzhiyun 		   6304, 6600, 2160, 2168, 2178, 2250, 0,
809*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
810*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
811*4882a593Smuzhiyun 	/* 126 - 5120x2160@60Hz 64:27 */
812*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 742500, 5120, 5284,
813*4882a593Smuzhiyun 		   5372, 5500, 2160, 2168, 2178, 2250, 0,
814*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
815*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
816*4882a593Smuzhiyun 	/* 127 - 5120x2160@100Hz 64:27 */
817*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1485000, 5120, 6216,
818*4882a593Smuzhiyun 		   6304, 6600, 2160, 2168, 2178, 2250, 0,
819*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
820*4882a593Smuzhiyun 	.vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
821*4882a593Smuzhiyun };
822*4882a593Smuzhiyun 
823*4882a593Smuzhiyun static const struct drm_display_mode edid_cea_modes_193[] = {
824*4882a593Smuzhiyun 	/* 193 - 5120x2160@120Hz 64:27 */
825*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1485000, 5120, 5284,
826*4882a593Smuzhiyun 		   5372, 5500, 2160, 2168, 2178, 2250, 0,
827*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
828*4882a593Smuzhiyun 	  .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
829*4882a593Smuzhiyun 	/* 194 - 7680x4320@24Hz 16:9 */
830*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 7680, 10232,
831*4882a593Smuzhiyun 		   10408, 11000, 4320, 4336, 4356, 4500, 0,
832*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
833*4882a593Smuzhiyun 	 .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
834*4882a593Smuzhiyun 	/* 195 - 7680x4320@25Hz 16:9 */
835*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 7680, 10032,
836*4882a593Smuzhiyun 		   10208, 10800, 4320, 4336, 4356, 4400, 0,
837*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
838*4882a593Smuzhiyun 	 .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
839*4882a593Smuzhiyun 	/* 196 - 7680x4320@30Hz 16:9 */
840*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 7680, 8232,
841*4882a593Smuzhiyun 		   8408, 9000, 4320, 4336, 4356, 4400, 0,
842*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
843*4882a593Smuzhiyun 	 .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
844*4882a593Smuzhiyun 	/* 197 - 7680x4320@48Hz 16:9 */
845*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 10232,
846*4882a593Smuzhiyun 		   10408, 11000, 4320, 4336, 4356, 4500, 0,
847*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
848*4882a593Smuzhiyun 	 .vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
849*4882a593Smuzhiyun 	/* 198 - 7680x4320@50Hz 16:9 */
850*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 10032,
851*4882a593Smuzhiyun 		   10208, 10800, 4320, 4336, 4356, 4400, 0,
852*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
853*4882a593Smuzhiyun 	 .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
854*4882a593Smuzhiyun 	/* 199 - 7680x4320@60Hz 16:9 */
855*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 8232,
856*4882a593Smuzhiyun 		   8408, 9000, 4320, 4336, 4356, 4400, 0,
857*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
858*4882a593Smuzhiyun 	 .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
859*4882a593Smuzhiyun 	/* 200 - 7680x4320@100Hz 16:9 */
860*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 4752000, 7680, 9792,
861*4882a593Smuzhiyun 		   9968, 10560, 4320, 4336, 4356, 4500, 0,
862*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
863*4882a593Smuzhiyun 	 .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
864*4882a593Smuzhiyun 	/* 201 - 7680x4320@120Hz 16:9 */
865*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 4752000, 7680, 8032,
866*4882a593Smuzhiyun 		   8208, 8800, 4320, 4336, 4356, 4500, 0,
867*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
868*4882a593Smuzhiyun 	 .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
869*4882a593Smuzhiyun 	/* 202 - 7680x4320@24Hz 64:27 */
870*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 7680, 10232,
871*4882a593Smuzhiyun 		   10408, 11000, 4320, 4336, 4356, 4500, 0,
872*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
873*4882a593Smuzhiyun 	.vrefresh = 24,  .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
874*4882a593Smuzhiyun 	/* 203 - 7680x4320@25Hz 64:27 */
875*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 7680, 10032,
876*4882a593Smuzhiyun 		   10208, 10800, 4320, 4336, 4356, 4400, 0,
877*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
878*4882a593Smuzhiyun 	.vrefresh = 25,  .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
879*4882a593Smuzhiyun 	/* 204 - 7680x4320@30Hz 64:27 */
880*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 7680, 8232,
881*4882a593Smuzhiyun 		   8408, 9000, 4320, 4336, 4356, 4400, 0,
882*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
883*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
884*4882a593Smuzhiyun 	/* 205 - 7680x4320@48Hz 64:27 */
885*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 10232,
886*4882a593Smuzhiyun 		   10408, 11000, 4320, 4336, 4356, 4500, 0,
887*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
888*4882a593Smuzhiyun 	.vrefresh = 48,  .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
889*4882a593Smuzhiyun 	/* 206 - 7680x4320@50Hz 64:27 */
890*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 10032,
891*4882a593Smuzhiyun 		   10208, 10800, 4320, 4336, 4356, 4400, 0,
892*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
893*4882a593Smuzhiyun 	.vrefresh = 50,  .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
894*4882a593Smuzhiyun 	/* 207 - 7680x4320@60Hz 64:27 */
895*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 8232,
896*4882a593Smuzhiyun 		   8408, 9000, 4320, 4336, 4356, 4400, 0,
897*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
898*4882a593Smuzhiyun 	.vrefresh = 60,  .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
899*4882a593Smuzhiyun 	/* 208 - 7680x4320@100Hz 64:27 */
900*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 4752000, 7680, 9792,
901*4882a593Smuzhiyun 		   9968, 10560, 4320, 4336, 4356, 4500, 0,
902*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
903*4882a593Smuzhiyun 	.vrefresh = 100,  .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
904*4882a593Smuzhiyun 	/* 209 - 7680x4320@120Hz 64:27 */
905*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 4752000, 7680, 8032,
906*4882a593Smuzhiyun 		   8208, 8800, 4320, 4336, 4356, 4500, 0,
907*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
908*4882a593Smuzhiyun 	.vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
909*4882a593Smuzhiyun 	/* 210 - 10240x4320@24Hz 64:27 */
910*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1485000, 10240, 11732,
911*4882a593Smuzhiyun 		   11908, 12500, 4320, 4336, 4356, 4950, 0,
912*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
913*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
914*4882a593Smuzhiyun 	/* 211 - 10240x4320@25Hz 64:27 */
915*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1485000, 10240, 12732,
916*4882a593Smuzhiyun 		   12908, 13500, 4320, 4336, 4356, 4400, 0,
917*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
918*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
919*4882a593Smuzhiyun 	/* 212 - 10240x4320@30Hz 64:27 */
920*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1485000, 10240, 10528,
921*4882a593Smuzhiyun 		   10704, 11000, 4320, 4336, 4356, 4500, 0,
922*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
923*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
924*4882a593Smuzhiyun 	/* 213 - 10240x4320@48Hz 64:27 */
925*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2970000, 10240, 11732,
926*4882a593Smuzhiyun 		   11908, 12500, 4320, 4336, 4356, 4950, 0,
927*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
928*4882a593Smuzhiyun 	.vrefresh = 48, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
929*4882a593Smuzhiyun 	/* 214 - 10240x4320@50Hz 64:27 */
930*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2970000, 10240, 12732,
931*4882a593Smuzhiyun 		   12908, 13500, 4320, 4336, 4356, 4400, 0,
932*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
933*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
934*4882a593Smuzhiyun 	/* 215 - 10240x4320@60Hz 64:27 */
935*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2970000, 10240, 10528,
936*4882a593Smuzhiyun 		   10704, 11000, 4320, 4336, 4356, 4500, 0,
937*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
938*4882a593Smuzhiyun 	 .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
939*4882a593Smuzhiyun 	/* 216 - 10240x4320@100Hz 64:27 */
940*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 5940000, 10240, 12432,
941*4882a593Smuzhiyun 		   12608, 13200, 4320, 4336, 4356, 4500, 0,
942*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
943*4882a593Smuzhiyun 	 .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
944*4882a593Smuzhiyun 	/* 217 - 10240x4320@120Hz 64:27 */
945*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 5940000, 10240, 10528,
946*4882a593Smuzhiyun 		   10704, 11000, 4320, 4336, 4356, 4500, 0,
947*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
948*4882a593Smuzhiyun 	 .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_64_27, },
949*4882a593Smuzhiyun 	/* 218 - 4096x2160@100Hz 256:135 */
950*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 4096, 4896,
951*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
952*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
953*4882a593Smuzhiyun 	 .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
954*4882a593Smuzhiyun 	/* 219 - 4096x2160@120Hz 256:135 */
955*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 4096, 4184,
956*4882a593Smuzhiyun 		   4272, 4400, 2160, 2168, 2178, 2250, 0,
957*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
958*4882a593Smuzhiyun 	 .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
959*4882a593Smuzhiyun };
960*4882a593Smuzhiyun 
961*4882a593Smuzhiyun /*
962*4882a593Smuzhiyun  * HDMI 1.4 4k modes. Index using the VIC.
963*4882a593Smuzhiyun  */
964*4882a593Smuzhiyun static const struct drm_display_mode edid_4k_modes[] = {
965*4882a593Smuzhiyun 	/* 0 - dummy, VICs start at 1 */
966*4882a593Smuzhiyun 	{ },
967*4882a593Smuzhiyun 	/* 1 - 3840x2160@30Hz */
968*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000,
969*4882a593Smuzhiyun 		   3840, 4016, 4104, 4400,
970*4882a593Smuzhiyun 		   2160, 2168, 2178, 2250, 0,
971*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
972*4882a593Smuzhiyun 	  .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
973*4882a593Smuzhiyun 	/* 2 - 3840x2160@25Hz */
974*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000,
975*4882a593Smuzhiyun 		   3840, 4896, 4984, 5280,
976*4882a593Smuzhiyun 		   2160, 2168, 2178, 2250, 0,
977*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
978*4882a593Smuzhiyun 	  .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
979*4882a593Smuzhiyun 	/* 3 - 3840x2160@24Hz */
980*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000,
981*4882a593Smuzhiyun 		   3840, 5116, 5204, 5500,
982*4882a593Smuzhiyun 		   2160, 2168, 2178, 2250, 0,
983*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
984*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
985*4882a593Smuzhiyun 	/* 4 - 4096x2160@24Hz (SMPTE) */
986*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000,
987*4882a593Smuzhiyun 		   4096, 5116, 5204, 5500,
988*4882a593Smuzhiyun 		   2160, 2168, 2178, 2250, 0,
989*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
990*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
991*4882a593Smuzhiyun };
992*4882a593Smuzhiyun 
993*4882a593Smuzhiyun /*
994*4882a593Smuzhiyun  * Autogenerated from the DMT spec.
995*4882a593Smuzhiyun  * This table is copied from xfree86/modes/xf86EdidModes.c.
996*4882a593Smuzhiyun  */
997*4882a593Smuzhiyun static const struct drm_display_mode drm_dmt_modes[] = {
998*4882a593Smuzhiyun 	/* 0x01 - 640x350@85Hz */
999*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 31500, 640, 672,
1000*4882a593Smuzhiyun 		   736, 832, 350, 382, 385, 445, 0,
1001*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1002*4882a593Smuzhiyun 	/* 0x02 - 640x400@85Hz */
1003*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 31500, 640, 672,
1004*4882a593Smuzhiyun 		   736, 832, 400, 401, 404, 445, 0,
1005*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1006*4882a593Smuzhiyun 	/* 0x03 - 720x400@85Hz */
1007*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 35500, 720, 756,
1008*4882a593Smuzhiyun 		   828, 936, 400, 401, 404, 446, 0,
1009*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1010*4882a593Smuzhiyun 	/* 0x04 - 640x480@60Hz */
1011*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
1012*4882a593Smuzhiyun 		   752, 800, 480, 490, 492, 525, 0,
1013*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1014*4882a593Smuzhiyun 	/* 0x05 - 640x480@72Hz */
1015*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 31500, 640, 664,
1016*4882a593Smuzhiyun 		   704, 832, 480, 489, 492, 520, 0,
1017*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1018*4882a593Smuzhiyun 	/* 0x06 - 640x480@75Hz */
1019*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 31500, 640, 656,
1020*4882a593Smuzhiyun 		   720, 840, 480, 481, 484, 500, 0,
1021*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1022*4882a593Smuzhiyun 	/* 0x07 - 640x480@85Hz */
1023*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 36000, 640, 696,
1024*4882a593Smuzhiyun 		   752, 832, 480, 481, 484, 509, 0,
1025*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1026*4882a593Smuzhiyun 	/* 0x08 - 800x600@56Hz */
1027*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 36000, 800, 824,
1028*4882a593Smuzhiyun 		   896, 1024, 600, 601, 603, 625, 0,
1029*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1030*4882a593Smuzhiyun 	/* 0x09 - 800x600@60Hz */
1031*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
1032*4882a593Smuzhiyun 		   968, 1056, 600, 601, 605, 628, 0,
1033*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1034*4882a593Smuzhiyun 	/* 0x0a - 800x600@72Hz */
1035*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 50000, 800, 856,
1036*4882a593Smuzhiyun 		   976, 1040, 600, 637, 643, 666, 0,
1037*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1038*4882a593Smuzhiyun 	/* 0x0b - 800x600@75Hz */
1039*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 49500, 800, 816,
1040*4882a593Smuzhiyun 		   896, 1056, 600, 601, 604, 625, 0,
1041*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1042*4882a593Smuzhiyun 	/* 0x0c - 800x600@85Hz */
1043*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 56250, 800, 832,
1044*4882a593Smuzhiyun 		   896, 1048, 600, 601, 604, 631, 0,
1045*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1046*4882a593Smuzhiyun 	/* 0x0d - 800x600@120Hz RB */
1047*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 73250, 800, 848,
1048*4882a593Smuzhiyun 		   880, 960, 600, 603, 607, 636, 0,
1049*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1050*4882a593Smuzhiyun 	/* 0x0e - 848x480@60Hz */
1051*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 33750, 848, 864,
1052*4882a593Smuzhiyun 		   976, 1088, 480, 486, 494, 517, 0,
1053*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1054*4882a593Smuzhiyun 	/* 0x0f - 1024x768@43Hz, interlace */
1055*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 44900, 1024, 1032,
1056*4882a593Smuzhiyun 		   1208, 1264, 768, 768, 772, 817, 0,
1057*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
1058*4882a593Smuzhiyun 		   DRM_MODE_FLAG_INTERLACE) },
1059*4882a593Smuzhiyun 	/* 0x10 - 1024x768@60Hz */
1060*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
1061*4882a593Smuzhiyun 		   1184, 1344, 768, 771, 777, 806, 0,
1062*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1063*4882a593Smuzhiyun 	/* 0x11 - 1024x768@70Hz */
1064*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 75000, 1024, 1048,
1065*4882a593Smuzhiyun 		   1184, 1328, 768, 771, 777, 806, 0,
1066*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1067*4882a593Smuzhiyun 	/* 0x12 - 1024x768@75Hz */
1068*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 78750, 1024, 1040,
1069*4882a593Smuzhiyun 		   1136, 1312, 768, 769, 772, 800, 0,
1070*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1071*4882a593Smuzhiyun 	/* 0x13 - 1024x768@85Hz */
1072*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 94500, 1024, 1072,
1073*4882a593Smuzhiyun 		   1168, 1376, 768, 769, 772, 808, 0,
1074*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1075*4882a593Smuzhiyun 	/* 0x14 - 1024x768@120Hz RB */
1076*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 115500, 1024, 1072,
1077*4882a593Smuzhiyun 		   1104, 1184, 768, 771, 775, 813, 0,
1078*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1079*4882a593Smuzhiyun 	/* 0x15 - 1152x864@75Hz */
1080*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 1152, 1216,
1081*4882a593Smuzhiyun 		   1344, 1600, 864, 865, 868, 900, 0,
1082*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1083*4882a593Smuzhiyun 	/* 0x55 - 1280x720@60Hz */
1084*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 1390,
1085*4882a593Smuzhiyun 		   1430, 1650, 720, 725, 730, 750, 0,
1086*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1087*4882a593Smuzhiyun 	/* 0x16 - 1280x768@60Hz RB */
1088*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 68250, 1280, 1328,
1089*4882a593Smuzhiyun 		   1360, 1440, 768, 771, 778, 790, 0,
1090*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1091*4882a593Smuzhiyun 	/* 0x17 - 1280x768@60Hz */
1092*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 79500, 1280, 1344,
1093*4882a593Smuzhiyun 		   1472, 1664, 768, 771, 778, 798, 0,
1094*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1095*4882a593Smuzhiyun 	/* 0x18 - 1280x768@75Hz */
1096*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 102250, 1280, 1360,
1097*4882a593Smuzhiyun 		   1488, 1696, 768, 771, 778, 805, 0,
1098*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1099*4882a593Smuzhiyun 	/* 0x19 - 1280x768@85Hz */
1100*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 117500, 1280, 1360,
1101*4882a593Smuzhiyun 		   1496, 1712, 768, 771, 778, 809, 0,
1102*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1103*4882a593Smuzhiyun 	/* 0x1a - 1280x768@120Hz RB */
1104*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 140250, 1280, 1328,
1105*4882a593Smuzhiyun 		   1360, 1440, 768, 771, 778, 813, 0,
1106*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1107*4882a593Smuzhiyun 	/* 0x1b - 1280x800@60Hz RB */
1108*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 71000, 1280, 1328,
1109*4882a593Smuzhiyun 		   1360, 1440, 800, 803, 809, 823, 0,
1110*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1111*4882a593Smuzhiyun 	/* 0x1c - 1280x800@60Hz */
1112*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 83500, 1280, 1352,
1113*4882a593Smuzhiyun 		   1480, 1680, 800, 803, 809, 831, 0,
1114*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1115*4882a593Smuzhiyun 	/* 0x1d - 1280x800@75Hz */
1116*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 106500, 1280, 1360,
1117*4882a593Smuzhiyun 		   1488, 1696, 800, 803, 809, 838, 0,
1118*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1119*4882a593Smuzhiyun 	/* 0x1e - 1280x800@85Hz */
1120*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 122500, 1280, 1360,
1121*4882a593Smuzhiyun 		   1496, 1712, 800, 803, 809, 843, 0,
1122*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1123*4882a593Smuzhiyun 	/* 0x1f - 1280x800@120Hz RB */
1124*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 146250, 1280, 1328,
1125*4882a593Smuzhiyun 		   1360, 1440, 800, 803, 809, 847, 0,
1126*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1127*4882a593Smuzhiyun 	/* 0x20 - 1280x960@60Hz */
1128*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 1280, 1376,
1129*4882a593Smuzhiyun 		   1488, 1800, 960, 961, 964, 1000, 0,
1130*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1131*4882a593Smuzhiyun 	/* 0x21 - 1280x960@85Hz */
1132*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1280, 1344,
1133*4882a593Smuzhiyun 		   1504, 1728, 960, 961, 964, 1011, 0,
1134*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1135*4882a593Smuzhiyun 	/* 0x22 - 1280x960@120Hz RB */
1136*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 175500, 1280, 1328,
1137*4882a593Smuzhiyun 		   1360, 1440, 960, 963, 967, 1017, 0,
1138*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1139*4882a593Smuzhiyun 	/* 0x23 - 1280x1024@60Hz */
1140*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 1280, 1328,
1141*4882a593Smuzhiyun 		   1440, 1688, 1024, 1025, 1028, 1066, 0,
1142*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1143*4882a593Smuzhiyun 	/* 0x24 - 1280x1024@75Hz */
1144*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 135000, 1280, 1296,
1145*4882a593Smuzhiyun 		   1440, 1688, 1024, 1025, 1028, 1066, 0,
1146*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1147*4882a593Smuzhiyun 	/* 0x25 - 1280x1024@85Hz */
1148*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 157500, 1280, 1344,
1149*4882a593Smuzhiyun 		   1504, 1728, 1024, 1025, 1028, 1072, 0,
1150*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1151*4882a593Smuzhiyun 	/* 0x26 - 1280x1024@120Hz RB */
1152*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 187250, 1280, 1328,
1153*4882a593Smuzhiyun 		   1360, 1440, 1024, 1027, 1034, 1084, 0,
1154*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1155*4882a593Smuzhiyun 	/* 0x27 - 1360x768@60Hz */
1156*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 85500, 1360, 1424,
1157*4882a593Smuzhiyun 		   1536, 1792, 768, 771, 777, 795, 0,
1158*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1159*4882a593Smuzhiyun 	/* 0x28 - 1360x768@120Hz RB */
1160*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148250, 1360, 1408,
1161*4882a593Smuzhiyun 		   1440, 1520, 768, 771, 776, 813, 0,
1162*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1163*4882a593Smuzhiyun 	/* 0x51 - 1366x768@60Hz */
1164*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 85500, 1366, 1436,
1165*4882a593Smuzhiyun 		   1579, 1792, 768, 771, 774, 798, 0,
1166*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1167*4882a593Smuzhiyun 	/* 0x56 - 1366x768@60Hz */
1168*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 72000, 1366, 1380,
1169*4882a593Smuzhiyun 		   1436, 1500, 768, 769, 772, 800, 0,
1170*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1171*4882a593Smuzhiyun 	/* 0x29 - 1400x1050@60Hz RB */
1172*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 101000, 1400, 1448,
1173*4882a593Smuzhiyun 		   1480, 1560, 1050, 1053, 1057, 1080, 0,
1174*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1175*4882a593Smuzhiyun 	/* 0x2a - 1400x1050@60Hz */
1176*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 121750, 1400, 1488,
1177*4882a593Smuzhiyun 		   1632, 1864, 1050, 1053, 1057, 1089, 0,
1178*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1179*4882a593Smuzhiyun 	/* 0x2b - 1400x1050@75Hz */
1180*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 156000, 1400, 1504,
1181*4882a593Smuzhiyun 		   1648, 1896, 1050, 1053, 1057, 1099, 0,
1182*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1183*4882a593Smuzhiyun 	/* 0x2c - 1400x1050@85Hz */
1184*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 179500, 1400, 1504,
1185*4882a593Smuzhiyun 		   1656, 1912, 1050, 1053, 1057, 1105, 0,
1186*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1187*4882a593Smuzhiyun 	/* 0x2d - 1400x1050@120Hz RB */
1188*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 208000, 1400, 1448,
1189*4882a593Smuzhiyun 		   1480, 1560, 1050, 1053, 1057, 1112, 0,
1190*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1191*4882a593Smuzhiyun 	/* 0x2e - 1440x900@60Hz RB */
1192*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 88750, 1440, 1488,
1193*4882a593Smuzhiyun 		   1520, 1600, 900, 903, 909, 926, 0,
1194*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1195*4882a593Smuzhiyun 	/* 0x2f - 1440x900@60Hz */
1196*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 106500, 1440, 1520,
1197*4882a593Smuzhiyun 		   1672, 1904, 900, 903, 909, 934, 0,
1198*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1199*4882a593Smuzhiyun 	/* 0x30 - 1440x900@75Hz */
1200*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 136750, 1440, 1536,
1201*4882a593Smuzhiyun 		   1688, 1936, 900, 903, 909, 942, 0,
1202*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1203*4882a593Smuzhiyun 	/* 0x31 - 1440x900@85Hz */
1204*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 157000, 1440, 1544,
1205*4882a593Smuzhiyun 		   1696, 1952, 900, 903, 909, 948, 0,
1206*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1207*4882a593Smuzhiyun 	/* 0x32 - 1440x900@120Hz RB */
1208*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 182750, 1440, 1488,
1209*4882a593Smuzhiyun 		   1520, 1600, 900, 903, 909, 953, 0,
1210*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1211*4882a593Smuzhiyun 	/* 0x53 - 1600x900@60Hz */
1212*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 1600, 1624,
1213*4882a593Smuzhiyun 		   1704, 1800, 900, 901, 904, 1000, 0,
1214*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1215*4882a593Smuzhiyun 	/* 0x33 - 1600x1200@60Hz */
1216*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 162000, 1600, 1664,
1217*4882a593Smuzhiyun 		   1856, 2160, 1200, 1201, 1204, 1250, 0,
1218*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1219*4882a593Smuzhiyun 	/* 0x34 - 1600x1200@65Hz */
1220*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 175500, 1600, 1664,
1221*4882a593Smuzhiyun 		   1856, 2160, 1200, 1201, 1204, 1250, 0,
1222*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1223*4882a593Smuzhiyun 	/* 0x35 - 1600x1200@70Hz */
1224*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 189000, 1600, 1664,
1225*4882a593Smuzhiyun 		   1856, 2160, 1200, 1201, 1204, 1250, 0,
1226*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1227*4882a593Smuzhiyun 	/* 0x36 - 1600x1200@75Hz */
1228*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 202500, 1600, 1664,
1229*4882a593Smuzhiyun 		   1856, 2160, 1200, 1201, 1204, 1250, 0,
1230*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1231*4882a593Smuzhiyun 	/* 0x37 - 1600x1200@85Hz */
1232*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 229500, 1600, 1664,
1233*4882a593Smuzhiyun 		   1856, 2160, 1200, 1201, 1204, 1250, 0,
1234*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1235*4882a593Smuzhiyun 	/* 0x38 - 1600x1200@120Hz RB */
1236*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 268250, 1600, 1648,
1237*4882a593Smuzhiyun 		   1680, 1760, 1200, 1203, 1207, 1271, 0,
1238*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1239*4882a593Smuzhiyun 	/* 0x39 - 1680x1050@60Hz RB */
1240*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 119000, 1680, 1728,
1241*4882a593Smuzhiyun 		   1760, 1840, 1050, 1053, 1059, 1080, 0,
1242*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1243*4882a593Smuzhiyun 	/* 0x3a - 1680x1050@60Hz */
1244*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 146250, 1680, 1784,
1245*4882a593Smuzhiyun 		   1960, 2240, 1050, 1053, 1059, 1089, 0,
1246*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1247*4882a593Smuzhiyun 	/* 0x3b - 1680x1050@75Hz */
1248*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 187000, 1680, 1800,
1249*4882a593Smuzhiyun 		   1976, 2272, 1050, 1053, 1059, 1099, 0,
1250*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1251*4882a593Smuzhiyun 	/* 0x3c - 1680x1050@85Hz */
1252*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 214750, 1680, 1808,
1253*4882a593Smuzhiyun 		   1984, 2288, 1050, 1053, 1059, 1105, 0,
1254*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1255*4882a593Smuzhiyun 	/* 0x3d - 1680x1050@120Hz RB */
1256*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 245500, 1680, 1728,
1257*4882a593Smuzhiyun 		   1760, 1840, 1050, 1053, 1059, 1112, 0,
1258*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1259*4882a593Smuzhiyun 	/* 0x3e - 1792x1344@60Hz */
1260*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 204750, 1792, 1920,
1261*4882a593Smuzhiyun 		   2120, 2448, 1344, 1345, 1348, 1394, 0,
1262*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1263*4882a593Smuzhiyun 	/* 0x3f - 1792x1344@75Hz */
1264*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 261000, 1792, 1888,
1265*4882a593Smuzhiyun 		   2104, 2456, 1344, 1345, 1348, 1417, 0,
1266*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1267*4882a593Smuzhiyun 	/* 0x40 - 1792x1344@120Hz RB */
1268*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 333250, 1792, 1840,
1269*4882a593Smuzhiyun 		   1872, 1952, 1344, 1347, 1351, 1423, 0,
1270*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1271*4882a593Smuzhiyun 	/* 0x41 - 1856x1392@60Hz */
1272*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 218250, 1856, 1952,
1273*4882a593Smuzhiyun 		   2176, 2528, 1392, 1393, 1396, 1439, 0,
1274*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1275*4882a593Smuzhiyun 	/* 0x42 - 1856x1392@75Hz */
1276*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 288000, 1856, 1984,
1277*4882a593Smuzhiyun 		   2208, 2560, 1392, 1393, 1396, 1500, 0,
1278*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1279*4882a593Smuzhiyun 	/* 0x43 - 1856x1392@120Hz RB */
1280*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 356500, 1856, 1904,
1281*4882a593Smuzhiyun 		   1936, 2016, 1392, 1395, 1399, 1474, 0,
1282*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1283*4882a593Smuzhiyun 	/* 0x52 - 1920x1080@60Hz */
1284*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
1285*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
1286*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1287*4882a593Smuzhiyun 	/* 0x44 - 1920x1200@60Hz RB */
1288*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 154000, 1920, 1968,
1289*4882a593Smuzhiyun 		   2000, 2080, 1200, 1203, 1209, 1235, 0,
1290*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1291*4882a593Smuzhiyun 	/* 0x45 - 1920x1200@60Hz */
1292*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 193250, 1920, 2056,
1293*4882a593Smuzhiyun 		   2256, 2592, 1200, 1203, 1209, 1245, 0,
1294*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1295*4882a593Smuzhiyun 	/* 0x46 - 1920x1200@75Hz */
1296*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 245250, 1920, 2056,
1297*4882a593Smuzhiyun 		   2264, 2608, 1200, 1203, 1209, 1255, 0,
1298*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1299*4882a593Smuzhiyun 	/* 0x47 - 1920x1200@85Hz */
1300*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 281250, 1920, 2064,
1301*4882a593Smuzhiyun 		   2272, 2624, 1200, 1203, 1209, 1262, 0,
1302*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1303*4882a593Smuzhiyun 	/* 0x48 - 1920x1200@120Hz RB */
1304*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 317000, 1920, 1968,
1305*4882a593Smuzhiyun 		   2000, 2080, 1200, 1203, 1209, 1271, 0,
1306*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1307*4882a593Smuzhiyun 	/* 0x49 - 1920x1440@60Hz */
1308*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 234000, 1920, 2048,
1309*4882a593Smuzhiyun 		   2256, 2600, 1440, 1441, 1444, 1500, 0,
1310*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1311*4882a593Smuzhiyun 	/* 0x4a - 1920x1440@75Hz */
1312*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 1920, 2064,
1313*4882a593Smuzhiyun 		   2288, 2640, 1440, 1441, 1444, 1500, 0,
1314*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1315*4882a593Smuzhiyun 	/* 0x4b - 1920x1440@120Hz RB */
1316*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 380500, 1920, 1968,
1317*4882a593Smuzhiyun 		   2000, 2080, 1440, 1443, 1447, 1525, 0,
1318*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1319*4882a593Smuzhiyun 	/* 0x54 - 2048x1152@60Hz */
1320*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 162000, 2048, 2074,
1321*4882a593Smuzhiyun 		   2154, 2250, 1152, 1153, 1156, 1200, 0,
1322*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1323*4882a593Smuzhiyun 	/* 0x4c - 2560x1600@60Hz RB */
1324*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 268500, 2560, 2608,
1325*4882a593Smuzhiyun 		   2640, 2720, 1600, 1603, 1609, 1646, 0,
1326*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1327*4882a593Smuzhiyun 	/* 0x4d - 2560x1600@60Hz */
1328*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 348500, 2560, 2752,
1329*4882a593Smuzhiyun 		   3032, 3504, 1600, 1603, 1609, 1658, 0,
1330*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1331*4882a593Smuzhiyun 	/* 0x4e - 2560x1600@75Hz */
1332*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 443250, 2560, 2768,
1333*4882a593Smuzhiyun 		   3048, 3536, 1600, 1603, 1609, 1672, 0,
1334*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1335*4882a593Smuzhiyun 	/* 0x4f - 2560x1600@85Hz */
1336*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 505250, 2560, 2768,
1337*4882a593Smuzhiyun 		   3048, 3536, 1600, 1603, 1609, 1682, 0,
1338*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1339*4882a593Smuzhiyun 	/* 0x50 - 2560x1600@120Hz RB */
1340*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 552750, 2560, 2608,
1341*4882a593Smuzhiyun 		   2640, 2720, 1600, 1603, 1609, 1694, 0,
1342*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1343*4882a593Smuzhiyun 	/* 0x57 - 4096x2160@60Hz RB */
1344*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 556744, 4096, 4104,
1345*4882a593Smuzhiyun 		   4136, 4176, 2160, 2208, 2216, 2222, 0,
1346*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1347*4882a593Smuzhiyun 	/* 0x58 - 4096x2160@59.94Hz RB */
1348*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 556188, 4096, 4104,
1349*4882a593Smuzhiyun 		   4136, 4176, 2160, 2208, 2216, 2222, 0,
1350*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
1351*4882a593Smuzhiyun };
1352*4882a593Smuzhiyun 
1353*4882a593Smuzhiyun /*
1354*4882a593Smuzhiyun  * These more or less come from the DMT spec.  The 720x400 modes are
1355*4882a593Smuzhiyun  * inferred from historical 80x25 practice.  The 640x480@67 and 832x624@75
1356*4882a593Smuzhiyun  * modes are old-school Mac modes.  The EDID spec says the 1152x864@75 mode
1357*4882a593Smuzhiyun  * should be 1152x870, again for the Mac, but instead we use the x864 DMT
1358*4882a593Smuzhiyun  * mode.
1359*4882a593Smuzhiyun  *
1360*4882a593Smuzhiyun  * The DMT modes have been fact-checked; the rest are mild guesses.
1361*4882a593Smuzhiyun  */
1362*4882a593Smuzhiyun static const struct drm_display_mode edid_est_modes[] = {
1363*4882a593Smuzhiyun 	/* 800x600@60Hz */
1364*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
1365*4882a593Smuzhiyun 		   968, 1056, 600, 601, 605, 628, 0,
1366*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1367*4882a593Smuzhiyun 	/* 800x600@56Hz */
1368*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 36000, 800, 824,
1369*4882a593Smuzhiyun 		   896, 1024, 600, 601, 603,  625, 0,
1370*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1371*4882a593Smuzhiyun 	/* 640x480@75Hz */
1372*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 31500, 640, 656,
1373*4882a593Smuzhiyun 		   720, 840, 480, 481, 484, 500, 0,
1374*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1375*4882a593Smuzhiyun 	/* 640x480@72Hz */
1376*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 31500, 640, 664,
1377*4882a593Smuzhiyun 		   704,  832, 480, 489, 492, 520, 0,
1378*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1379*4882a593Smuzhiyun 	/* 640x480@67Hz */
1380*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 30240, 640, 704,
1381*4882a593Smuzhiyun 		   768,  864, 480, 483, 486, 525, 0,
1382*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1383*4882a593Smuzhiyun 	/* 640x480@60Hz */
1384*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
1385*4882a593Smuzhiyun 		   752, 800, 480, 490, 492, 525, 0,
1386*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1387*4882a593Smuzhiyun 	/* 720x400@88Hz */
1388*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 35500, 720, 738,
1389*4882a593Smuzhiyun 		   846, 900, 400, 421, 423,  449, 0,
1390*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1391*4882a593Smuzhiyun 	/* 720x400@70Hz */
1392*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 28320, 720, 738,
1393*4882a593Smuzhiyun 		   846,  900, 400, 412, 414, 449, 0,
1394*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
1395*4882a593Smuzhiyun 	/* 1280x1024@75Hz */
1396*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 135000, 1280, 1296,
1397*4882a593Smuzhiyun 		   1440, 1688, 1024, 1025, 1028, 1066, 0,
1398*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1399*4882a593Smuzhiyun 	/* 1024x768@75Hz */
1400*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 78750, 1024, 1040,
1401*4882a593Smuzhiyun 		   1136, 1312,  768, 769, 772, 800, 0,
1402*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1403*4882a593Smuzhiyun 	/* 1024x768@70Hz */
1404*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 75000, 1024, 1048,
1405*4882a593Smuzhiyun 		   1184, 1328, 768, 771, 777, 806, 0,
1406*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1407*4882a593Smuzhiyun 	/* 1024x768@60Hz */
1408*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
1409*4882a593Smuzhiyun 		   1184, 1344, 768, 771, 777, 806, 0,
1410*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1411*4882a593Smuzhiyun 	/* 1024x768@43Hz */
1412*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 44900, 1024, 1032,
1413*4882a593Smuzhiyun 		   1208, 1264, 768, 768, 776, 817, 0,
1414*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
1415*4882a593Smuzhiyun 		   DRM_MODE_FLAG_INTERLACE) },
1416*4882a593Smuzhiyun 	/* 832x624@75Hz */
1417*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 57284, 832, 864,
1418*4882a593Smuzhiyun 		   928, 1152, 624, 625, 628, 667, 0,
1419*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1420*4882a593Smuzhiyun 	/* 800x600@75Hz */
1421*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 49500, 800, 816,
1422*4882a593Smuzhiyun 		   896, 1056, 600, 601, 604,  625, 0,
1423*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1424*4882a593Smuzhiyun 	/* 800x600@72Hz */
1425*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 50000, 800, 856,
1426*4882a593Smuzhiyun 		   976, 1040, 600, 637, 643, 666, 0,
1427*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1428*4882a593Smuzhiyun 	/* 1152x864@75Hz */
1429*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 108000, 1152, 1216,
1430*4882a593Smuzhiyun 		   1344, 1600, 864, 865, 868, 900, 0,
1431*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
1432*4882a593Smuzhiyun };
1433*4882a593Smuzhiyun 
1434*4882a593Smuzhiyun static const struct drm_display_mode resolution_white[] = {
1435*4882a593Smuzhiyun 	/* 0. vic:2 - 720x480@60Hz */
1436*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
1437*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
1438*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
1439*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
1440*4882a593Smuzhiyun 	/* 1. vic:3 - 720x480@60Hz */
1441*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
1442*4882a593Smuzhiyun 		   798, 858, 480, 489, 495, 525, 0,
1443*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
1444*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1445*4882a593Smuzhiyun 	/* 1024x768@60Hz */
1446*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
1447*4882a593Smuzhiyun 		   1184, 1344, 768, 771, 777, 806, 0,
1448*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
1449*4882a593Smuzhiyun 	/* 2. vic:4 - 1280x720@60Hz */
1450*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 1390,
1451*4882a593Smuzhiyun 		   1430, 1650, 720, 725, 730, 750, 0,
1452*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1453*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1454*4882a593Smuzhiyun 	/* 3. vic:5 - 1920x1080i@60Hz */
1455*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
1456*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1094, 1125, 0,
1457*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
1458*4882a593Smuzhiyun 		   DRM_MODE_FLAG_INTERLACE),
1459*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1460*4882a593Smuzhiyun 	/* 4. vic:6 - 720(1440)x480i@60Hz */
1461*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 739,
1462*4882a593Smuzhiyun 		   801, 858, 480, 488, 494, 525, 0,
1463*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
1464*4882a593Smuzhiyun 		   DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
1465*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
1466*4882a593Smuzhiyun 	/* 5. vic:16 - 1920x1080@60Hz */
1467*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
1468*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
1469*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1470*4882a593Smuzhiyun 	  .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1471*4882a593Smuzhiyun 	/* 6. vic:17 - 720x576@50Hz */
1472*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
1473*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
1474*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
1475*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
1476*4882a593Smuzhiyun 	/* 7. vic:18 - 720x576@50Hz */
1477*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
1478*4882a593Smuzhiyun 		   796, 864, 576, 581, 586, 625, 0,
1479*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
1480*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1481*4882a593Smuzhiyun 	/* 8. vic:19 - 1280x720@50Hz */
1482*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 1720,
1483*4882a593Smuzhiyun 		   1760, 1980, 720, 725, 730, 750, 0,
1484*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1485*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1486*4882a593Smuzhiyun 	/* 9. vic:20 - 1920x1080i@50Hz */
1487*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
1488*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1094, 1125, 0,
1489*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
1490*4882a593Smuzhiyun 		   DRM_MODE_FLAG_INTERLACE),
1491*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1492*4882a593Smuzhiyun 	/* 10. vic:21 - 720(1440)x576i@50Hz */
1493*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 13500, 720, 732,
1494*4882a593Smuzhiyun 		   795, 864, 576, 580, 586, 625, 0,
1495*4882a593Smuzhiyun 		   DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
1496*4882a593Smuzhiyun 		   DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
1497*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
1498*4882a593Smuzhiyun 	/* 11. vic:31 - 1920x1080@50Hz */
1499*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
1500*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
1501*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1502*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1503*4882a593Smuzhiyun 	/* 12. vic:32 - 1920x1080@24Hz */
1504*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2558,
1505*4882a593Smuzhiyun 		   2602, 2750, 1080, 1084, 1089, 1125, 0,
1506*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1507*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1508*4882a593Smuzhiyun 	/* 13. vic:33 - 1920x1080@25Hz */
1509*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
1510*4882a593Smuzhiyun 		   2492, 2640, 1080, 1084, 1089, 1125, 0,
1511*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1512*4882a593Smuzhiyun 	  .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1513*4882a593Smuzhiyun 	/* 14. vic:34 - 1920x1080@30Hz */
1514*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
1515*4882a593Smuzhiyun 		   2052, 2200, 1080, 1084, 1089, 1125, 0,
1516*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1517*4882a593Smuzhiyun 	  .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1518*4882a593Smuzhiyun 	/* 15. vic:39 - 1920x1080i@50Hz */
1519*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 72000, 1920, 1952,
1520*4882a593Smuzhiyun 		   2120, 2304, 1080, 1126, 1136, 1250, 0,
1521*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC |
1522*4882a593Smuzhiyun 		   DRM_MODE_FLAG_INTERLACE),
1523*4882a593Smuzhiyun 	  .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1524*4882a593Smuzhiyun 	/* 16. vic:60 - 1280x720@24Hz */
1525*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 59400, 1280, 3040,
1526*4882a593Smuzhiyun 		   3080, 3300, 720, 725, 730, 750, 0,
1527*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1528*4882a593Smuzhiyun 	  .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1529*4882a593Smuzhiyun 	/* 17. vic:61 - 1280x720@25Hz */
1530*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 3700,
1531*4882a593Smuzhiyun 		   3740, 3960, 720, 725, 730, 750, 0,
1532*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1533*4882a593Smuzhiyun 	  .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1534*4882a593Smuzhiyun 	/* 18. vic:62 - 1280x720@30Hz */
1535*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 74250, 1280, 3040,
1536*4882a593Smuzhiyun 		   3080, 3300, 720, 725, 730, 750, 0,
1537*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1538*4882a593Smuzhiyun 	  .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1539*4882a593Smuzhiyun 	/* 19. vic:93 - 3840x2160p@24Hz 16:9 */
1540*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 5116,
1541*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
1542*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1543*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1544*4882a593Smuzhiyun 	/* 20. vic:94 - 3840x2160p@25Hz 16:9 */
1545*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 4896,
1546*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
1547*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1548*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1549*4882a593Smuzhiyun 	/* 21. vic:95 - 3840x2160p@30Hz 16:9 */
1550*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 3840, 4016,
1551*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
1552*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1553*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1554*4882a593Smuzhiyun 	/* 22. vic:96 - 3840x2160p@50Hz 16:9 */
1555*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 4896,
1556*4882a593Smuzhiyun 		   4984, 5280, 2160, 2168, 2178, 2250, 0,
1557*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1558*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1559*4882a593Smuzhiyun 	/* 23. vic:97 - 3840x2160p@60Hz 16:9 */
1560*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 3840, 4016,
1561*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
1562*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1563*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1564*4882a593Smuzhiyun 	/* 24. vic:98 - 4096x2160p@24Hz 256:135 */
1565*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 4096, 5116,
1566*4882a593Smuzhiyun 		   5204, 5500, 2160, 2168, 2178, 2250, 0,
1567*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1568*4882a593Smuzhiyun 	.vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
1569*4882a593Smuzhiyun 	/* 25. vic:99 - 4096x2160p@25Hz 256:135 */
1570*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 4096, 5064,
1571*4882a593Smuzhiyun 		   5152, 5280, 2160, 2168, 2178, 2250, 0,
1572*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1573*4882a593Smuzhiyun 	.vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
1574*4882a593Smuzhiyun 	/* 26. vic:100 - 4096x2160p@30Hz 256:135 */
1575*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 297000, 4096, 4184,
1576*4882a593Smuzhiyun 		   4272, 4400, 2160, 2168, 2178, 2250, 0,
1577*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1578*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
1579*4882a593Smuzhiyun 	/* 27. vic:101 - 4096x2160p@50Hz 256:135 */
1580*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 4096, 5064,
1581*4882a593Smuzhiyun 		   5152, 5280, 2160, 2168, 2178, 2250, 0,
1582*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1583*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
1584*4882a593Smuzhiyun 	/* 28. vic:102 - 4096x2160p@60Hz 256:135 */
1585*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 594000, 4096, 4184,
1586*4882a593Smuzhiyun 		   4272, 4400, 2160, 2168, 2178, 2250, 0,
1587*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1588*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_256_135, },
1589*4882a593Smuzhiyun 	/* 29. vic:118 - 3840x2160@120Hz 16:9 */
1590*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 3840, 4016,
1591*4882a593Smuzhiyun 		   4104, 4400, 2160, 2168, 2178, 2250, 0,
1592*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1593*4882a593Smuzhiyun 	.vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1594*4882a593Smuzhiyun 	/* 30. vic:196 - 7680x4320@30Hz 16:9 */
1595*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 1188000, 7680, 8232,
1596*4882a593Smuzhiyun 		   8408, 9000, 4320, 4336, 4356, 4400, 0,
1597*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1598*4882a593Smuzhiyun 	.vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1599*4882a593Smuzhiyun 	/* 31. vic:198 - 7680x4320@50Hz 16:9 */
1600*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 10032,
1601*4882a593Smuzhiyun 		   10208, 10800, 4320, 4336, 4356, 4400, 0,
1602*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1603*4882a593Smuzhiyun 	.vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1604*4882a593Smuzhiyun 	/* 32. vic:199 - 7680x4320@60Hz 16:9 */
1605*4882a593Smuzhiyun 	{ DRM_MODE(DRM_MODE_TYPE_DRIVER, 2376000, 7680, 8232,
1606*4882a593Smuzhiyun 		   8408, 9000, 4320, 4336, 4356, 4400, 0,
1607*4882a593Smuzhiyun 		   DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
1608*4882a593Smuzhiyun 	.vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
1609*4882a593Smuzhiyun };
1610*4882a593Smuzhiyun 
1611*4882a593Smuzhiyun struct minimode {
1612*4882a593Smuzhiyun 	short w;
1613*4882a593Smuzhiyun 	short h;
1614*4882a593Smuzhiyun 	short r;
1615*4882a593Smuzhiyun 	short rb;
1616*4882a593Smuzhiyun };
1617*4882a593Smuzhiyun 
1618*4882a593Smuzhiyun static const struct minimode est3_modes[] = {
1619*4882a593Smuzhiyun 	/* byte 6 */
1620*4882a593Smuzhiyun 	{ 640, 350, 85, 0 },
1621*4882a593Smuzhiyun 	{ 640, 400, 85, 0 },
1622*4882a593Smuzhiyun 	{ 720, 400, 85, 0 },
1623*4882a593Smuzhiyun 	{ 640, 480, 85, 0 },
1624*4882a593Smuzhiyun 	{ 848, 480, 60, 0 },
1625*4882a593Smuzhiyun 	{ 800, 600, 85, 0 },
1626*4882a593Smuzhiyun 	{ 1024, 768, 85, 0 },
1627*4882a593Smuzhiyun 	{ 1152, 864, 75, 0 },
1628*4882a593Smuzhiyun 	/* byte 7 */
1629*4882a593Smuzhiyun 	{ 1280, 768, 60, 1 },
1630*4882a593Smuzhiyun 	{ 1280, 768, 60, 0 },
1631*4882a593Smuzhiyun 	{ 1280, 768, 75, 0 },
1632*4882a593Smuzhiyun 	{ 1280, 768, 85, 0 },
1633*4882a593Smuzhiyun 	{ 1280, 960, 60, 0 },
1634*4882a593Smuzhiyun 	{ 1280, 960, 85, 0 },
1635*4882a593Smuzhiyun 	{ 1280, 1024, 60, 0 },
1636*4882a593Smuzhiyun 	{ 1280, 1024, 85, 0 },
1637*4882a593Smuzhiyun 	/* byte 8 */
1638*4882a593Smuzhiyun 	{ 1360, 768, 60, 0 },
1639*4882a593Smuzhiyun 	{ 1440, 900, 60, 1 },
1640*4882a593Smuzhiyun 	{ 1440, 900, 60, 0 },
1641*4882a593Smuzhiyun 	{ 1440, 900, 75, 0 },
1642*4882a593Smuzhiyun 	{ 1440, 900, 85, 0 },
1643*4882a593Smuzhiyun 	{ 1400, 1050, 60, 1 },
1644*4882a593Smuzhiyun 	{ 1400, 1050, 60, 0 },
1645*4882a593Smuzhiyun 	{ 1400, 1050, 75, 0 },
1646*4882a593Smuzhiyun 	/* byte 9 */
1647*4882a593Smuzhiyun 	{ 1400, 1050, 85, 0 },
1648*4882a593Smuzhiyun 	{ 1680, 1050, 60, 1 },
1649*4882a593Smuzhiyun 	{ 1680, 1050, 60, 0 },
1650*4882a593Smuzhiyun 	{ 1680, 1050, 75, 0 },
1651*4882a593Smuzhiyun 	{ 1680, 1050, 85, 0 },
1652*4882a593Smuzhiyun 	{ 1600, 1200, 60, 0 },
1653*4882a593Smuzhiyun 	{ 1600, 1200, 65, 0 },
1654*4882a593Smuzhiyun 	{ 1600, 1200, 70, 0 },
1655*4882a593Smuzhiyun 	/* byte 10 */
1656*4882a593Smuzhiyun 	{ 1600, 1200, 75, 0 },
1657*4882a593Smuzhiyun 	{ 1600, 1200, 85, 0 },
1658*4882a593Smuzhiyun 	{ 1792, 1344, 60, 0 },
1659*4882a593Smuzhiyun 	{ 1792, 1344, 75, 0 },
1660*4882a593Smuzhiyun 	{ 1856, 1392, 60, 0 },
1661*4882a593Smuzhiyun 	{ 1856, 1392, 75, 0 },
1662*4882a593Smuzhiyun 	{ 1920, 1200, 60, 1 },
1663*4882a593Smuzhiyun 	{ 1920, 1200, 60, 0 },
1664*4882a593Smuzhiyun 	/* byte 11 */
1665*4882a593Smuzhiyun 	{ 1920, 1200, 75, 0 },
1666*4882a593Smuzhiyun 	{ 1920, 1200, 85, 0 },
1667*4882a593Smuzhiyun 	{ 1920, 1440, 60, 0 },
1668*4882a593Smuzhiyun 	{ 1920, 1440, 75, 0 },
1669*4882a593Smuzhiyun };
1670*4882a593Smuzhiyun 
1671*4882a593Smuzhiyun static const struct minimode extra_modes[] = {
1672*4882a593Smuzhiyun 	{ 1024, 576,  60, 0 },
1673*4882a593Smuzhiyun 	{ 1366, 768,  60, 0 },
1674*4882a593Smuzhiyun 	{ 1600, 900,  60, 0 },
1675*4882a593Smuzhiyun 	{ 1680, 945,  60, 0 },
1676*4882a593Smuzhiyun 	{ 1920, 1080, 60, 0 },
1677*4882a593Smuzhiyun 	{ 2048, 1152, 60, 0 },
1678*4882a593Smuzhiyun 	{ 2048, 1536, 60, 0 },
1679*4882a593Smuzhiyun };
1680*4882a593Smuzhiyun 
cea_mode_for_vic(u8 vic)1681*4882a593Smuzhiyun static const struct drm_display_mode *cea_mode_for_vic(u8 vic)
1682*4882a593Smuzhiyun {
1683*4882a593Smuzhiyun 	if (!vic)
1684*4882a593Smuzhiyun 		return NULL;
1685*4882a593Smuzhiyun 	else if (vic >= 1 && vic < 1 + ARRAY_SIZE(edid_cea_modes_1))
1686*4882a593Smuzhiyun 		return &edid_cea_modes_1[vic - 1];
1687*4882a593Smuzhiyun 	else if (vic >= 193 && vic < 193 + ARRAY_SIZE(edid_cea_modes_193))
1688*4882a593Smuzhiyun 		return &edid_cea_modes_193[vic - 193];
1689*4882a593Smuzhiyun 
1690*4882a593Smuzhiyun 	return NULL;
1691*4882a593Smuzhiyun }
1692*4882a593Smuzhiyun 
cea_num_vics(void)1693*4882a593Smuzhiyun static u8 cea_num_vics(void)
1694*4882a593Smuzhiyun {
1695*4882a593Smuzhiyun 	return 193 + ARRAY_SIZE(edid_cea_modes_193);
1696*4882a593Smuzhiyun }
1697*4882a593Smuzhiyun 
cea_next_vic(u8 vic)1698*4882a593Smuzhiyun static u8 cea_next_vic(u8 vic)
1699*4882a593Smuzhiyun {
1700*4882a593Smuzhiyun 	if (++vic == 1 + ARRAY_SIZE(edid_cea_modes_1))
1701*4882a593Smuzhiyun 		vic = 193;
1702*4882a593Smuzhiyun 
1703*4882a593Smuzhiyun 	return vic;
1704*4882a593Smuzhiyun }
1705*4882a593Smuzhiyun 
edid_check_info(struct edid1_info * edid_info)1706*4882a593Smuzhiyun int edid_check_info(struct edid1_info *edid_info)
1707*4882a593Smuzhiyun {
1708*4882a593Smuzhiyun 	if ((edid_info == NULL) || (edid_info->version == 0))
1709*4882a593Smuzhiyun 		return -1;
1710*4882a593Smuzhiyun 
1711*4882a593Smuzhiyun 	if (memcmp(edid_info->header, "\x0\xff\xff\xff\xff\xff\xff\x0", 8))
1712*4882a593Smuzhiyun 		return -1;
1713*4882a593Smuzhiyun 
1714*4882a593Smuzhiyun 	if (edid_info->version == 0xff && edid_info->revision == 0xff)
1715*4882a593Smuzhiyun 		return -1;
1716*4882a593Smuzhiyun 
1717*4882a593Smuzhiyun 	return 0;
1718*4882a593Smuzhiyun }
1719*4882a593Smuzhiyun 
edid_check_checksum(u8 * edid_block)1720*4882a593Smuzhiyun int edid_check_checksum(u8 *edid_block)
1721*4882a593Smuzhiyun {
1722*4882a593Smuzhiyun 	u8 checksum = 0;
1723*4882a593Smuzhiyun 	int i;
1724*4882a593Smuzhiyun 
1725*4882a593Smuzhiyun 	for (i = 0; i < 128; i++)
1726*4882a593Smuzhiyun 		checksum += edid_block[i];
1727*4882a593Smuzhiyun 
1728*4882a593Smuzhiyun 	return (checksum == 0) ? 0 : -EINVAL;
1729*4882a593Smuzhiyun }
1730*4882a593Smuzhiyun 
edid_get_ranges(struct edid1_info * edid,unsigned int * hmin,unsigned int * hmax,unsigned int * vmin,unsigned int * vmax)1731*4882a593Smuzhiyun int edid_get_ranges(struct edid1_info *edid, unsigned int *hmin,
1732*4882a593Smuzhiyun 		    unsigned int *hmax, unsigned int *vmin,
1733*4882a593Smuzhiyun 		    unsigned int *vmax)
1734*4882a593Smuzhiyun {
1735*4882a593Smuzhiyun 	int i;
1736*4882a593Smuzhiyun 	struct edid_monitor_descriptor *monitor;
1737*4882a593Smuzhiyun 
1738*4882a593Smuzhiyun 	*hmin = *hmax = *vmin = *vmax = 0;
1739*4882a593Smuzhiyun 	if (edid_check_info(edid))
1740*4882a593Smuzhiyun 		return -1;
1741*4882a593Smuzhiyun 
1742*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(edid->monitor_details.descriptor); i++) {
1743*4882a593Smuzhiyun 		monitor = &edid->monitor_details.descriptor[i];
1744*4882a593Smuzhiyun 		if (monitor->type == EDID_MONITOR_DESCRIPTOR_RANGE) {
1745*4882a593Smuzhiyun 			*hmin = monitor->data.range_data.horizontal_min;
1746*4882a593Smuzhiyun 			*hmax = monitor->data.range_data.horizontal_max;
1747*4882a593Smuzhiyun 			*vmin = monitor->data.range_data.vertical_min;
1748*4882a593Smuzhiyun 			*vmax = monitor->data.range_data.vertical_max;
1749*4882a593Smuzhiyun 			return 0;
1750*4882a593Smuzhiyun 		}
1751*4882a593Smuzhiyun 	}
1752*4882a593Smuzhiyun 	return -1;
1753*4882a593Smuzhiyun }
1754*4882a593Smuzhiyun 
1755*4882a593Smuzhiyun /* Set all parts of a timing entry to the same value */
set_entry(struct timing_entry * entry,u32 value)1756*4882a593Smuzhiyun static void set_entry(struct timing_entry *entry, u32 value)
1757*4882a593Smuzhiyun {
1758*4882a593Smuzhiyun 	entry->min = value;
1759*4882a593Smuzhiyun 	entry->typ = value;
1760*4882a593Smuzhiyun 	entry->max = value;
1761*4882a593Smuzhiyun }
1762*4882a593Smuzhiyun 
1763*4882a593Smuzhiyun /**
1764*4882a593Smuzhiyun  * decode_timing() - Decoding an 18-byte detailed timing record
1765*4882a593Smuzhiyun  *
1766*4882a593Smuzhiyun  * @buf:	Pointer to EDID detailed timing record
1767*4882a593Smuzhiyun  * @timing:	Place to put timing
1768*4882a593Smuzhiyun  */
decode_timing(u8 * buf,struct display_timing * timing)1769*4882a593Smuzhiyun static void decode_timing(u8 *buf, struct display_timing *timing)
1770*4882a593Smuzhiyun {
1771*4882a593Smuzhiyun 	uint x_mm, y_mm;
1772*4882a593Smuzhiyun 	unsigned int ha, hbl, hso, hspw, hborder;
1773*4882a593Smuzhiyun 	unsigned int va, vbl, vso, vspw, vborder;
1774*4882a593Smuzhiyun 	struct edid_detailed_timing *t = (struct edid_detailed_timing *)buf;
1775*4882a593Smuzhiyun 
1776*4882a593Smuzhiyun 	/* Edid contains pixel clock in terms of 10KHz */
1777*4882a593Smuzhiyun 	set_entry(&timing->pixelclock, (buf[0] + (buf[1] << 8)) * 10000);
1778*4882a593Smuzhiyun 	x_mm = (buf[12] + ((buf[14] & 0xf0) << 4));
1779*4882a593Smuzhiyun 	y_mm = (buf[13] + ((buf[14] & 0x0f) << 8));
1780*4882a593Smuzhiyun 	ha = (buf[2] + ((buf[4] & 0xf0) << 4));
1781*4882a593Smuzhiyun 	hbl = (buf[3] + ((buf[4] & 0x0f) << 8));
1782*4882a593Smuzhiyun 	hso = (buf[8] + ((buf[11] & 0xc0) << 2));
1783*4882a593Smuzhiyun 	hspw = (buf[9] + ((buf[11] & 0x30) << 4));
1784*4882a593Smuzhiyun 	hborder = buf[15];
1785*4882a593Smuzhiyun 	va = (buf[5] + ((buf[7] & 0xf0) << 4));
1786*4882a593Smuzhiyun 	vbl = (buf[6] + ((buf[7] & 0x0f) << 8));
1787*4882a593Smuzhiyun 	vso = ((buf[10] >> 4) + ((buf[11] & 0x0c) << 2));
1788*4882a593Smuzhiyun 	vspw = ((buf[10] & 0x0f) + ((buf[11] & 0x03) << 4));
1789*4882a593Smuzhiyun 	vborder = buf[16];
1790*4882a593Smuzhiyun 
1791*4882a593Smuzhiyun 	set_entry(&timing->hactive, ha);
1792*4882a593Smuzhiyun 	set_entry(&timing->hfront_porch, hso);
1793*4882a593Smuzhiyun 	set_entry(&timing->hback_porch, hbl - hso - hspw);
1794*4882a593Smuzhiyun 	set_entry(&timing->hsync_len, hspw);
1795*4882a593Smuzhiyun 
1796*4882a593Smuzhiyun 	set_entry(&timing->vactive, va);
1797*4882a593Smuzhiyun 	set_entry(&timing->vfront_porch, vso);
1798*4882a593Smuzhiyun 	set_entry(&timing->vback_porch, vbl - vso - vspw);
1799*4882a593Smuzhiyun 	set_entry(&timing->vsync_len, vspw);
1800*4882a593Smuzhiyun 
1801*4882a593Smuzhiyun 	timing->flags = 0;
1802*4882a593Smuzhiyun 	if (EDID_DETAILED_TIMING_FLAG_HSYNC_POLARITY(*t))
1803*4882a593Smuzhiyun 		timing->flags |= DISPLAY_FLAGS_HSYNC_HIGH;
1804*4882a593Smuzhiyun 	else
1805*4882a593Smuzhiyun 		timing->flags |= DISPLAY_FLAGS_HSYNC_LOW;
1806*4882a593Smuzhiyun 	if (EDID_DETAILED_TIMING_FLAG_VSYNC_POLARITY(*t))
1807*4882a593Smuzhiyun 		timing->flags |= DISPLAY_FLAGS_VSYNC_HIGH;
1808*4882a593Smuzhiyun 	else
1809*4882a593Smuzhiyun 		timing->flags |= DISPLAY_FLAGS_VSYNC_LOW;
1810*4882a593Smuzhiyun 
1811*4882a593Smuzhiyun 	if (EDID_DETAILED_TIMING_FLAG_INTERLACED(*t))
1812*4882a593Smuzhiyun 		timing->flags = DISPLAY_FLAGS_INTERLACED;
1813*4882a593Smuzhiyun 
1814*4882a593Smuzhiyun 	debug("Detailed mode clock %u Hz, %d mm x %d mm\n"
1815*4882a593Smuzhiyun 	      "               %04x %04x %04x %04x hborder %x\n"
1816*4882a593Smuzhiyun 	      "               %04x %04x %04x %04x vborder %x\n",
1817*4882a593Smuzhiyun 	      timing->pixelclock.typ,
1818*4882a593Smuzhiyun 	      x_mm, y_mm,
1819*4882a593Smuzhiyun 	      ha, ha + hso, ha + hso + hspw,
1820*4882a593Smuzhiyun 	      ha + hbl, hborder,
1821*4882a593Smuzhiyun 	      va, va + vso, va + vso + vspw,
1822*4882a593Smuzhiyun 	      va + vbl, vborder);
1823*4882a593Smuzhiyun }
1824*4882a593Smuzhiyun 
1825*4882a593Smuzhiyun /**
1826*4882a593Smuzhiyun  * decode_mode() - Decoding an 18-byte detailed timing record
1827*4882a593Smuzhiyun  *
1828*4882a593Smuzhiyun  * @buf:	Pointer to EDID detailed timing record
1829*4882a593Smuzhiyun  * @timing:	Place to put timing
1830*4882a593Smuzhiyun  */
decode_mode(u8 * buf,struct drm_display_mode * mode)1831*4882a593Smuzhiyun static void decode_mode(u8 *buf, struct drm_display_mode *mode)
1832*4882a593Smuzhiyun {
1833*4882a593Smuzhiyun 	uint x_mm, y_mm;
1834*4882a593Smuzhiyun 	unsigned int ha, hbl, hso, hspw, hborder;
1835*4882a593Smuzhiyun 	unsigned int va, vbl, vso, vspw, vborder;
1836*4882a593Smuzhiyun 	struct edid_detailed_timing *t = (struct edid_detailed_timing *)buf;
1837*4882a593Smuzhiyun 
1838*4882a593Smuzhiyun 	x_mm = (buf[12] + ((buf[14] & 0xf0) << 4));
1839*4882a593Smuzhiyun 	y_mm = (buf[13] + ((buf[14] & 0x0f) << 8));
1840*4882a593Smuzhiyun 	ha = (buf[2] + ((buf[4] & 0xf0) << 4));
1841*4882a593Smuzhiyun 	hbl = (buf[3] + ((buf[4] & 0x0f) << 8));
1842*4882a593Smuzhiyun 	hso = (buf[8] + ((buf[11] & 0xc0) << 2));
1843*4882a593Smuzhiyun 	hspw = (buf[9] + ((buf[11] & 0x30) << 4));
1844*4882a593Smuzhiyun 	hborder = buf[15];
1845*4882a593Smuzhiyun 	va = (buf[5] + ((buf[7] & 0xf0) << 4));
1846*4882a593Smuzhiyun 	vbl = (buf[6] + ((buf[7] & 0x0f) << 8));
1847*4882a593Smuzhiyun 	vso = ((buf[10] >> 4) + ((buf[11] & 0x0c) << 2));
1848*4882a593Smuzhiyun 	vspw = ((buf[10] & 0x0f) + ((buf[11] & 0x03) << 4));
1849*4882a593Smuzhiyun 	vborder = buf[16];
1850*4882a593Smuzhiyun 
1851*4882a593Smuzhiyun 	/* Edid contains pixel clock in terms of 10KHz */
1852*4882a593Smuzhiyun 	mode->clock = (buf[0] + (buf[1] << 8)) * 10;
1853*4882a593Smuzhiyun 	mode->hdisplay = ha;
1854*4882a593Smuzhiyun 	mode->hsync_start = ha + hso;
1855*4882a593Smuzhiyun 	mode->hsync_end = ha + hso + hspw;
1856*4882a593Smuzhiyun 	mode->htotal = ha + hbl;
1857*4882a593Smuzhiyun 	mode->vdisplay = va;
1858*4882a593Smuzhiyun 	mode->vsync_start = va + vso;
1859*4882a593Smuzhiyun 	mode->vsync_end = va + vso + vspw;
1860*4882a593Smuzhiyun 	mode->vtotal = va + vbl;
1861*4882a593Smuzhiyun 
1862*4882a593Smuzhiyun 	mode->flags = EDID_DETAILED_TIMING_FLAG_HSYNC_POLARITY(*t) ?
1863*4882a593Smuzhiyun 		DRM_MODE_FLAG_PHSYNC : DRM_MODE_FLAG_NHSYNC;
1864*4882a593Smuzhiyun 	mode->flags |= EDID_DETAILED_TIMING_FLAG_VSYNC_POLARITY(*t) ?
1865*4882a593Smuzhiyun 		DRM_MODE_FLAG_PVSYNC : DRM_MODE_FLAG_NVSYNC;
1866*4882a593Smuzhiyun 
1867*4882a593Smuzhiyun 	if (EDID_DETAILED_TIMING_FLAG_INTERLACED(*t))
1868*4882a593Smuzhiyun 		mode->flags |= DRM_MODE_FLAG_INTERLACE;
1869*4882a593Smuzhiyun 
1870*4882a593Smuzhiyun 	debug("Detailed mode clock %u kHz, %d mm x %d mm, flags[%x]\n"
1871*4882a593Smuzhiyun 	      "     %04d %04d %04d %04d hborder %d\n"
1872*4882a593Smuzhiyun 	      "     %04d %04d %04d %04d vborder %d\n",
1873*4882a593Smuzhiyun 	      mode->clock,
1874*4882a593Smuzhiyun 	      x_mm, y_mm, mode->flags,
1875*4882a593Smuzhiyun 	      mode->hdisplay, mode->hsync_start, mode->hsync_end,
1876*4882a593Smuzhiyun 	      mode->htotal, hborder,
1877*4882a593Smuzhiyun 	      mode->vdisplay, mode->vsync_start, mode->vsync_end,
1878*4882a593Smuzhiyun 	      mode->vtotal, vborder);
1879*4882a593Smuzhiyun }
1880*4882a593Smuzhiyun 
1881*4882a593Smuzhiyun /**
1882*4882a593Smuzhiyun  * edid_vendor - match a string against EDID's obfuscated vendor field
1883*4882a593Smuzhiyun  * @edid: EDID to match
1884*4882a593Smuzhiyun  * @vendor: vendor string
1885*4882a593Smuzhiyun  *
1886*4882a593Smuzhiyun  * Returns true if @vendor is in @edid, false otherwise
1887*4882a593Smuzhiyun  */
edid_vendor(struct edid * edid,char * vendor)1888*4882a593Smuzhiyun static bool edid_vendor(struct edid *edid, char *vendor)
1889*4882a593Smuzhiyun {
1890*4882a593Smuzhiyun 	char edid_vendor[3];
1891*4882a593Smuzhiyun 
1892*4882a593Smuzhiyun 	edid_vendor[0] = ((edid->mfg_id[0] & 0x7c) >> 2) + '@';
1893*4882a593Smuzhiyun 	edid_vendor[1] = (((edid->mfg_id[0] & 0x3) << 3) |
1894*4882a593Smuzhiyun 			  ((edid->mfg_id[1] & 0xe0) >> 5)) + '@';
1895*4882a593Smuzhiyun 	edid_vendor[2] = (edid->mfg_id[1] & 0x1f) + '@';
1896*4882a593Smuzhiyun 
1897*4882a593Smuzhiyun 	return !strncmp(edid_vendor, vendor, 3);
1898*4882a593Smuzhiyun }
1899*4882a593Smuzhiyun 
1900*4882a593Smuzhiyun /**
1901*4882a593Smuzhiyun  * Check if HDMI vendor specific data block is present in CEA block
1902*4882a593Smuzhiyun  * @param info	CEA extension block
1903*4882a593Smuzhiyun  * @return true if block is found
1904*4882a593Smuzhiyun  */
cea_is_hdmi_vsdb_present(struct edid_cea861_info * info)1905*4882a593Smuzhiyun static bool cea_is_hdmi_vsdb_present(struct edid_cea861_info *info)
1906*4882a593Smuzhiyun {
1907*4882a593Smuzhiyun 	u8 end, i = 0;
1908*4882a593Smuzhiyun 
1909*4882a593Smuzhiyun 	/* check for end of data block */
1910*4882a593Smuzhiyun 	end = info->dtd_offset;
1911*4882a593Smuzhiyun 	if (end == 0)
1912*4882a593Smuzhiyun 		end = sizeof(info->data);
1913*4882a593Smuzhiyun 	if (end < 4 || end > sizeof(info->data))
1914*4882a593Smuzhiyun 		return false;
1915*4882a593Smuzhiyun 	end -= 4;
1916*4882a593Smuzhiyun 
1917*4882a593Smuzhiyun 	while (i < end) {
1918*4882a593Smuzhiyun 		/* Look for vendor specific data block of appropriate size */
1919*4882a593Smuzhiyun 		if ((EDID_CEA861_DB_TYPE(*info, i) == EDID_CEA861_DB_VENDOR) &&
1920*4882a593Smuzhiyun 		    (EDID_CEA861_DB_LEN(*info, i) >= 5)) {
1921*4882a593Smuzhiyun 			u8 *db = &info->data[i + 1];
1922*4882a593Smuzhiyun 			u32 oui = db[0] | (db[1] << 8) | (db[2] << 16);
1923*4882a593Smuzhiyun 
1924*4882a593Smuzhiyun 			if (oui == HDMI_IEEE_OUI)
1925*4882a593Smuzhiyun 				return true;
1926*4882a593Smuzhiyun 		}
1927*4882a593Smuzhiyun 		i += EDID_CEA861_DB_LEN(*info, i) + 1;
1928*4882a593Smuzhiyun 	}
1929*4882a593Smuzhiyun 
1930*4882a593Smuzhiyun 	return false;
1931*4882a593Smuzhiyun }
1932*4882a593Smuzhiyun 
drm_get_vrefresh(const struct drm_display_mode * mode)1933*4882a593Smuzhiyun static int drm_get_vrefresh(const struct drm_display_mode *mode)
1934*4882a593Smuzhiyun {
1935*4882a593Smuzhiyun 	int refresh = 0;
1936*4882a593Smuzhiyun 	unsigned int calc_val;
1937*4882a593Smuzhiyun 
1938*4882a593Smuzhiyun 	if (mode->vrefresh > 0) {
1939*4882a593Smuzhiyun 		refresh = mode->vrefresh;
1940*4882a593Smuzhiyun 	} else if (mode->htotal > 0 && mode->vtotal > 0) {
1941*4882a593Smuzhiyun 		int vtotal;
1942*4882a593Smuzhiyun 
1943*4882a593Smuzhiyun 		vtotal = mode->vtotal;
1944*4882a593Smuzhiyun 		/* work out vrefresh the value will be x1000 */
1945*4882a593Smuzhiyun 		calc_val = (mode->clock * 1000);
1946*4882a593Smuzhiyun 		calc_val /= mode->htotal;
1947*4882a593Smuzhiyun 		refresh = (calc_val + vtotal / 2) / vtotal;
1948*4882a593Smuzhiyun 
1949*4882a593Smuzhiyun 		if (mode->flags & DRM_MODE_FLAG_INTERLACE)
1950*4882a593Smuzhiyun 			refresh *= 2;
1951*4882a593Smuzhiyun 		if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
1952*4882a593Smuzhiyun 			refresh /= 2;
1953*4882a593Smuzhiyun 		if (mode->vscan > 1)
1954*4882a593Smuzhiyun 			refresh /= mode->vscan;
1955*4882a593Smuzhiyun 	}
1956*4882a593Smuzhiyun 	return refresh;
1957*4882a593Smuzhiyun }
1958*4882a593Smuzhiyun 
edid_get_drm_mode(u8 * buf,int buf_size,struct drm_display_mode * mode,int * panel_bits_per_colourp)1959*4882a593Smuzhiyun int edid_get_drm_mode(u8 *buf, int buf_size, struct drm_display_mode *mode,
1960*4882a593Smuzhiyun 		      int *panel_bits_per_colourp)
1961*4882a593Smuzhiyun {
1962*4882a593Smuzhiyun 	struct edid1_info *edid = (struct edid1_info *)buf;
1963*4882a593Smuzhiyun 	bool timing_done;
1964*4882a593Smuzhiyun 	int i;
1965*4882a593Smuzhiyun 
1966*4882a593Smuzhiyun 	if (buf_size < sizeof(*edid) || edid_check_info(edid)) {
1967*4882a593Smuzhiyun 		debug("%s: Invalid buffer\n", __func__);
1968*4882a593Smuzhiyun 		return -EINVAL;
1969*4882a593Smuzhiyun 	}
1970*4882a593Smuzhiyun 
1971*4882a593Smuzhiyun 	if (!EDID1_INFO_FEATURE_PREFERRED_TIMING_MODE(*edid)) {
1972*4882a593Smuzhiyun 		debug("%s: No preferred timing\n", __func__);
1973*4882a593Smuzhiyun 		return -ENOENT;
1974*4882a593Smuzhiyun 	}
1975*4882a593Smuzhiyun 
1976*4882a593Smuzhiyun 	/* Look for detailed timing */
1977*4882a593Smuzhiyun 	timing_done = false;
1978*4882a593Smuzhiyun 	for (i = 0; i < 4; i++) {
1979*4882a593Smuzhiyun 		struct edid_monitor_descriptor *desc;
1980*4882a593Smuzhiyun 
1981*4882a593Smuzhiyun 		desc = &edid->monitor_details.descriptor[i];
1982*4882a593Smuzhiyun 		if (desc->zero_flag_1 != 0) {
1983*4882a593Smuzhiyun 			decode_mode((u8 *)desc, mode);
1984*4882a593Smuzhiyun 			timing_done = true;
1985*4882a593Smuzhiyun 			break;
1986*4882a593Smuzhiyun 		}
1987*4882a593Smuzhiyun 	}
1988*4882a593Smuzhiyun 	if (!timing_done)
1989*4882a593Smuzhiyun 		return -EINVAL;
1990*4882a593Smuzhiyun 
1991*4882a593Smuzhiyun 	if (!EDID1_INFO_VIDEO_INPUT_DIGITAL(*edid)) {
1992*4882a593Smuzhiyun 		debug("%s: Not a digital display\n", __func__);
1993*4882a593Smuzhiyun 		return -ENOSYS;
1994*4882a593Smuzhiyun 	}
1995*4882a593Smuzhiyun 	if (edid->version != 1 || edid->revision < 4) {
1996*4882a593Smuzhiyun 		debug("%s: EDID version %d.%d does not have required info\n",
1997*4882a593Smuzhiyun 		      __func__, edid->version, edid->revision);
1998*4882a593Smuzhiyun 		*panel_bits_per_colourp = -1;
1999*4882a593Smuzhiyun 	} else  {
2000*4882a593Smuzhiyun 		*panel_bits_per_colourp =
2001*4882a593Smuzhiyun 			((edid->video_input_definition & 0x70) >> 3) + 4;
2002*4882a593Smuzhiyun 	}
2003*4882a593Smuzhiyun 
2004*4882a593Smuzhiyun 	return 0;
2005*4882a593Smuzhiyun }
2006*4882a593Smuzhiyun 
edid_get_timing(u8 * buf,int buf_size,struct display_timing * timing,int * panel_bits_per_colourp)2007*4882a593Smuzhiyun int edid_get_timing(u8 *buf, int buf_size, struct display_timing *timing,
2008*4882a593Smuzhiyun 		    int *panel_bits_per_colourp)
2009*4882a593Smuzhiyun {
2010*4882a593Smuzhiyun 	struct edid1_info *edid = (struct edid1_info *)buf;
2011*4882a593Smuzhiyun 	bool timing_done;
2012*4882a593Smuzhiyun 	int i;
2013*4882a593Smuzhiyun 
2014*4882a593Smuzhiyun 	if (buf_size < sizeof(*edid) || edid_check_info(edid)) {
2015*4882a593Smuzhiyun 		debug("%s: Invalid buffer\n", __func__);
2016*4882a593Smuzhiyun 		return -EINVAL;
2017*4882a593Smuzhiyun 	}
2018*4882a593Smuzhiyun 
2019*4882a593Smuzhiyun 	if (!EDID1_INFO_FEATURE_PREFERRED_TIMING_MODE(*edid)) {
2020*4882a593Smuzhiyun 		debug("%s: No preferred timing\n", __func__);
2021*4882a593Smuzhiyun 		return -ENOENT;
2022*4882a593Smuzhiyun 	}
2023*4882a593Smuzhiyun 
2024*4882a593Smuzhiyun 	/* Look for detailed timing */
2025*4882a593Smuzhiyun 	timing_done = false;
2026*4882a593Smuzhiyun 	for (i = 0; i < 4; i++) {
2027*4882a593Smuzhiyun 		struct edid_monitor_descriptor *desc;
2028*4882a593Smuzhiyun 
2029*4882a593Smuzhiyun 		desc = &edid->monitor_details.descriptor[i];
2030*4882a593Smuzhiyun 		if (desc->zero_flag_1 != 0) {
2031*4882a593Smuzhiyun 			decode_timing((u8 *)desc, timing);
2032*4882a593Smuzhiyun 			timing_done = true;
2033*4882a593Smuzhiyun 			break;
2034*4882a593Smuzhiyun 		}
2035*4882a593Smuzhiyun 	}
2036*4882a593Smuzhiyun 	if (!timing_done)
2037*4882a593Smuzhiyun 		return -EINVAL;
2038*4882a593Smuzhiyun 
2039*4882a593Smuzhiyun 	if (!EDID1_INFO_VIDEO_INPUT_DIGITAL(*edid)) {
2040*4882a593Smuzhiyun 		debug("%s: Not a digital display\n", __func__);
2041*4882a593Smuzhiyun 		return -ENOSYS;
2042*4882a593Smuzhiyun 	}
2043*4882a593Smuzhiyun 	if (edid->version != 1 || edid->revision < 4) {
2044*4882a593Smuzhiyun 		debug("%s: EDID version %d.%d does not have required info\n",
2045*4882a593Smuzhiyun 		      __func__, edid->version, edid->revision);
2046*4882a593Smuzhiyun 		*panel_bits_per_colourp = -1;
2047*4882a593Smuzhiyun 	} else  {
2048*4882a593Smuzhiyun 		*panel_bits_per_colourp =
2049*4882a593Smuzhiyun 			((edid->video_input_definition & 0x70) >> 3) + 4;
2050*4882a593Smuzhiyun 	}
2051*4882a593Smuzhiyun 
2052*4882a593Smuzhiyun 	timing->hdmi_monitor = false;
2053*4882a593Smuzhiyun 	if (edid->extension_flag && (buf_size >= EDID_EXT_SIZE)) {
2054*4882a593Smuzhiyun 		struct edid_cea861_info *info =
2055*4882a593Smuzhiyun 			(struct edid_cea861_info *)(buf + sizeof(*edid));
2056*4882a593Smuzhiyun 
2057*4882a593Smuzhiyun 		if (info->extension_tag == EDID_CEA861_EXTENSION_TAG)
2058*4882a593Smuzhiyun 			timing->hdmi_monitor = cea_is_hdmi_vsdb_present(info);
2059*4882a593Smuzhiyun 	}
2060*4882a593Smuzhiyun 
2061*4882a593Smuzhiyun 	return 0;
2062*4882a593Smuzhiyun }
2063*4882a593Smuzhiyun 
2064*4882a593Smuzhiyun /**
2065*4882a593Smuzhiyun  * Snip the tailing whitespace/return of a string.
2066*4882a593Smuzhiyun  *
2067*4882a593Smuzhiyun  * @param string	The string to be snipped
2068*4882a593Smuzhiyun  * @return the snipped string
2069*4882a593Smuzhiyun  */
snip(char * string)2070*4882a593Smuzhiyun static char *snip(char *string)
2071*4882a593Smuzhiyun {
2072*4882a593Smuzhiyun 	char *s;
2073*4882a593Smuzhiyun 
2074*4882a593Smuzhiyun 	/*
2075*4882a593Smuzhiyun 	 * This is always a 13 character buffer
2076*4882a593Smuzhiyun 	 * and it's not always terminated.
2077*4882a593Smuzhiyun 	 */
2078*4882a593Smuzhiyun 	string[12] = '\0';
2079*4882a593Smuzhiyun 	s = &string[strlen(string) - 1];
2080*4882a593Smuzhiyun 
2081*4882a593Smuzhiyun 	while (s >= string && (isspace(*s) || *s == '\n' || *s == '\r' ||
2082*4882a593Smuzhiyun 	       *s == '\0'))
2083*4882a593Smuzhiyun 		*(s--) = '\0';
2084*4882a593Smuzhiyun 
2085*4882a593Smuzhiyun 	return string;
2086*4882a593Smuzhiyun }
2087*4882a593Smuzhiyun 
2088*4882a593Smuzhiyun /**
2089*4882a593Smuzhiyun  * Print an EDID monitor descriptor block
2090*4882a593Smuzhiyun  *
2091*4882a593Smuzhiyun  * @param monitor	The EDID monitor descriptor block
2092*4882a593Smuzhiyun  * @have_timing		Modifies to 1 if the desciptor contains timing info
2093*4882a593Smuzhiyun  */
edid_print_dtd(struct edid_monitor_descriptor * monitor,unsigned int * have_timing)2094*4882a593Smuzhiyun static void edid_print_dtd(struct edid_monitor_descriptor *monitor,
2095*4882a593Smuzhiyun 			   unsigned int *have_timing)
2096*4882a593Smuzhiyun {
2097*4882a593Smuzhiyun 	unsigned char *bytes = (unsigned char *)monitor;
2098*4882a593Smuzhiyun 	struct edid_detailed_timing *timing =
2099*4882a593Smuzhiyun 			(struct edid_detailed_timing *)monitor;
2100*4882a593Smuzhiyun 
2101*4882a593Smuzhiyun 	if (bytes[0] == 0 && bytes[1] == 0) {
2102*4882a593Smuzhiyun 		if (monitor->type == EDID_MONITOR_DESCRIPTOR_SERIAL)
2103*4882a593Smuzhiyun 			printf("Monitor serial number: %s\n",
2104*4882a593Smuzhiyun 			       snip(monitor->data.string));
2105*4882a593Smuzhiyun 		else if (monitor->type == EDID_MONITOR_DESCRIPTOR_ASCII)
2106*4882a593Smuzhiyun 			printf("Monitor ID: %s\n",
2107*4882a593Smuzhiyun 			       snip(monitor->data.string));
2108*4882a593Smuzhiyun 		else if (monitor->type == EDID_MONITOR_DESCRIPTOR_NAME)
2109*4882a593Smuzhiyun 			printf("Monitor name: %s\n",
2110*4882a593Smuzhiyun 			       snip(monitor->data.string));
2111*4882a593Smuzhiyun 		else if (monitor->type == EDID_MONITOR_DESCRIPTOR_RANGE)
2112*4882a593Smuzhiyun 			printf("Monitor range limits, horizontal sync: "
2113*4882a593Smuzhiyun 			       "%d-%d kHz, vertical refresh: "
2114*4882a593Smuzhiyun 			       "%d-%d Hz, max pixel clock: "
2115*4882a593Smuzhiyun 			       "%d MHz\n",
2116*4882a593Smuzhiyun 			       monitor->data.range_data.horizontal_min,
2117*4882a593Smuzhiyun 			       monitor->data.range_data.horizontal_max,
2118*4882a593Smuzhiyun 			       monitor->data.range_data.vertical_min,
2119*4882a593Smuzhiyun 			       monitor->data.range_data.vertical_max,
2120*4882a593Smuzhiyun 			       monitor->data.range_data.pixel_clock_max * 10);
2121*4882a593Smuzhiyun 	} else {
2122*4882a593Smuzhiyun 		u32 pixclock, h_active, h_blanking, v_active, v_blanking;
2123*4882a593Smuzhiyun 		u32 h_total, v_total, vfreq;
2124*4882a593Smuzhiyun 
2125*4882a593Smuzhiyun 		pixclock = EDID_DETAILED_TIMING_PIXEL_CLOCK(*timing);
2126*4882a593Smuzhiyun 		h_active = EDID_DETAILED_TIMING_HORIZONTAL_ACTIVE(*timing);
2127*4882a593Smuzhiyun 		h_blanking = EDID_DETAILED_TIMING_HORIZONTAL_BLANKING(*timing);
2128*4882a593Smuzhiyun 		v_active = EDID_DETAILED_TIMING_VERTICAL_ACTIVE(*timing);
2129*4882a593Smuzhiyun 		v_blanking = EDID_DETAILED_TIMING_VERTICAL_BLANKING(*timing);
2130*4882a593Smuzhiyun 
2131*4882a593Smuzhiyun 		h_total = h_active + h_blanking;
2132*4882a593Smuzhiyun 		v_total = v_active + v_blanking;
2133*4882a593Smuzhiyun 		if (v_total > 0 && h_total > 0)
2134*4882a593Smuzhiyun 			vfreq = pixclock / (v_total * h_total);
2135*4882a593Smuzhiyun 		else
2136*4882a593Smuzhiyun 			vfreq = 1; /* Error case */
2137*4882a593Smuzhiyun 		printf("\t%dx%d\%c\t%d Hz (detailed)\n", h_active,
2138*4882a593Smuzhiyun 		       v_active, h_active > 1000 ? ' ' : '\t', vfreq);
2139*4882a593Smuzhiyun 		*have_timing = 1;
2140*4882a593Smuzhiyun 	}
2141*4882a593Smuzhiyun }
2142*4882a593Smuzhiyun 
2143*4882a593Smuzhiyun /**
2144*4882a593Smuzhiyun  * Get the manufacturer name from an EDID info.
2145*4882a593Smuzhiyun  *
2146*4882a593Smuzhiyun  * @param edid_info     The EDID info to be printed
2147*4882a593Smuzhiyun  * @param name		Returns the string of the manufacturer name
2148*4882a593Smuzhiyun  */
edid_get_manufacturer_name(struct edid1_info * edid,char * name)2149*4882a593Smuzhiyun static void edid_get_manufacturer_name(struct edid1_info *edid, char *name)
2150*4882a593Smuzhiyun {
2151*4882a593Smuzhiyun 	name[0] = EDID1_INFO_MANUFACTURER_NAME_CHAR1(*edid) + 'A' - 1;
2152*4882a593Smuzhiyun 	name[1] = EDID1_INFO_MANUFACTURER_NAME_CHAR2(*edid) + 'A' - 1;
2153*4882a593Smuzhiyun 	name[2] = EDID1_INFO_MANUFACTURER_NAME_CHAR3(*edid) + 'A' - 1;
2154*4882a593Smuzhiyun 	name[3] = '\0';
2155*4882a593Smuzhiyun }
2156*4882a593Smuzhiyun 
edid_print_info(struct edid1_info * edid_info)2157*4882a593Smuzhiyun void edid_print_info(struct edid1_info *edid_info)
2158*4882a593Smuzhiyun {
2159*4882a593Smuzhiyun 	int i;
2160*4882a593Smuzhiyun 	char manufacturer[4];
2161*4882a593Smuzhiyun 	unsigned int have_timing = 0;
2162*4882a593Smuzhiyun 	u32 serial_number;
2163*4882a593Smuzhiyun 
2164*4882a593Smuzhiyun 	if (edid_check_info(edid_info)) {
2165*4882a593Smuzhiyun 		printf("Not a valid EDID\n");
2166*4882a593Smuzhiyun 		return;
2167*4882a593Smuzhiyun 	}
2168*4882a593Smuzhiyun 
2169*4882a593Smuzhiyun 	printf("EDID version: %d.%d\n",
2170*4882a593Smuzhiyun 	       edid_info->version, edid_info->revision);
2171*4882a593Smuzhiyun 
2172*4882a593Smuzhiyun 	printf("Product ID code: %04x\n", EDID1_INFO_PRODUCT_CODE(*edid_info));
2173*4882a593Smuzhiyun 
2174*4882a593Smuzhiyun 	edid_get_manufacturer_name(edid_info, manufacturer);
2175*4882a593Smuzhiyun 	printf("Manufacturer: %s\n", manufacturer);
2176*4882a593Smuzhiyun 
2177*4882a593Smuzhiyun 	serial_number = EDID1_INFO_SERIAL_NUMBER(*edid_info);
2178*4882a593Smuzhiyun 	if (serial_number != 0xffffffff) {
2179*4882a593Smuzhiyun 		if (strcmp(manufacturer, "MAG") == 0)
2180*4882a593Smuzhiyun 			serial_number -= 0x7000000;
2181*4882a593Smuzhiyun 		if (strcmp(manufacturer, "OQI") == 0)
2182*4882a593Smuzhiyun 			serial_number -= 456150000;
2183*4882a593Smuzhiyun 		if (strcmp(manufacturer, "VSC") == 0)
2184*4882a593Smuzhiyun 			serial_number -= 640000000;
2185*4882a593Smuzhiyun 	}
2186*4882a593Smuzhiyun 	printf("Serial number: %08x\n", serial_number);
2187*4882a593Smuzhiyun 	printf("Manufactured in week: %d year: %d\n",
2188*4882a593Smuzhiyun 	       edid_info->week, edid_info->year + 1990);
2189*4882a593Smuzhiyun 
2190*4882a593Smuzhiyun 	printf("Video input definition: %svoltage level %d%s%s%s%s%s\n",
2191*4882a593Smuzhiyun 	       EDID1_INFO_VIDEO_INPUT_DIGITAL(*edid_info) ?
2192*4882a593Smuzhiyun 	       "digital signal, " : "analog signal, ",
2193*4882a593Smuzhiyun 	       EDID1_INFO_VIDEO_INPUT_VOLTAGE_LEVEL(*edid_info),
2194*4882a593Smuzhiyun 	       EDID1_INFO_VIDEO_INPUT_BLANK_TO_BLACK(*edid_info) ?
2195*4882a593Smuzhiyun 	       ", blank to black" : "",
2196*4882a593Smuzhiyun 	       EDID1_INFO_VIDEO_INPUT_SEPARATE_SYNC(*edid_info) ?
2197*4882a593Smuzhiyun 	       ", separate sync" : "",
2198*4882a593Smuzhiyun 	       EDID1_INFO_VIDEO_INPUT_COMPOSITE_SYNC(*edid_info) ?
2199*4882a593Smuzhiyun 	       ", composite sync" : "",
2200*4882a593Smuzhiyun 	       EDID1_INFO_VIDEO_INPUT_SYNC_ON_GREEN(*edid_info) ?
2201*4882a593Smuzhiyun 	       ", sync on green" : "",
2202*4882a593Smuzhiyun 	       EDID1_INFO_VIDEO_INPUT_SERRATION_V(*edid_info) ?
2203*4882a593Smuzhiyun 	       ", serration v" : "");
2204*4882a593Smuzhiyun 
2205*4882a593Smuzhiyun 	printf("Monitor is %s\n",
2206*4882a593Smuzhiyun 	       EDID1_INFO_FEATURE_RGB(*edid_info) ? "RGB" : "non-RGB");
2207*4882a593Smuzhiyun 
2208*4882a593Smuzhiyun 	printf("Maximum visible display size: %d cm x %d cm\n",
2209*4882a593Smuzhiyun 	       edid_info->max_size_horizontal,
2210*4882a593Smuzhiyun 	       edid_info->max_size_vertical);
2211*4882a593Smuzhiyun 
2212*4882a593Smuzhiyun 	printf("Power management features: %s%s, %s%s, %s%s\n",
2213*4882a593Smuzhiyun 	       EDID1_INFO_FEATURE_ACTIVE_OFF(*edid_info) ?
2214*4882a593Smuzhiyun 	       "" : "no ", "active off",
2215*4882a593Smuzhiyun 	       EDID1_INFO_FEATURE_SUSPEND(*edid_info) ? "" : "no ", "suspend",
2216*4882a593Smuzhiyun 	       EDID1_INFO_FEATURE_STANDBY(*edid_info) ? "" : "no ", "standby");
2217*4882a593Smuzhiyun 
2218*4882a593Smuzhiyun 	printf("Estabilished timings:\n");
2219*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_720X400_70(*edid_info))
2220*4882a593Smuzhiyun 		printf("\t720x400\t\t70 Hz (VGA 640x400, IBM)\n");
2221*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_720X400_88(*edid_info))
2222*4882a593Smuzhiyun 		printf("\t720x400\t\t88 Hz (XGA2)\n");
2223*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_60(*edid_info))
2224*4882a593Smuzhiyun 		printf("\t640x480\t\t60 Hz (VGA)\n");
2225*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_67(*edid_info))
2226*4882a593Smuzhiyun 		printf("\t640x480\t\t67 Hz (Mac II, Apple)\n");
2227*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_72(*edid_info))
2228*4882a593Smuzhiyun 		printf("\t640x480\t\t72 Hz (VESA)\n");
2229*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_75(*edid_info))
2230*4882a593Smuzhiyun 		printf("\t640x480\t\t75 Hz (VESA)\n");
2231*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_56(*edid_info))
2232*4882a593Smuzhiyun 		printf("\t800x600\t\t56 Hz (VESA)\n");
2233*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_60(*edid_info))
2234*4882a593Smuzhiyun 		printf("\t800x600\t\t60 Hz (VESA)\n");
2235*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_72(*edid_info))
2236*4882a593Smuzhiyun 		printf("\t800x600\t\t72 Hz (VESA)\n");
2237*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_75(*edid_info))
2238*4882a593Smuzhiyun 		printf("\t800x600\t\t75 Hz (VESA)\n");
2239*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_832X624_75(*edid_info))
2240*4882a593Smuzhiyun 		printf("\t832x624\t\t75 Hz (Mac II)\n");
2241*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_87I(*edid_info))
2242*4882a593Smuzhiyun 		printf("\t1024x768\t87 Hz Interlaced (8514A)\n");
2243*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_60(*edid_info))
2244*4882a593Smuzhiyun 		printf("\t1024x768\t60 Hz (VESA)\n");
2245*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_70(*edid_info))
2246*4882a593Smuzhiyun 		printf("\t1024x768\t70 Hz (VESA)\n");
2247*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_75(*edid_info))
2248*4882a593Smuzhiyun 		printf("\t1024x768\t75 Hz (VESA)\n");
2249*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_1280X1024_75(*edid_info))
2250*4882a593Smuzhiyun 		printf("\t1280x1024\t75 (VESA)\n");
2251*4882a593Smuzhiyun 	if (EDID1_INFO_ESTABLISHED_TIMING_1152X870_75(*edid_info))
2252*4882a593Smuzhiyun 		printf("\t1152x870\t75 (Mac II)\n");
2253*4882a593Smuzhiyun 
2254*4882a593Smuzhiyun 	/* Standard timings. */
2255*4882a593Smuzhiyun 	printf("Standard timings:\n");
2256*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(edid_info->standard_timings); i++) {
2257*4882a593Smuzhiyun 		unsigned int aspect = 10000;
2258*4882a593Smuzhiyun 		unsigned int x, y;
2259*4882a593Smuzhiyun 		unsigned char xres, vfreq;
2260*4882a593Smuzhiyun 
2261*4882a593Smuzhiyun 		xres = EDID1_INFO_STANDARD_TIMING_XRESOLUTION(*edid_info, i);
2262*4882a593Smuzhiyun 		vfreq = EDID1_INFO_STANDARD_TIMING_VFREQ(*edid_info, i);
2263*4882a593Smuzhiyun 		if ((xres != vfreq) ||
2264*4882a593Smuzhiyun 		    ((xres != 0) && (xres != 1)) ||
2265*4882a593Smuzhiyun 		    ((vfreq != 0) && (vfreq != 1))) {
2266*4882a593Smuzhiyun 			switch (EDID1_INFO_STANDARD_TIMING_ASPECT(*edid_info,
2267*4882a593Smuzhiyun 				i)) {
2268*4882a593Smuzhiyun 			case ASPECT_625:
2269*4882a593Smuzhiyun 				aspect = 6250;
2270*4882a593Smuzhiyun 				break;
2271*4882a593Smuzhiyun 			case ASPECT_75:
2272*4882a593Smuzhiyun 				aspect = 7500;
2273*4882a593Smuzhiyun 				break;
2274*4882a593Smuzhiyun 			case ASPECT_8:
2275*4882a593Smuzhiyun 				aspect = 8000;
2276*4882a593Smuzhiyun 				break;
2277*4882a593Smuzhiyun 			case ASPECT_5625:
2278*4882a593Smuzhiyun 				aspect = 5625;
2279*4882a593Smuzhiyun 				break;
2280*4882a593Smuzhiyun 			}
2281*4882a593Smuzhiyun 			x = (xres + 31) * 8;
2282*4882a593Smuzhiyun 			y = x * aspect / 10000;
2283*4882a593Smuzhiyun 			printf("\t%dx%d%c\t%d Hz\n", x, y,
2284*4882a593Smuzhiyun 			       x > 1000 ? ' ' : '\t', (vfreq & 0x3f) + 60);
2285*4882a593Smuzhiyun 			have_timing = 1;
2286*4882a593Smuzhiyun 		}
2287*4882a593Smuzhiyun 	}
2288*4882a593Smuzhiyun 
2289*4882a593Smuzhiyun 	/* Detailed timing information. */
2290*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(edid_info->monitor_details.descriptor);
2291*4882a593Smuzhiyun 			i++) {
2292*4882a593Smuzhiyun 		edid_print_dtd(&edid_info->monitor_details.descriptor[i],
2293*4882a593Smuzhiyun 			       &have_timing);
2294*4882a593Smuzhiyun 	}
2295*4882a593Smuzhiyun 
2296*4882a593Smuzhiyun 	if (!have_timing)
2297*4882a593Smuzhiyun 		printf("\tNone\n");
2298*4882a593Smuzhiyun }
2299*4882a593Smuzhiyun 
2300*4882a593Smuzhiyun /**
2301*4882a593Smuzhiyun  * drm_cvt_mode -create a modeline based on the CVT algorithm
2302*4882a593Smuzhiyun  * @hdisplay: hdisplay size
2303*4882a593Smuzhiyun  * @vdisplay: vdisplay size
2304*4882a593Smuzhiyun  * @vrefresh: vrefresh rate
2305*4882a593Smuzhiyun  * @reduced: whether to use reduced blanking
2306*4882a593Smuzhiyun  * @interlaced: whether to compute an interlaced mode
2307*4882a593Smuzhiyun  * @margins: whether to add margins (borders)
2308*4882a593Smuzhiyun  *
2309*4882a593Smuzhiyun  * This function is called to generate the modeline based on CVT algorithm
2310*4882a593Smuzhiyun  * according to the hdisplay, vdisplay, vrefresh.
2311*4882a593Smuzhiyun  * It is based from the VESA(TM) Coordinated Video Timing Generator by
2312*4882a593Smuzhiyun  * Graham Loveridge April 9, 2003 available at
2313*4882a593Smuzhiyun  * http://www.elo.utfsm.cl/~elo212/docs/CVTd6r1.xls
2314*4882a593Smuzhiyun  *
2315*4882a593Smuzhiyun  * And it is copied from xf86CVTmode in xserver/hw/xfree86/modes/xf86cvt.c.
2316*4882a593Smuzhiyun  * What I have done is to translate it by using integer calculation.
2317*4882a593Smuzhiyun  *
2318*4882a593Smuzhiyun  * Returns:
2319*4882a593Smuzhiyun  * The modeline based on the CVT algorithm stored in a drm_display_mode object.
2320*4882a593Smuzhiyun  * The display mode object is allocated with drm_mode_create(). Returns NULL
2321*4882a593Smuzhiyun  * when no mode could be allocated.
2322*4882a593Smuzhiyun  */
2323*4882a593Smuzhiyun static
drm_cvt_mode(int hdisplay,int vdisplay,int vrefresh,bool reduced,bool interlaced,bool margins)2324*4882a593Smuzhiyun struct drm_display_mode *drm_cvt_mode(int hdisplay, int vdisplay, int vrefresh,
2325*4882a593Smuzhiyun 				      bool reduced, bool interlaced,
2326*4882a593Smuzhiyun 				      bool margins)
2327*4882a593Smuzhiyun {
2328*4882a593Smuzhiyun #define HV_FACTOR			1000
2329*4882a593Smuzhiyun 	/* 1) top/bottom margin size (% of height) - default: 1.8, */
2330*4882a593Smuzhiyun #define	CVT_MARGIN_PERCENTAGE		18
2331*4882a593Smuzhiyun 	/* 2) character cell horizontal granularity (pixels) - default 8 */
2332*4882a593Smuzhiyun #define	CVT_H_GRANULARITY		8
2333*4882a593Smuzhiyun 	/* 3) Minimum vertical porch (lines) - default 3 */
2334*4882a593Smuzhiyun #define	CVT_MIN_V_PORCH			3
2335*4882a593Smuzhiyun 	/* 4) Minimum number of vertical back porch lines - default 6 */
2336*4882a593Smuzhiyun #define	CVT_MIN_V_BPORCH		6
2337*4882a593Smuzhiyun 	/* Pixel Clock step (kHz) */
2338*4882a593Smuzhiyun #define CVT_CLOCK_STEP			250
2339*4882a593Smuzhiyun 	struct drm_display_mode *drm_mode;
2340*4882a593Smuzhiyun 	unsigned int vfieldrate, hperiod;
2341*4882a593Smuzhiyun 	int hdisplay_rnd, hmargin, vdisplay_rnd, vmargin, vsync;
2342*4882a593Smuzhiyun 	int interlace;
2343*4882a593Smuzhiyun 
2344*4882a593Smuzhiyun 	/* allocate the drm_display_mode structure. If failure, we will
2345*4882a593Smuzhiyun 	 * return directly
2346*4882a593Smuzhiyun 	 */
2347*4882a593Smuzhiyun 	drm_mode = drm_mode_create();
2348*4882a593Smuzhiyun 	if (!drm_mode)
2349*4882a593Smuzhiyun 		return NULL;
2350*4882a593Smuzhiyun 
2351*4882a593Smuzhiyun 	/* the CVT default refresh rate is 60Hz */
2352*4882a593Smuzhiyun 	if (!vrefresh)
2353*4882a593Smuzhiyun 		vrefresh = 60;
2354*4882a593Smuzhiyun 
2355*4882a593Smuzhiyun 	/* the required field fresh rate */
2356*4882a593Smuzhiyun 	if (interlaced)
2357*4882a593Smuzhiyun 		vfieldrate = vrefresh * 2;
2358*4882a593Smuzhiyun 	else
2359*4882a593Smuzhiyun 		vfieldrate = vrefresh;
2360*4882a593Smuzhiyun 
2361*4882a593Smuzhiyun 	/* horizontal pixels */
2362*4882a593Smuzhiyun 	hdisplay_rnd = hdisplay - (hdisplay % CVT_H_GRANULARITY);
2363*4882a593Smuzhiyun 
2364*4882a593Smuzhiyun 	/* determine the left&right borders */
2365*4882a593Smuzhiyun 	hmargin = 0;
2366*4882a593Smuzhiyun 	if (margins) {
2367*4882a593Smuzhiyun 		hmargin = hdisplay_rnd * CVT_MARGIN_PERCENTAGE / 1000;
2368*4882a593Smuzhiyun 		hmargin -= hmargin % CVT_H_GRANULARITY;
2369*4882a593Smuzhiyun 	}
2370*4882a593Smuzhiyun 	/* find the total active pixels */
2371*4882a593Smuzhiyun 	drm_mode->hdisplay = hdisplay_rnd + 2 * hmargin;
2372*4882a593Smuzhiyun 
2373*4882a593Smuzhiyun 	/* find the number of lines per field */
2374*4882a593Smuzhiyun 	if (interlaced)
2375*4882a593Smuzhiyun 		vdisplay_rnd = vdisplay / 2;
2376*4882a593Smuzhiyun 	else
2377*4882a593Smuzhiyun 		vdisplay_rnd = vdisplay;
2378*4882a593Smuzhiyun 
2379*4882a593Smuzhiyun 	/* find the top & bottom borders */
2380*4882a593Smuzhiyun 	vmargin = 0;
2381*4882a593Smuzhiyun 	if (margins)
2382*4882a593Smuzhiyun 		vmargin = vdisplay_rnd * CVT_MARGIN_PERCENTAGE / 1000;
2383*4882a593Smuzhiyun 
2384*4882a593Smuzhiyun 	drm_mode->vdisplay = vdisplay + 2 * vmargin;
2385*4882a593Smuzhiyun 
2386*4882a593Smuzhiyun 	/* Interlaced */
2387*4882a593Smuzhiyun 	if (interlaced)
2388*4882a593Smuzhiyun 		interlace = 1;
2389*4882a593Smuzhiyun 	else
2390*4882a593Smuzhiyun 		interlace = 0;
2391*4882a593Smuzhiyun 
2392*4882a593Smuzhiyun 	/* Determine VSync Width from aspect ratio */
2393*4882a593Smuzhiyun 	if (!(vdisplay % 3) && ((vdisplay * 4 / 3) == hdisplay))
2394*4882a593Smuzhiyun 		vsync = 4;
2395*4882a593Smuzhiyun 	else if (!(vdisplay % 9) && ((vdisplay * 16 / 9) == hdisplay))
2396*4882a593Smuzhiyun 		vsync = 5;
2397*4882a593Smuzhiyun 	else if (!(vdisplay % 10) && ((vdisplay * 16 / 10) == hdisplay))
2398*4882a593Smuzhiyun 		vsync = 6;
2399*4882a593Smuzhiyun 	else if (!(vdisplay % 4) && ((vdisplay * 5 / 4) == hdisplay))
2400*4882a593Smuzhiyun 		vsync = 7;
2401*4882a593Smuzhiyun 	else if (!(vdisplay % 9) && ((vdisplay * 15 / 9) == hdisplay))
2402*4882a593Smuzhiyun 		vsync = 7;
2403*4882a593Smuzhiyun 	else /* custom */
2404*4882a593Smuzhiyun 		vsync = 10;
2405*4882a593Smuzhiyun 
2406*4882a593Smuzhiyun 	if (!reduced) {
2407*4882a593Smuzhiyun 		/* simplify the GTF calculation */
2408*4882a593Smuzhiyun 		/* 4) Minimum time of vertical sync + back porch interval
2409*4882a593Smuzhiyun 		 * default 550.0
2410*4882a593Smuzhiyun 		 */
2411*4882a593Smuzhiyun 		int tmp1, tmp2;
2412*4882a593Smuzhiyun #define CVT_MIN_VSYNC_BP	550
2413*4882a593Smuzhiyun 		/* 3) Nominal HSync width (% of line period) - default 8 */
2414*4882a593Smuzhiyun #define CVT_HSYNC_PERCENTAGE	8
2415*4882a593Smuzhiyun 		unsigned int hblank_percentage;
2416*4882a593Smuzhiyun 		int vsyncandback_porch, hblank;
2417*4882a593Smuzhiyun 
2418*4882a593Smuzhiyun 		/* estimated the horizontal period */
2419*4882a593Smuzhiyun 		tmp1 = HV_FACTOR * 1000000  -
2420*4882a593Smuzhiyun 				CVT_MIN_VSYNC_BP * HV_FACTOR * vfieldrate;
2421*4882a593Smuzhiyun 		tmp2 = (vdisplay_rnd + 2 * vmargin + CVT_MIN_V_PORCH) * 2 +
2422*4882a593Smuzhiyun 				interlace;
2423*4882a593Smuzhiyun 		hperiod = tmp1 * 2 / (tmp2 * vfieldrate);
2424*4882a593Smuzhiyun 
2425*4882a593Smuzhiyun 		tmp1 = CVT_MIN_VSYNC_BP * HV_FACTOR / hperiod + 1;
2426*4882a593Smuzhiyun 		/* 9. Find number of lines in sync + backporch */
2427*4882a593Smuzhiyun 		if (tmp1 < (vsync + CVT_MIN_V_PORCH))
2428*4882a593Smuzhiyun 			vsyncandback_porch = vsync + CVT_MIN_V_PORCH;
2429*4882a593Smuzhiyun 		else
2430*4882a593Smuzhiyun 			vsyncandback_porch = tmp1;
2431*4882a593Smuzhiyun 		/* 10. Find number of lines in back porch
2432*4882a593Smuzhiyun 		 *		vback_porch = vsyncandback_porch - vsync;
2433*4882a593Smuzhiyun 		 */
2434*4882a593Smuzhiyun 		drm_mode->vtotal = vdisplay_rnd + 2 * vmargin +
2435*4882a593Smuzhiyun 				vsyncandback_porch + CVT_MIN_V_PORCH;
2436*4882a593Smuzhiyun 		/* 5) Definition of Horizontal blanking time limitation */
2437*4882a593Smuzhiyun 		/* Gradient (%/kHz) - default 600 */
2438*4882a593Smuzhiyun #define CVT_M_FACTOR	600
2439*4882a593Smuzhiyun 		/* Offset (%) - default 40 */
2440*4882a593Smuzhiyun #define CVT_C_FACTOR	40
2441*4882a593Smuzhiyun 		/* Blanking time scaling factor - default 128 */
2442*4882a593Smuzhiyun #define CVT_K_FACTOR	128
2443*4882a593Smuzhiyun 		/* Scaling factor weighting - default 20 */
2444*4882a593Smuzhiyun #define CVT_J_FACTOR	20
2445*4882a593Smuzhiyun #define CVT_M_PRIME	(CVT_M_FACTOR * CVT_K_FACTOR / 256)
2446*4882a593Smuzhiyun #define CVT_C_PRIME	((CVT_C_FACTOR - CVT_J_FACTOR) * CVT_K_FACTOR / 256 + \
2447*4882a593Smuzhiyun 			 CVT_J_FACTOR)
2448*4882a593Smuzhiyun 		/* 12. Find ideal blanking duty cycle from formula */
2449*4882a593Smuzhiyun 		hblank_percentage = CVT_C_PRIME * HV_FACTOR - CVT_M_PRIME *
2450*4882a593Smuzhiyun 					hperiod / 1000;
2451*4882a593Smuzhiyun 		/* 13. Blanking time */
2452*4882a593Smuzhiyun 		if (hblank_percentage < 20 * HV_FACTOR)
2453*4882a593Smuzhiyun 			hblank_percentage = 20 * HV_FACTOR;
2454*4882a593Smuzhiyun 		hblank = drm_mode->hdisplay * hblank_percentage /
2455*4882a593Smuzhiyun 			 (100 * HV_FACTOR - hblank_percentage);
2456*4882a593Smuzhiyun 		hblank -= hblank % (2 * CVT_H_GRANULARITY);
2457*4882a593Smuzhiyun 		/* 14. find the total pixels per line */
2458*4882a593Smuzhiyun 		drm_mode->htotal = drm_mode->hdisplay + hblank;
2459*4882a593Smuzhiyun 		drm_mode->hsync_end = drm_mode->hdisplay + hblank / 2;
2460*4882a593Smuzhiyun 		drm_mode->hsync_start = drm_mode->hsync_end -
2461*4882a593Smuzhiyun 			(drm_mode->htotal * CVT_HSYNC_PERCENTAGE) / 100;
2462*4882a593Smuzhiyun 		drm_mode->hsync_start += CVT_H_GRANULARITY -
2463*4882a593Smuzhiyun 			drm_mode->hsync_start % CVT_H_GRANULARITY;
2464*4882a593Smuzhiyun 		/* fill the Vsync values */
2465*4882a593Smuzhiyun 		drm_mode->vsync_start = drm_mode->vdisplay + CVT_MIN_V_PORCH;
2466*4882a593Smuzhiyun 		drm_mode->vsync_end = drm_mode->vsync_start + vsync;
2467*4882a593Smuzhiyun 	} else {
2468*4882a593Smuzhiyun 		/* Reduced blanking */
2469*4882a593Smuzhiyun 		/* Minimum vertical blanking interval time - default 460 */
2470*4882a593Smuzhiyun #define CVT_RB_MIN_VBLANK	460
2471*4882a593Smuzhiyun 		/* Fixed number of clocks for horizontal sync */
2472*4882a593Smuzhiyun #define CVT_RB_H_SYNC		32
2473*4882a593Smuzhiyun 		/* Fixed number of clocks for horizontal blanking */
2474*4882a593Smuzhiyun #define CVT_RB_H_BLANK		160
2475*4882a593Smuzhiyun 		/* Fixed number of lines for vertical front porch - default 3*/
2476*4882a593Smuzhiyun #define CVT_RB_VFPORCH		3
2477*4882a593Smuzhiyun 		int vbilines;
2478*4882a593Smuzhiyun 		int tmp1, tmp2;
2479*4882a593Smuzhiyun 		/* 8. Estimate Horizontal period. */
2480*4882a593Smuzhiyun 		tmp1 = HV_FACTOR * 1000000 -
2481*4882a593Smuzhiyun 			CVT_RB_MIN_VBLANK * HV_FACTOR * vfieldrate;
2482*4882a593Smuzhiyun 		tmp2 = vdisplay_rnd + 2 * vmargin;
2483*4882a593Smuzhiyun 		hperiod = tmp1 / (tmp2 * vfieldrate);
2484*4882a593Smuzhiyun 		/* 9. Find number of lines in vertical blanking */
2485*4882a593Smuzhiyun 		vbilines = CVT_RB_MIN_VBLANK * HV_FACTOR / hperiod + 1;
2486*4882a593Smuzhiyun 		/* 10. Check if vertical blanking is sufficient */
2487*4882a593Smuzhiyun 		if (vbilines < (CVT_RB_VFPORCH + vsync + CVT_MIN_V_BPORCH))
2488*4882a593Smuzhiyun 			vbilines = CVT_RB_VFPORCH + vsync + CVT_MIN_V_BPORCH;
2489*4882a593Smuzhiyun 		/* 11. Find total number of lines in vertical field */
2490*4882a593Smuzhiyun 		drm_mode->vtotal = vdisplay_rnd + 2 * vmargin + vbilines;
2491*4882a593Smuzhiyun 		/* 12. Find total number of pixels in a line */
2492*4882a593Smuzhiyun 		drm_mode->htotal = drm_mode->hdisplay + CVT_RB_H_BLANK;
2493*4882a593Smuzhiyun 		/* Fill in HSync values */
2494*4882a593Smuzhiyun 		drm_mode->hsync_end = drm_mode->hdisplay + CVT_RB_H_BLANK / 2;
2495*4882a593Smuzhiyun 		drm_mode->hsync_start = drm_mode->hsync_end - CVT_RB_H_SYNC;
2496*4882a593Smuzhiyun 		/* Fill in VSync values */
2497*4882a593Smuzhiyun 		drm_mode->vsync_start = drm_mode->vdisplay + CVT_RB_VFPORCH;
2498*4882a593Smuzhiyun 		drm_mode->vsync_end = drm_mode->vsync_start + vsync;
2499*4882a593Smuzhiyun 	}
2500*4882a593Smuzhiyun 	/* 15/13. Find pixel clock frequency (kHz for xf86) */
2501*4882a593Smuzhiyun 	drm_mode->clock = drm_mode->htotal * HV_FACTOR * 1000 / hperiod;
2502*4882a593Smuzhiyun 	drm_mode->clock -= drm_mode->clock % CVT_CLOCK_STEP;
2503*4882a593Smuzhiyun 	/* 18/16. Find actual vertical frame frequency */
2504*4882a593Smuzhiyun 	/* ignore - just set the mode flag for interlaced */
2505*4882a593Smuzhiyun 	if (interlaced) {
2506*4882a593Smuzhiyun 		drm_mode->vtotal *= 2;
2507*4882a593Smuzhiyun 		drm_mode->flags |= DRM_MODE_FLAG_INTERLACE;
2508*4882a593Smuzhiyun 	}
2509*4882a593Smuzhiyun 
2510*4882a593Smuzhiyun 	if (reduced)
2511*4882a593Smuzhiyun 		drm_mode->flags |= (DRM_MODE_FLAG_PHSYNC |
2512*4882a593Smuzhiyun 					DRM_MODE_FLAG_NVSYNC);
2513*4882a593Smuzhiyun 	else
2514*4882a593Smuzhiyun 		drm_mode->flags |= (DRM_MODE_FLAG_PVSYNC |
2515*4882a593Smuzhiyun 					DRM_MODE_FLAG_NHSYNC);
2516*4882a593Smuzhiyun 
2517*4882a593Smuzhiyun 	return drm_mode;
2518*4882a593Smuzhiyun }
2519*4882a593Smuzhiyun 
2520*4882a593Smuzhiyun static int
cea_db_payload_len(const u8 * db)2521*4882a593Smuzhiyun cea_db_payload_len(const u8 *db)
2522*4882a593Smuzhiyun {
2523*4882a593Smuzhiyun 	return db[0] & 0x1f;
2524*4882a593Smuzhiyun }
2525*4882a593Smuzhiyun 
2526*4882a593Smuzhiyun static int
cea_db_extended_tag(const u8 * db)2527*4882a593Smuzhiyun cea_db_extended_tag(const u8 *db)
2528*4882a593Smuzhiyun {
2529*4882a593Smuzhiyun 	return db[1];
2530*4882a593Smuzhiyun }
2531*4882a593Smuzhiyun 
2532*4882a593Smuzhiyun static int
cea_db_tag(const u8 * db)2533*4882a593Smuzhiyun cea_db_tag(const u8 *db)
2534*4882a593Smuzhiyun {
2535*4882a593Smuzhiyun 	return db[0] >> 5;
2536*4882a593Smuzhiyun }
2537*4882a593Smuzhiyun 
2538*4882a593Smuzhiyun #define for_each_cea_db(cea, i, start, end) \
2539*4882a593Smuzhiyun 	for ((i) = (start); (i) < (end) && (i) + \
2540*4882a593Smuzhiyun 	cea_db_payload_len(&(cea)[(i)]) < \
2541*4882a593Smuzhiyun 	(end); (i) += cea_db_payload_len(&(cea)[(i)]) + 1)
2542*4882a593Smuzhiyun 
2543*4882a593Smuzhiyun static int
cea_revision(const u8 * cea)2544*4882a593Smuzhiyun cea_revision(const u8 *cea)
2545*4882a593Smuzhiyun {
2546*4882a593Smuzhiyun 	return cea[1];
2547*4882a593Smuzhiyun }
2548*4882a593Smuzhiyun 
2549*4882a593Smuzhiyun static int
cea_db_offsets(const u8 * cea,int * start,int * end)2550*4882a593Smuzhiyun cea_db_offsets(const u8 *cea, int *start, int *end)
2551*4882a593Smuzhiyun {
2552*4882a593Smuzhiyun 	/* Data block offset in CEA extension block */
2553*4882a593Smuzhiyun 	*start = 4;
2554*4882a593Smuzhiyun 	*end = cea[2];
2555*4882a593Smuzhiyun 	if (*end == 0)
2556*4882a593Smuzhiyun 		*end = 127;
2557*4882a593Smuzhiyun 	if (*end < 4 || *end > 127)
2558*4882a593Smuzhiyun 		return -ERANGE;
2559*4882a593Smuzhiyun 
2560*4882a593Smuzhiyun 	/*
2561*4882a593Smuzhiyun 	 * XXX: cea[2] is equal to the real value minus one in some sink edid.
2562*4882a593Smuzhiyun 	 */
2563*4882a593Smuzhiyun 	if (*end != 4) {
2564*4882a593Smuzhiyun 		int i;
2565*4882a593Smuzhiyun 
2566*4882a593Smuzhiyun 		i = *start;
2567*4882a593Smuzhiyun 		while (i < (*end) &&
2568*4882a593Smuzhiyun 		       i + cea_db_payload_len(&(cea)[i]) < (*end))
2569*4882a593Smuzhiyun 			i += cea_db_payload_len(&(cea)[i]) + 1;
2570*4882a593Smuzhiyun 
2571*4882a593Smuzhiyun 		if (cea_db_payload_len(&(cea)[i]) &&
2572*4882a593Smuzhiyun 		    i + cea_db_payload_len(&(cea)[i]) == (*end))
2573*4882a593Smuzhiyun 			(*end)++;
2574*4882a593Smuzhiyun 	}
2575*4882a593Smuzhiyun 
2576*4882a593Smuzhiyun 	return 0;
2577*4882a593Smuzhiyun }
2578*4882a593Smuzhiyun 
cea_db_is_hdmi_vsdb(const u8 * db)2579*4882a593Smuzhiyun static bool cea_db_is_hdmi_vsdb(const u8 *db)
2580*4882a593Smuzhiyun {
2581*4882a593Smuzhiyun 	int hdmi_id;
2582*4882a593Smuzhiyun 
2583*4882a593Smuzhiyun 	if (cea_db_tag(db) != EDID_CEA861_DB_VENDOR)
2584*4882a593Smuzhiyun 		return false;
2585*4882a593Smuzhiyun 
2586*4882a593Smuzhiyun 	if (cea_db_payload_len(db) < 5)
2587*4882a593Smuzhiyun 		return false;
2588*4882a593Smuzhiyun 
2589*4882a593Smuzhiyun 	hdmi_id = db[1] | (db[2] << 8) | (db[3] << 16);
2590*4882a593Smuzhiyun 
2591*4882a593Smuzhiyun 	return hdmi_id == HDMI_IEEE_OUI;
2592*4882a593Smuzhiyun }
2593*4882a593Smuzhiyun 
cea_db_is_hdmi_forum_vsdb(const u8 * db)2594*4882a593Smuzhiyun static bool cea_db_is_hdmi_forum_vsdb(const u8 *db)
2595*4882a593Smuzhiyun {
2596*4882a593Smuzhiyun 	unsigned int oui;
2597*4882a593Smuzhiyun 
2598*4882a593Smuzhiyun 	if (cea_db_tag(db) != EDID_CEA861_DB_VENDOR)
2599*4882a593Smuzhiyun 		return false;
2600*4882a593Smuzhiyun 
2601*4882a593Smuzhiyun 	if (cea_db_payload_len(db) < 7)
2602*4882a593Smuzhiyun 		return false;
2603*4882a593Smuzhiyun 
2604*4882a593Smuzhiyun 	oui = db[3] << 16 | db[2] << 8 | db[1];
2605*4882a593Smuzhiyun 
2606*4882a593Smuzhiyun 	return oui == HDMI_FORUM_IEEE_OUI;
2607*4882a593Smuzhiyun }
2608*4882a593Smuzhiyun 
cea_db_is_y420cmdb(const u8 * db)2609*4882a593Smuzhiyun static bool cea_db_is_y420cmdb(const u8 *db)
2610*4882a593Smuzhiyun {
2611*4882a593Smuzhiyun 	if (cea_db_tag(db) != EDID_CEA861_DB_USE_EXTENDED)
2612*4882a593Smuzhiyun 		return false;
2613*4882a593Smuzhiyun 
2614*4882a593Smuzhiyun 	if (!cea_db_payload_len(db))
2615*4882a593Smuzhiyun 		return false;
2616*4882a593Smuzhiyun 
2617*4882a593Smuzhiyun 	if (cea_db_extended_tag(db) != EXT_VIDEO_CAP_BLOCK_Y420CMDB)
2618*4882a593Smuzhiyun 		return false;
2619*4882a593Smuzhiyun 
2620*4882a593Smuzhiyun 	return true;
2621*4882a593Smuzhiyun }
2622*4882a593Smuzhiyun 
cea_db_is_y420vdb(const u8 * db)2623*4882a593Smuzhiyun static bool cea_db_is_y420vdb(const u8 *db)
2624*4882a593Smuzhiyun {
2625*4882a593Smuzhiyun 	if (cea_db_tag(db) != EDID_CEA861_DB_USE_EXTENDED)
2626*4882a593Smuzhiyun 		return false;
2627*4882a593Smuzhiyun 
2628*4882a593Smuzhiyun 	if (!cea_db_payload_len(db))
2629*4882a593Smuzhiyun 		return false;
2630*4882a593Smuzhiyun 
2631*4882a593Smuzhiyun 	if (cea_db_extended_tag(db) != EXT_VIDEO_DATA_BLOCK_420)
2632*4882a593Smuzhiyun 		return false;
2633*4882a593Smuzhiyun 
2634*4882a593Smuzhiyun 	return true;
2635*4882a593Smuzhiyun }
2636*4882a593Smuzhiyun 
drm_valid_hdmi_vic(u8 vic)2637*4882a593Smuzhiyun static bool drm_valid_hdmi_vic(u8 vic)
2638*4882a593Smuzhiyun {
2639*4882a593Smuzhiyun 	return vic > 0 && vic < ARRAY_SIZE(edid_4k_modes);
2640*4882a593Smuzhiyun }
2641*4882a593Smuzhiyun 
drm_add_hdmi_modes(struct hdmi_edid_data * data,const struct drm_display_mode * mode)2642*4882a593Smuzhiyun static void drm_add_hdmi_modes(struct hdmi_edid_data *data,
2643*4882a593Smuzhiyun 			       const struct drm_display_mode *mode)
2644*4882a593Smuzhiyun {
2645*4882a593Smuzhiyun 	struct drm_display_mode *mode_buf = data->mode_buf;
2646*4882a593Smuzhiyun 
2647*4882a593Smuzhiyun 	if (data->modes >= MODE_LEN)
2648*4882a593Smuzhiyun 		return;
2649*4882a593Smuzhiyun 	mode_buf[(data->modes)++] = *mode;
2650*4882a593Smuzhiyun }
2651*4882a593Smuzhiyun 
drm_valid_cea_vic(u8 vic)2652*4882a593Smuzhiyun static bool drm_valid_cea_vic(u8 vic)
2653*4882a593Smuzhiyun {
2654*4882a593Smuzhiyun 	return cea_mode_for_vic(vic) ? true : false;
2655*4882a593Smuzhiyun }
2656*4882a593Smuzhiyun 
svd_to_vic(u8 svd)2657*4882a593Smuzhiyun static u8 svd_to_vic(u8 svd)
2658*4882a593Smuzhiyun {
2659*4882a593Smuzhiyun 	/* 0-6 bit vic, 7th bit native mode indicator */
2660*4882a593Smuzhiyun 	if ((svd >= 1 &&  svd <= 64) || (svd >= 129 && svd <= 192))
2661*4882a593Smuzhiyun 		return svd & 127;
2662*4882a593Smuzhiyun 
2663*4882a593Smuzhiyun 	return svd;
2664*4882a593Smuzhiyun }
2665*4882a593Smuzhiyun 
2666*4882a593Smuzhiyun static struct drm_display_mode *
drm_display_mode_from_vic_index(const u8 * video_db,u8 video_len,u8 video_index)2667*4882a593Smuzhiyun drm_display_mode_from_vic_index(const u8 *video_db, u8 video_len,
2668*4882a593Smuzhiyun 				u8 video_index)
2669*4882a593Smuzhiyun {
2670*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
2671*4882a593Smuzhiyun 	u8 vic;
2672*4882a593Smuzhiyun 
2673*4882a593Smuzhiyun 	if (!video_db || video_index >= video_len)
2674*4882a593Smuzhiyun 		return NULL;
2675*4882a593Smuzhiyun 
2676*4882a593Smuzhiyun 	/* CEA modes are numbered 1..127 */
2677*4882a593Smuzhiyun 	vic = svd_to_vic(video_db[video_index]);
2678*4882a593Smuzhiyun 	if (!drm_valid_cea_vic(vic))
2679*4882a593Smuzhiyun 		return NULL;
2680*4882a593Smuzhiyun 
2681*4882a593Smuzhiyun 	newmode = drm_mode_create();
2682*4882a593Smuzhiyun 	if (!newmode)
2683*4882a593Smuzhiyun 		return NULL;
2684*4882a593Smuzhiyun 
2685*4882a593Smuzhiyun 	*newmode = *cea_mode_for_vic(vic);
2686*4882a593Smuzhiyun 	newmode->vrefresh = 0;
2687*4882a593Smuzhiyun 
2688*4882a593Smuzhiyun 	return newmode;
2689*4882a593Smuzhiyun }
2690*4882a593Smuzhiyun 
bitmap_set(unsigned long * map,unsigned int start,int len)2691*4882a593Smuzhiyun static void bitmap_set(unsigned long *map, unsigned int start, int len)
2692*4882a593Smuzhiyun {
2693*4882a593Smuzhiyun 	unsigned long *p = map + BIT_WORD(start);
2694*4882a593Smuzhiyun 	const unsigned int size = start + len;
2695*4882a593Smuzhiyun 	int bits_to_set = BITS_PER_LONG - (start % BITS_PER_LONG);
2696*4882a593Smuzhiyun 	unsigned long mask_to_set = BITMAP_FIRST_WORD_MASK(start);
2697*4882a593Smuzhiyun 
2698*4882a593Smuzhiyun 	while (len - bits_to_set >= 0) {
2699*4882a593Smuzhiyun 		*p |= mask_to_set;
2700*4882a593Smuzhiyun 		len -= bits_to_set;
2701*4882a593Smuzhiyun 		bits_to_set = BITS_PER_LONG;
2702*4882a593Smuzhiyun 		mask_to_set = ~0UL;
2703*4882a593Smuzhiyun 		p++;
2704*4882a593Smuzhiyun 	}
2705*4882a593Smuzhiyun 	if (len) {
2706*4882a593Smuzhiyun 		mask_to_set &= BITMAP_LAST_WORD_MASK(size);
2707*4882a593Smuzhiyun 		*p |= mask_to_set;
2708*4882a593Smuzhiyun 	}
2709*4882a593Smuzhiyun }
2710*4882a593Smuzhiyun 
2711*4882a593Smuzhiyun static void
drm_add_cmdb_modes(u8 svd,struct drm_hdmi_info * hdmi)2712*4882a593Smuzhiyun drm_add_cmdb_modes(u8 svd, struct drm_hdmi_info *hdmi)
2713*4882a593Smuzhiyun {
2714*4882a593Smuzhiyun 	u8 vic = svd_to_vic(svd);
2715*4882a593Smuzhiyun 
2716*4882a593Smuzhiyun 	if (!drm_valid_cea_vic(vic))
2717*4882a593Smuzhiyun 		return;
2718*4882a593Smuzhiyun 
2719*4882a593Smuzhiyun 	bitmap_set(hdmi->y420_cmdb_modes, vic, 1);
2720*4882a593Smuzhiyun }
2721*4882a593Smuzhiyun 
do_cea_modes(struct hdmi_edid_data * data,const u8 * db,u8 len)2722*4882a593Smuzhiyun int do_cea_modes(struct hdmi_edid_data *data, const u8 *db, u8 len)
2723*4882a593Smuzhiyun {
2724*4882a593Smuzhiyun 	int i, modes = 0;
2725*4882a593Smuzhiyun 	struct drm_hdmi_info *hdmi = &data->display_info.hdmi;
2726*4882a593Smuzhiyun 
2727*4882a593Smuzhiyun 	for (i = 0; i < len; i++) {
2728*4882a593Smuzhiyun 		struct drm_display_mode *mode;
2729*4882a593Smuzhiyun 
2730*4882a593Smuzhiyun 		mode = drm_display_mode_from_vic_index(db, len, i);
2731*4882a593Smuzhiyun 		if (mode) {
2732*4882a593Smuzhiyun 			/*
2733*4882a593Smuzhiyun 			 * YCBCR420 capability block contains a bitmap which
2734*4882a593Smuzhiyun 			 * gives the index of CEA modes from CEA VDB, which
2735*4882a593Smuzhiyun 			 * can support YCBCR 420 sampling output also (apart
2736*4882a593Smuzhiyun 			 * from RGB/YCBCR444 etc).
2737*4882a593Smuzhiyun 			 * For example, if the bit 0 in bitmap is set,
2738*4882a593Smuzhiyun 			 * first mode in VDB can support YCBCR420 output too.
2739*4882a593Smuzhiyun 			 * Add YCBCR420 modes only if sink is HDMI 2.0 capable.
2740*4882a593Smuzhiyun 			 */
2741*4882a593Smuzhiyun 			if (i < 64 && hdmi->y420_cmdb_map & (1ULL << i))
2742*4882a593Smuzhiyun 				drm_add_cmdb_modes(db[i], hdmi);
2743*4882a593Smuzhiyun 			drm_add_hdmi_modes(data, mode);
2744*4882a593Smuzhiyun 			drm_mode_destroy(mode);
2745*4882a593Smuzhiyun 			modes++;
2746*4882a593Smuzhiyun 		}
2747*4882a593Smuzhiyun 	}
2748*4882a593Smuzhiyun 
2749*4882a593Smuzhiyun 	return modes;
2750*4882a593Smuzhiyun }
2751*4882a593Smuzhiyun 
2752*4882a593Smuzhiyun /*
2753*4882a593Smuzhiyun  * do_y420vdb_modes - Parse YCBCR 420 only modes
2754*4882a593Smuzhiyun  * @data: the structure that save parsed hdmi edid data
2755*4882a593Smuzhiyun  * @svds: start of the data block of CEA YCBCR 420 VDB
2756*4882a593Smuzhiyun  * @svds_len: length of the CEA YCBCR 420 VDB
2757*4882a593Smuzhiyun  * @hdmi: runtime information about the connected HDMI sink
2758*4882a593Smuzhiyun  *
2759*4882a593Smuzhiyun  * Parse the CEA-861-F YCBCR 420 Video Data Block (Y420VDB)
2760*4882a593Smuzhiyun  * which contains modes which can be supported in YCBCR 420
2761*4882a593Smuzhiyun  * output format only.
2762*4882a593Smuzhiyun  */
2763*4882a593Smuzhiyun static int
do_y420vdb_modes(struct hdmi_edid_data * data,const u8 * svds,u8 svds_len)2764*4882a593Smuzhiyun do_y420vdb_modes(struct hdmi_edid_data *data, const u8 *svds, u8 svds_len)
2765*4882a593Smuzhiyun {
2766*4882a593Smuzhiyun 	int modes = 0, i;
2767*4882a593Smuzhiyun 	struct drm_hdmi_info *hdmi = &data->display_info.hdmi;
2768*4882a593Smuzhiyun 
2769*4882a593Smuzhiyun 	for (i = 0; i < svds_len; i++) {
2770*4882a593Smuzhiyun 		u8 vic = svd_to_vic(svds[i]);
2771*4882a593Smuzhiyun 
2772*4882a593Smuzhiyun 		if (!drm_valid_cea_vic(vic))
2773*4882a593Smuzhiyun 			continue;
2774*4882a593Smuzhiyun 
2775*4882a593Smuzhiyun 		bitmap_set(hdmi->y420_vdb_modes, vic, 1);
2776*4882a593Smuzhiyun 		drm_add_hdmi_modes(data, cea_mode_for_vic(vic));
2777*4882a593Smuzhiyun 		modes++;
2778*4882a593Smuzhiyun 	}
2779*4882a593Smuzhiyun 
2780*4882a593Smuzhiyun 	return modes;
2781*4882a593Smuzhiyun }
2782*4882a593Smuzhiyun 
2783*4882a593Smuzhiyun struct stereo_mandatory_mode {
2784*4882a593Smuzhiyun 	int width, height, vrefresh;
2785*4882a593Smuzhiyun 	unsigned int flags;
2786*4882a593Smuzhiyun };
2787*4882a593Smuzhiyun 
2788*4882a593Smuzhiyun static const struct stereo_mandatory_mode stereo_mandatory_modes[] = {
2789*4882a593Smuzhiyun 	{ 1920, 1080, 24, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
2790*4882a593Smuzhiyun 	{ 1920, 1080, 24, DRM_MODE_FLAG_3D_FRAME_PACKING },
2791*4882a593Smuzhiyun 	{ 1920, 1080, 50,
2792*4882a593Smuzhiyun 	  DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF },
2793*4882a593Smuzhiyun 	{ 1920, 1080, 60,
2794*4882a593Smuzhiyun 	  DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF },
2795*4882a593Smuzhiyun 	{ 1280, 720,  50, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
2796*4882a593Smuzhiyun 	{ 1280, 720,  50, DRM_MODE_FLAG_3D_FRAME_PACKING },
2797*4882a593Smuzhiyun 	{ 1280, 720,  60, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
2798*4882a593Smuzhiyun 	{ 1280, 720,  60, DRM_MODE_FLAG_3D_FRAME_PACKING }
2799*4882a593Smuzhiyun };
2800*4882a593Smuzhiyun 
2801*4882a593Smuzhiyun static bool
stereo_match_mandatory(const struct drm_display_mode * mode,const struct stereo_mandatory_mode * stereo_mode)2802*4882a593Smuzhiyun stereo_match_mandatory(const struct drm_display_mode *mode,
2803*4882a593Smuzhiyun 		       const struct stereo_mandatory_mode *stereo_mode)
2804*4882a593Smuzhiyun {
2805*4882a593Smuzhiyun 	unsigned int interlaced = mode->flags & DRM_MODE_FLAG_INTERLACE;
2806*4882a593Smuzhiyun 
2807*4882a593Smuzhiyun 	return mode->hdisplay == stereo_mode->width &&
2808*4882a593Smuzhiyun 	       mode->vdisplay == stereo_mode->height &&
2809*4882a593Smuzhiyun 	       interlaced == (stereo_mode->flags & DRM_MODE_FLAG_INTERLACE) &&
2810*4882a593Smuzhiyun 	       drm_get_vrefresh(mode) == stereo_mode->vrefresh;
2811*4882a593Smuzhiyun }
2812*4882a593Smuzhiyun 
add_hdmi_mandatory_stereo_modes(struct hdmi_edid_data * data)2813*4882a593Smuzhiyun static int add_hdmi_mandatory_stereo_modes(struct hdmi_edid_data *data)
2814*4882a593Smuzhiyun {
2815*4882a593Smuzhiyun 	const struct drm_display_mode *mode;
2816*4882a593Smuzhiyun 	int num = data->modes, modes = 0, i, k;
2817*4882a593Smuzhiyun 
2818*4882a593Smuzhiyun 	for (k = 0; k < num; k++) {
2819*4882a593Smuzhiyun 		mode = &data->mode_buf[k];
2820*4882a593Smuzhiyun 		for (i = 0; i < ARRAY_SIZE(stereo_mandatory_modes); i++) {
2821*4882a593Smuzhiyun 			const struct stereo_mandatory_mode *mandatory;
2822*4882a593Smuzhiyun 			struct drm_display_mode *new_mode;
2823*4882a593Smuzhiyun 
2824*4882a593Smuzhiyun 			if (!stereo_match_mandatory(mode,
2825*4882a593Smuzhiyun 						    &stereo_mandatory_modes[i]))
2826*4882a593Smuzhiyun 				continue;
2827*4882a593Smuzhiyun 
2828*4882a593Smuzhiyun 			mandatory = &stereo_mandatory_modes[i];
2829*4882a593Smuzhiyun 			new_mode = drm_mode_create();
2830*4882a593Smuzhiyun 			if (!new_mode)
2831*4882a593Smuzhiyun 				continue;
2832*4882a593Smuzhiyun 
2833*4882a593Smuzhiyun 			*new_mode = *mode;
2834*4882a593Smuzhiyun 			new_mode->flags |= mandatory->flags;
2835*4882a593Smuzhiyun 			drm_add_hdmi_modes(data, new_mode);
2836*4882a593Smuzhiyun 			drm_mode_destroy(new_mode);
2837*4882a593Smuzhiyun 			modes++;
2838*4882a593Smuzhiyun 		}
2839*4882a593Smuzhiyun 	}
2840*4882a593Smuzhiyun 
2841*4882a593Smuzhiyun 	return modes;
2842*4882a593Smuzhiyun }
2843*4882a593Smuzhiyun 
add_3d_struct_modes(struct hdmi_edid_data * data,u16 structure,const u8 * video_db,u8 video_len,u8 video_index)2844*4882a593Smuzhiyun static int add_3d_struct_modes(struct hdmi_edid_data *data, u16 structure,
2845*4882a593Smuzhiyun 			       const u8 *video_db, u8 video_len, u8 video_index)
2846*4882a593Smuzhiyun {
2847*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
2848*4882a593Smuzhiyun 	int modes = 0;
2849*4882a593Smuzhiyun 
2850*4882a593Smuzhiyun 	if (structure & (1 << 0)) {
2851*4882a593Smuzhiyun 		newmode = drm_display_mode_from_vic_index(video_db,
2852*4882a593Smuzhiyun 							  video_len,
2853*4882a593Smuzhiyun 							  video_index);
2854*4882a593Smuzhiyun 		if (newmode) {
2855*4882a593Smuzhiyun 			newmode->flags |= DRM_MODE_FLAG_3D_FRAME_PACKING;
2856*4882a593Smuzhiyun 			drm_add_hdmi_modes(data, newmode);
2857*4882a593Smuzhiyun 			modes++;
2858*4882a593Smuzhiyun 			drm_mode_destroy(newmode);
2859*4882a593Smuzhiyun 		}
2860*4882a593Smuzhiyun 	}
2861*4882a593Smuzhiyun 	if (structure & (1 << 6)) {
2862*4882a593Smuzhiyun 		newmode = drm_display_mode_from_vic_index(video_db,
2863*4882a593Smuzhiyun 							  video_len,
2864*4882a593Smuzhiyun 							  video_index);
2865*4882a593Smuzhiyun 		if (newmode) {
2866*4882a593Smuzhiyun 			newmode->flags |= DRM_MODE_FLAG_3D_TOP_AND_BOTTOM;
2867*4882a593Smuzhiyun 			drm_add_hdmi_modes(data, newmode);
2868*4882a593Smuzhiyun 			modes++;
2869*4882a593Smuzhiyun 			drm_mode_destroy(newmode);
2870*4882a593Smuzhiyun 		}
2871*4882a593Smuzhiyun 	}
2872*4882a593Smuzhiyun 	if (structure & (1 << 8)) {
2873*4882a593Smuzhiyun 		newmode = drm_display_mode_from_vic_index(video_db,
2874*4882a593Smuzhiyun 							  video_len,
2875*4882a593Smuzhiyun 							  video_index);
2876*4882a593Smuzhiyun 		if (newmode) {
2877*4882a593Smuzhiyun 			newmode->flags |= DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF;
2878*4882a593Smuzhiyun 			drm_add_hdmi_modes(data, newmode);
2879*4882a593Smuzhiyun 			modes++;
2880*4882a593Smuzhiyun 			drm_mode_destroy(newmode);
2881*4882a593Smuzhiyun 		}
2882*4882a593Smuzhiyun 	}
2883*4882a593Smuzhiyun 
2884*4882a593Smuzhiyun 	return modes;
2885*4882a593Smuzhiyun }
2886*4882a593Smuzhiyun 
add_hdmi_mode(struct hdmi_edid_data * data,u8 vic)2887*4882a593Smuzhiyun static int add_hdmi_mode(struct hdmi_edid_data *data, u8 vic)
2888*4882a593Smuzhiyun {
2889*4882a593Smuzhiyun 	if (!drm_valid_hdmi_vic(vic)) {
2890*4882a593Smuzhiyun 		debug("Unknown HDMI VIC: %d\n", vic);
2891*4882a593Smuzhiyun 		return 0;
2892*4882a593Smuzhiyun 	}
2893*4882a593Smuzhiyun 
2894*4882a593Smuzhiyun 	drm_add_hdmi_modes(data, &edid_4k_modes[vic]);
2895*4882a593Smuzhiyun 
2896*4882a593Smuzhiyun 	return 1;
2897*4882a593Smuzhiyun }
2898*4882a593Smuzhiyun 
2899*4882a593Smuzhiyun /*
2900*4882a593Smuzhiyun  * do_hdmi_vsdb_modes - Parse the HDMI Vendor Specific data block
2901*4882a593Smuzhiyun  * @db: start of the CEA vendor specific block
2902*4882a593Smuzhiyun  * @len: length of the CEA block payload, ie. one can access up to db[len]
2903*4882a593Smuzhiyun  *
2904*4882a593Smuzhiyun  * Parses the HDMI VSDB looking for modes to add to @data. This function
2905*4882a593Smuzhiyun  * also adds the stereo 3d modes when applicable.
2906*4882a593Smuzhiyun  */
2907*4882a593Smuzhiyun static int
do_hdmi_vsdb_modes(const u8 * db,u8 len,const u8 * video_db,u8 video_len,struct hdmi_edid_data * data)2908*4882a593Smuzhiyun do_hdmi_vsdb_modes(const u8 *db, u8 len, const u8 *video_db, u8 video_len,
2909*4882a593Smuzhiyun 		   struct hdmi_edid_data *data)
2910*4882a593Smuzhiyun {
2911*4882a593Smuzhiyun 	int modes = 0, offset = 0, i, multi_present = 0, multi_len;
2912*4882a593Smuzhiyun 	u8 vic_len, hdmi_3d_len = 0;
2913*4882a593Smuzhiyun 	u16 mask;
2914*4882a593Smuzhiyun 	u16 structure_all;
2915*4882a593Smuzhiyun 
2916*4882a593Smuzhiyun 	if (len < 8)
2917*4882a593Smuzhiyun 		goto out;
2918*4882a593Smuzhiyun 
2919*4882a593Smuzhiyun 	/* no HDMI_Video_Present */
2920*4882a593Smuzhiyun 	if (!(db[8] & (1 << 5)))
2921*4882a593Smuzhiyun 		goto out;
2922*4882a593Smuzhiyun 
2923*4882a593Smuzhiyun 	/* Latency_Fields_Present */
2924*4882a593Smuzhiyun 	if (db[8] & (1 << 7))
2925*4882a593Smuzhiyun 		offset += 2;
2926*4882a593Smuzhiyun 
2927*4882a593Smuzhiyun 	/* I_Latency_Fields_Present */
2928*4882a593Smuzhiyun 	if (db[8] & (1 << 6))
2929*4882a593Smuzhiyun 		offset += 2;
2930*4882a593Smuzhiyun 
2931*4882a593Smuzhiyun 	/* the declared length is not long enough for the 2 first bytes
2932*4882a593Smuzhiyun 	 * of additional video format capabilities
2933*4882a593Smuzhiyun 	 */
2934*4882a593Smuzhiyun 	if (len < (8 + offset + 2))
2935*4882a593Smuzhiyun 		goto out;
2936*4882a593Smuzhiyun 
2937*4882a593Smuzhiyun 	/* 3D_Present */
2938*4882a593Smuzhiyun 	offset++;
2939*4882a593Smuzhiyun 	if (db[8 + offset] & (1 << 7)) {
2940*4882a593Smuzhiyun 		modes += add_hdmi_mandatory_stereo_modes(data);
2941*4882a593Smuzhiyun 
2942*4882a593Smuzhiyun 		/* 3D_Multi_present */
2943*4882a593Smuzhiyun 		multi_present = (db[8 + offset] & 0x60) >> 5;
2944*4882a593Smuzhiyun 	}
2945*4882a593Smuzhiyun 
2946*4882a593Smuzhiyun 	offset++;
2947*4882a593Smuzhiyun 	vic_len = db[8 + offset] >> 5;
2948*4882a593Smuzhiyun 	hdmi_3d_len = db[8 + offset] & 0x1f;
2949*4882a593Smuzhiyun 
2950*4882a593Smuzhiyun 	for (i = 0; i < vic_len && len >= (9 + offset + i); i++) {
2951*4882a593Smuzhiyun 		u8 vic;
2952*4882a593Smuzhiyun 
2953*4882a593Smuzhiyun 		vic = db[9 + offset + i];
2954*4882a593Smuzhiyun 		modes += add_hdmi_mode(data, vic);
2955*4882a593Smuzhiyun 	}
2956*4882a593Smuzhiyun 
2957*4882a593Smuzhiyun 	offset += 1 + vic_len;
2958*4882a593Smuzhiyun 
2959*4882a593Smuzhiyun 	if (multi_present == 1)
2960*4882a593Smuzhiyun 		multi_len = 2;
2961*4882a593Smuzhiyun 	else if (multi_present == 2)
2962*4882a593Smuzhiyun 		multi_len = 4;
2963*4882a593Smuzhiyun 	else
2964*4882a593Smuzhiyun 		multi_len = 0;
2965*4882a593Smuzhiyun 
2966*4882a593Smuzhiyun 	if (len < (8 + offset + hdmi_3d_len - 1))
2967*4882a593Smuzhiyun 		goto out;
2968*4882a593Smuzhiyun 
2969*4882a593Smuzhiyun 	if (hdmi_3d_len < multi_len)
2970*4882a593Smuzhiyun 		goto out;
2971*4882a593Smuzhiyun 
2972*4882a593Smuzhiyun 	if (multi_present == 1 || multi_present == 2) {
2973*4882a593Smuzhiyun 		/* 3D_Structure_ALL */
2974*4882a593Smuzhiyun 		structure_all = (db[8 + offset] << 8) | db[9 + offset];
2975*4882a593Smuzhiyun 
2976*4882a593Smuzhiyun 		/* check if 3D_MASK is present */
2977*4882a593Smuzhiyun 		if (multi_present == 2)
2978*4882a593Smuzhiyun 			mask = (db[10 + offset] << 8) | db[11 + offset];
2979*4882a593Smuzhiyun 		else
2980*4882a593Smuzhiyun 			mask = 0xffff;
2981*4882a593Smuzhiyun 
2982*4882a593Smuzhiyun 		for (i = 0; i < 16; i++) {
2983*4882a593Smuzhiyun 			if (mask & (1 << i))
2984*4882a593Smuzhiyun 				modes += add_3d_struct_modes(data,
2985*4882a593Smuzhiyun 						structure_all,
2986*4882a593Smuzhiyun 						video_db,
2987*4882a593Smuzhiyun 						video_len, i);
2988*4882a593Smuzhiyun 		}
2989*4882a593Smuzhiyun 	}
2990*4882a593Smuzhiyun 
2991*4882a593Smuzhiyun 	offset += multi_len;
2992*4882a593Smuzhiyun 
2993*4882a593Smuzhiyun 	for (i = 0; i < (hdmi_3d_len - multi_len); i++) {
2994*4882a593Smuzhiyun 		int vic_index;
2995*4882a593Smuzhiyun 		struct drm_display_mode *newmode = NULL;
2996*4882a593Smuzhiyun 		unsigned int newflag = 0;
2997*4882a593Smuzhiyun 		bool detail_present;
2998*4882a593Smuzhiyun 
2999*4882a593Smuzhiyun 		detail_present = ((db[8 + offset + i] & 0x0f) > 7);
3000*4882a593Smuzhiyun 
3001*4882a593Smuzhiyun 		if (detail_present && (i + 1 == hdmi_3d_len - multi_len))
3002*4882a593Smuzhiyun 			break;
3003*4882a593Smuzhiyun 
3004*4882a593Smuzhiyun 		/* 2D_VIC_order_X */
3005*4882a593Smuzhiyun 		vic_index = db[8 + offset + i] >> 4;
3006*4882a593Smuzhiyun 
3007*4882a593Smuzhiyun 		/* 3D_Structure_X */
3008*4882a593Smuzhiyun 		switch (db[8 + offset + i] & 0x0f) {
3009*4882a593Smuzhiyun 		case 0:
3010*4882a593Smuzhiyun 			newflag = DRM_MODE_FLAG_3D_FRAME_PACKING;
3011*4882a593Smuzhiyun 			break;
3012*4882a593Smuzhiyun 		case 6:
3013*4882a593Smuzhiyun 			newflag = DRM_MODE_FLAG_3D_TOP_AND_BOTTOM;
3014*4882a593Smuzhiyun 			break;
3015*4882a593Smuzhiyun 		case 8:
3016*4882a593Smuzhiyun 			/* 3D_Detail_X */
3017*4882a593Smuzhiyun 			if ((db[9 + offset + i] >> 4) == 1)
3018*4882a593Smuzhiyun 				newflag = DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF;
3019*4882a593Smuzhiyun 			break;
3020*4882a593Smuzhiyun 		}
3021*4882a593Smuzhiyun 
3022*4882a593Smuzhiyun 		if (newflag != 0) {
3023*4882a593Smuzhiyun 			newmode = drm_display_mode_from_vic_index(
3024*4882a593Smuzhiyun 								  video_db,
3025*4882a593Smuzhiyun 								  video_len,
3026*4882a593Smuzhiyun 								  vic_index);
3027*4882a593Smuzhiyun 
3028*4882a593Smuzhiyun 			if (newmode) {
3029*4882a593Smuzhiyun 				newmode->flags |= newflag;
3030*4882a593Smuzhiyun 				drm_add_hdmi_modes(data, newmode);
3031*4882a593Smuzhiyun 				modes++;
3032*4882a593Smuzhiyun 				drm_mode_destroy(newmode);
3033*4882a593Smuzhiyun 			}
3034*4882a593Smuzhiyun 		}
3035*4882a593Smuzhiyun 
3036*4882a593Smuzhiyun 		if (detail_present)
3037*4882a593Smuzhiyun 			i++;
3038*4882a593Smuzhiyun 	}
3039*4882a593Smuzhiyun 
3040*4882a593Smuzhiyun out:
3041*4882a593Smuzhiyun 	return modes;
3042*4882a593Smuzhiyun }
3043*4882a593Smuzhiyun 
3044*4882a593Smuzhiyun /**
3045*4882a593Smuzhiyun  * edid_get_quirks - return quirk flags for a given EDID
3046*4882a593Smuzhiyun  * @edid: EDID to process
3047*4882a593Smuzhiyun  *
3048*4882a593Smuzhiyun  * This tells subsequent routines what fixes they need to apply.
3049*4882a593Smuzhiyun  */
edid_get_quirks(struct edid * edid)3050*4882a593Smuzhiyun static u32 edid_get_quirks(struct edid *edid)
3051*4882a593Smuzhiyun {
3052*4882a593Smuzhiyun 	struct edid_quirk *quirk;
3053*4882a593Smuzhiyun 	int i;
3054*4882a593Smuzhiyun 
3055*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(edid_quirk_list); i++) {
3056*4882a593Smuzhiyun 		quirk = &edid_quirk_list[i];
3057*4882a593Smuzhiyun 
3058*4882a593Smuzhiyun 		if (edid_vendor(edid, quirk->vendor) &&
3059*4882a593Smuzhiyun 		    (EDID_PRODUCT_ID(edid) == quirk->product_id))
3060*4882a593Smuzhiyun 			return quirk->quirks;
3061*4882a593Smuzhiyun 	}
3062*4882a593Smuzhiyun 
3063*4882a593Smuzhiyun 	return 0;
3064*4882a593Smuzhiyun }
3065*4882a593Smuzhiyun 
drm_parse_y420cmdb_bitmap(struct hdmi_edid_data * data,const u8 * db)3066*4882a593Smuzhiyun static void drm_parse_y420cmdb_bitmap(struct hdmi_edid_data *data,
3067*4882a593Smuzhiyun 				      const u8 *db)
3068*4882a593Smuzhiyun {
3069*4882a593Smuzhiyun 	struct drm_display_info *info = &data->display_info;
3070*4882a593Smuzhiyun 	struct drm_hdmi_info *hdmi = &info->hdmi;
3071*4882a593Smuzhiyun 	u8 map_len = cea_db_payload_len(db) - 1;
3072*4882a593Smuzhiyun 	u8 count;
3073*4882a593Smuzhiyun 	u64 map = 0;
3074*4882a593Smuzhiyun 
3075*4882a593Smuzhiyun 	if (map_len == 0) {
3076*4882a593Smuzhiyun 		/* All CEA modes support ycbcr420 sampling also.*/
3077*4882a593Smuzhiyun 		hdmi->y420_cmdb_map = U64_MAX;
3078*4882a593Smuzhiyun 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB420;
3079*4882a593Smuzhiyun 		return;
3080*4882a593Smuzhiyun 	}
3081*4882a593Smuzhiyun 
3082*4882a593Smuzhiyun 	/*
3083*4882a593Smuzhiyun 	 * This map indicates which of the existing CEA block modes
3084*4882a593Smuzhiyun 	 * from VDB can support YCBCR420 output too. So if bit=0 is
3085*4882a593Smuzhiyun 	 * set, first mode from VDB can support YCBCR420 output too.
3086*4882a593Smuzhiyun 	 * We will parse and keep this map, before parsing VDB itself
3087*4882a593Smuzhiyun 	 * to avoid going through the same block again and again.
3088*4882a593Smuzhiyun 	 *
3089*4882a593Smuzhiyun 	 * Spec is not clear about max possible size of this block.
3090*4882a593Smuzhiyun 	 * Clamping max bitmap block size at 8 bytes. Every byte can
3091*4882a593Smuzhiyun 	 * address 8 CEA modes, in this way this map can address
3092*4882a593Smuzhiyun 	 * 8*8 = first 64 SVDs.
3093*4882a593Smuzhiyun 	 */
3094*4882a593Smuzhiyun 	if (map_len > 8)
3095*4882a593Smuzhiyun 		map_len = 8;
3096*4882a593Smuzhiyun 
3097*4882a593Smuzhiyun 	for (count = 0; count < map_len; count++)
3098*4882a593Smuzhiyun 		map |= (u64)db[2 + count] << (8 * count);
3099*4882a593Smuzhiyun 
3100*4882a593Smuzhiyun 	if (map)
3101*4882a593Smuzhiyun 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB420;
3102*4882a593Smuzhiyun 
3103*4882a593Smuzhiyun 	hdmi->y420_cmdb_map = map;
3104*4882a593Smuzhiyun }
3105*4882a593Smuzhiyun 
3106*4882a593Smuzhiyun static
drm_get_max_frl_rate(int max_frl_rate,u8 * max_lanes,u8 * max_rate_per_lane)3107*4882a593Smuzhiyun void drm_get_max_frl_rate(int max_frl_rate, u8 *max_lanes, u8 *max_rate_per_lane)
3108*4882a593Smuzhiyun {
3109*4882a593Smuzhiyun 	switch (max_frl_rate) {
3110*4882a593Smuzhiyun 	case 1:
3111*4882a593Smuzhiyun 		*max_lanes = 3;
3112*4882a593Smuzhiyun 		*max_rate_per_lane = 3;
3113*4882a593Smuzhiyun 		break;
3114*4882a593Smuzhiyun 	case 2:
3115*4882a593Smuzhiyun 		*max_lanes = 3;
3116*4882a593Smuzhiyun 		*max_rate_per_lane = 6;
3117*4882a593Smuzhiyun 		break;
3118*4882a593Smuzhiyun 	case 3:
3119*4882a593Smuzhiyun 		*max_lanes = 4;
3120*4882a593Smuzhiyun 		*max_rate_per_lane = 6;
3121*4882a593Smuzhiyun 		break;
3122*4882a593Smuzhiyun 	case 4:
3123*4882a593Smuzhiyun 		*max_lanes = 4;
3124*4882a593Smuzhiyun 		*max_rate_per_lane = 8;
3125*4882a593Smuzhiyun 		break;
3126*4882a593Smuzhiyun 	case 5:
3127*4882a593Smuzhiyun 		*max_lanes = 4;
3128*4882a593Smuzhiyun 		*max_rate_per_lane = 10;
3129*4882a593Smuzhiyun 		break;
3130*4882a593Smuzhiyun 	case 6:
3131*4882a593Smuzhiyun 		*max_lanes = 4;
3132*4882a593Smuzhiyun 		*max_rate_per_lane = 12;
3133*4882a593Smuzhiyun 		break;
3134*4882a593Smuzhiyun 	case 0:
3135*4882a593Smuzhiyun 	default:
3136*4882a593Smuzhiyun 		*max_lanes = 0;
3137*4882a593Smuzhiyun 		*max_rate_per_lane = 0;
3138*4882a593Smuzhiyun 	}
3139*4882a593Smuzhiyun }
3140*4882a593Smuzhiyun 
drm_parse_ycbcr420_deep_color_info(struct hdmi_edid_data * data,const u8 * db)3141*4882a593Smuzhiyun static void drm_parse_ycbcr420_deep_color_info(struct hdmi_edid_data *data,
3142*4882a593Smuzhiyun 					       const u8 *db)
3143*4882a593Smuzhiyun {
3144*4882a593Smuzhiyun 	u8 dc_mask;
3145*4882a593Smuzhiyun 	struct drm_hdmi_info *hdmi = &data->display_info.hdmi;
3146*4882a593Smuzhiyun 
3147*4882a593Smuzhiyun 	dc_mask = db[7] & DRM_EDID_YCBCR420_DC_MASK;
3148*4882a593Smuzhiyun 	hdmi->y420_dc_modes |= dc_mask;
3149*4882a593Smuzhiyun }
3150*4882a593Smuzhiyun 
drm_parse_hdmi_forum_vsdb(struct hdmi_edid_data * data,const u8 * hf_vsdb)3151*4882a593Smuzhiyun static void drm_parse_hdmi_forum_vsdb(struct hdmi_edid_data *data,
3152*4882a593Smuzhiyun 				      const u8 *hf_vsdb)
3153*4882a593Smuzhiyun {
3154*4882a593Smuzhiyun 	struct drm_display_info *display = &data->display_info;
3155*4882a593Smuzhiyun 	struct drm_hdmi_info *hdmi = &display->hdmi;
3156*4882a593Smuzhiyun 
3157*4882a593Smuzhiyun 	if (hf_vsdb[6] & 0x80) {
3158*4882a593Smuzhiyun 		hdmi->scdc.supported = true;
3159*4882a593Smuzhiyun 		if (hf_vsdb[6] & 0x40)
3160*4882a593Smuzhiyun 			hdmi->scdc.read_request = true;
3161*4882a593Smuzhiyun 	}
3162*4882a593Smuzhiyun 
3163*4882a593Smuzhiyun 	/*
3164*4882a593Smuzhiyun 	 * All HDMI 2.0 monitors must support scrambling at rates > 340 MHz.
3165*4882a593Smuzhiyun 	 * And as per the spec, three factors confirm this:
3166*4882a593Smuzhiyun 	 * * Availability of a HF-VSDB block in EDID (check)
3167*4882a593Smuzhiyun 	 * * Non zero Max_TMDS_Char_Rate filed in HF-VSDB (let's check)
3168*4882a593Smuzhiyun 	 * * SCDC support available (let's check)
3169*4882a593Smuzhiyun 	 * Lets check it out.
3170*4882a593Smuzhiyun 	 */
3171*4882a593Smuzhiyun 
3172*4882a593Smuzhiyun 	if (hf_vsdb[5]) {
3173*4882a593Smuzhiyun 		/* max clock is 5000 KHz times block value */
3174*4882a593Smuzhiyun 		u32 max_tmds_clock = hf_vsdb[5] * 5000;
3175*4882a593Smuzhiyun 		struct drm_scdc *scdc = &hdmi->scdc;
3176*4882a593Smuzhiyun 
3177*4882a593Smuzhiyun 		if (max_tmds_clock > 340000) {
3178*4882a593Smuzhiyun 			display->max_tmds_clock = max_tmds_clock;
3179*4882a593Smuzhiyun 			debug("HF-VSDB: max TMDS clock %d kHz\n",
3180*4882a593Smuzhiyun 			      display->max_tmds_clock);
3181*4882a593Smuzhiyun 		}
3182*4882a593Smuzhiyun 
3183*4882a593Smuzhiyun 		if (scdc->supported) {
3184*4882a593Smuzhiyun 			scdc->scrambling.supported = true;
3185*4882a593Smuzhiyun 
3186*4882a593Smuzhiyun 			/* Few sinks support scrambling for cloks < 340M */
3187*4882a593Smuzhiyun 			if ((hf_vsdb[6] & 0x8))
3188*4882a593Smuzhiyun 				scdc->scrambling.low_rates = true;
3189*4882a593Smuzhiyun 		}
3190*4882a593Smuzhiyun 	}
3191*4882a593Smuzhiyun 
3192*4882a593Smuzhiyun 	if (hf_vsdb[7]) {
3193*4882a593Smuzhiyun 		u8 max_frl_rate;
3194*4882a593Smuzhiyun 		u8 dsc_max_frl_rate;
3195*4882a593Smuzhiyun 		u8 dsc_max_slices;
3196*4882a593Smuzhiyun 		struct drm_hdmi_dsc_cap *hdmi_dsc = &hdmi->dsc_cap;
3197*4882a593Smuzhiyun 
3198*4882a593Smuzhiyun 		debug("hdmi_21 sink detected. parsing edid\n");
3199*4882a593Smuzhiyun 		max_frl_rate = (hf_vsdb[7] & DRM_EDID_MAX_FRL_RATE_MASK) >> 4;
3200*4882a593Smuzhiyun 		drm_get_max_frl_rate(max_frl_rate, &hdmi->max_lanes,
3201*4882a593Smuzhiyun 				     &hdmi->max_frl_rate_per_lane);
3202*4882a593Smuzhiyun 		hdmi->add_func = hf_vsdb[8];
3203*4882a593Smuzhiyun 		hdmi_dsc->v_1p2 = hf_vsdb[11] & DRM_EDID_DSC_1P2;
3204*4882a593Smuzhiyun 
3205*4882a593Smuzhiyun 		if (hdmi_dsc->v_1p2) {
3206*4882a593Smuzhiyun 			hdmi_dsc->native_420 = hf_vsdb[11] & DRM_EDID_DSC_NATIVE_420;
3207*4882a593Smuzhiyun 			hdmi_dsc->all_bpp = hf_vsdb[11] & DRM_EDID_DSC_ALL_BPP;
3208*4882a593Smuzhiyun 
3209*4882a593Smuzhiyun 			if (hf_vsdb[11] & DRM_EDID_DSC_16BPC)
3210*4882a593Smuzhiyun 				hdmi_dsc->bpc_supported = 16;
3211*4882a593Smuzhiyun 			else if (hf_vsdb[11] & DRM_EDID_DSC_12BPC)
3212*4882a593Smuzhiyun 				hdmi_dsc->bpc_supported = 12;
3213*4882a593Smuzhiyun 			else if (hf_vsdb[11] & DRM_EDID_DSC_10BPC)
3214*4882a593Smuzhiyun 				hdmi_dsc->bpc_supported = 10;
3215*4882a593Smuzhiyun 			else
3216*4882a593Smuzhiyun 				hdmi_dsc->bpc_supported = 0;
3217*4882a593Smuzhiyun 
3218*4882a593Smuzhiyun 			dsc_max_frl_rate = (hf_vsdb[12] & DRM_EDID_DSC_MAX_FRL_RATE_MASK) >> 4;
3219*4882a593Smuzhiyun 			drm_get_max_frl_rate(dsc_max_frl_rate, &hdmi_dsc->max_lanes,
3220*4882a593Smuzhiyun 					     &hdmi_dsc->max_frl_rate_per_lane);
3221*4882a593Smuzhiyun 			hdmi_dsc->total_chunk_kbytes =
3222*4882a593Smuzhiyun 				hf_vsdb[13] & DRM_EDID_DSC_TOTAL_CHUNK_KBYTES;
3223*4882a593Smuzhiyun 
3224*4882a593Smuzhiyun 			dsc_max_slices = hf_vsdb[12] & DRM_EDID_DSC_MAX_SLICES;
3225*4882a593Smuzhiyun 			switch (dsc_max_slices) {
3226*4882a593Smuzhiyun 			case 1:
3227*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 1;
3228*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 340;
3229*4882a593Smuzhiyun 				break;
3230*4882a593Smuzhiyun 			case 2:
3231*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 2;
3232*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 340;
3233*4882a593Smuzhiyun 				break;
3234*4882a593Smuzhiyun 			case 3:
3235*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 4;
3236*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 340;
3237*4882a593Smuzhiyun 				break;
3238*4882a593Smuzhiyun 			case 4:
3239*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 8;
3240*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 340;
3241*4882a593Smuzhiyun 				break;
3242*4882a593Smuzhiyun 			case 5:
3243*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 8;
3244*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 400;
3245*4882a593Smuzhiyun 				break;
3246*4882a593Smuzhiyun 			case 6:
3247*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 12;
3248*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 400;
3249*4882a593Smuzhiyun 				break;
3250*4882a593Smuzhiyun 			case 7:
3251*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 16;
3252*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 400;
3253*4882a593Smuzhiyun 				break;
3254*4882a593Smuzhiyun 			case 0:
3255*4882a593Smuzhiyun 			default:
3256*4882a593Smuzhiyun 				hdmi_dsc->max_slices = 0;
3257*4882a593Smuzhiyun 				hdmi_dsc->clk_per_slice = 0;
3258*4882a593Smuzhiyun 			}
3259*4882a593Smuzhiyun 		}
3260*4882a593Smuzhiyun 	}
3261*4882a593Smuzhiyun 
3262*4882a593Smuzhiyun 	drm_parse_ycbcr420_deep_color_info(data, hf_vsdb);
3263*4882a593Smuzhiyun }
3264*4882a593Smuzhiyun 
3265*4882a593Smuzhiyun /**
3266*4882a593Smuzhiyun  * drm_default_rgb_quant_range - default RGB quantization range
3267*4882a593Smuzhiyun  * @mode: display mode
3268*4882a593Smuzhiyun  *
3269*4882a593Smuzhiyun  * Determine the default RGB quantization range for the mode,
3270*4882a593Smuzhiyun  * as specified in CEA-861.
3271*4882a593Smuzhiyun  *
3272*4882a593Smuzhiyun  * Return: The default RGB quantization range for the mode
3273*4882a593Smuzhiyun  */
3274*4882a593Smuzhiyun enum hdmi_quantization_range
drm_default_rgb_quant_range(struct drm_display_mode * mode)3275*4882a593Smuzhiyun drm_default_rgb_quant_range(struct drm_display_mode *mode)
3276*4882a593Smuzhiyun {
3277*4882a593Smuzhiyun 	/* All CEA modes other than VIC 1 use limited quantization range. */
3278*4882a593Smuzhiyun 	return drm_match_cea_mode(mode) > 1 ?
3279*4882a593Smuzhiyun 		HDMI_QUANTIZATION_RANGE_LIMITED :
3280*4882a593Smuzhiyun 		HDMI_QUANTIZATION_RANGE_FULL;
3281*4882a593Smuzhiyun }
3282*4882a593Smuzhiyun 
drm_parse_hdmi_deep_color_info(struct hdmi_edid_data * data,const u8 * hdmi)3283*4882a593Smuzhiyun static void drm_parse_hdmi_deep_color_info(struct hdmi_edid_data *data,
3284*4882a593Smuzhiyun 					   const u8 *hdmi)
3285*4882a593Smuzhiyun {
3286*4882a593Smuzhiyun 	struct drm_display_info *info = &data->display_info;
3287*4882a593Smuzhiyun 	unsigned int dc_bpc = 0;
3288*4882a593Smuzhiyun 
3289*4882a593Smuzhiyun 	/* HDMI supports at least 8 bpc */
3290*4882a593Smuzhiyun 	info->bpc = 8;
3291*4882a593Smuzhiyun 
3292*4882a593Smuzhiyun 	if (cea_db_payload_len(hdmi) < 6)
3293*4882a593Smuzhiyun 		return;
3294*4882a593Smuzhiyun 
3295*4882a593Smuzhiyun 	if (hdmi[6] & DRM_EDID_HDMI_DC_30) {
3296*4882a593Smuzhiyun 		dc_bpc = 10;
3297*4882a593Smuzhiyun 		info->edid_hdmi_dc_modes |= DRM_EDID_HDMI_DC_30;
3298*4882a593Smuzhiyun 		debug("HDMI sink does deep color 30.\n");
3299*4882a593Smuzhiyun 	}
3300*4882a593Smuzhiyun 
3301*4882a593Smuzhiyun 	if (hdmi[6] & DRM_EDID_HDMI_DC_36) {
3302*4882a593Smuzhiyun 		dc_bpc = 12;
3303*4882a593Smuzhiyun 		info->edid_hdmi_dc_modes |= DRM_EDID_HDMI_DC_36;
3304*4882a593Smuzhiyun 		debug("HDMI sink does deep color 36.\n");
3305*4882a593Smuzhiyun 	}
3306*4882a593Smuzhiyun 
3307*4882a593Smuzhiyun 	if (hdmi[6] & DRM_EDID_HDMI_DC_48) {
3308*4882a593Smuzhiyun 		dc_bpc = 16;
3309*4882a593Smuzhiyun 		info->edid_hdmi_dc_modes |= DRM_EDID_HDMI_DC_48;
3310*4882a593Smuzhiyun 		debug("HDMI sink does deep color 48.\n");
3311*4882a593Smuzhiyun 	}
3312*4882a593Smuzhiyun 
3313*4882a593Smuzhiyun 	if (dc_bpc == 0) {
3314*4882a593Smuzhiyun 		debug("No deep color support on this HDMI sink.\n");
3315*4882a593Smuzhiyun 		return;
3316*4882a593Smuzhiyun 	}
3317*4882a593Smuzhiyun 
3318*4882a593Smuzhiyun 	debug("Assigning HDMI sink color depth as %d bpc.\n", dc_bpc);
3319*4882a593Smuzhiyun 	info->bpc = dc_bpc;
3320*4882a593Smuzhiyun 
3321*4882a593Smuzhiyun 	/* YCRCB444 is optional according to spec. */
3322*4882a593Smuzhiyun 	if (hdmi[6] & DRM_EDID_HDMI_DC_Y444) {
3323*4882a593Smuzhiyun 		info->edid_hdmi_dc_modes |= DRM_EDID_HDMI_DC_Y444;
3324*4882a593Smuzhiyun 		debug("HDMI sink does YCRCB444 in deep color.\n");
3325*4882a593Smuzhiyun 	}
3326*4882a593Smuzhiyun 
3327*4882a593Smuzhiyun 	/*
3328*4882a593Smuzhiyun 	 * Spec says that if any deep color mode is supported at all,
3329*4882a593Smuzhiyun 	 * then deep color 36 bit must be supported.
3330*4882a593Smuzhiyun 	 */
3331*4882a593Smuzhiyun 	if (!(hdmi[6] & DRM_EDID_HDMI_DC_36))
3332*4882a593Smuzhiyun 		debug("HDMI sink should do DC_36, but does not!\n");
3333*4882a593Smuzhiyun }
3334*4882a593Smuzhiyun 
3335*4882a593Smuzhiyun /*
3336*4882a593Smuzhiyun  * Search EDID for CEA extension block.
3337*4882a593Smuzhiyun  */
drm_find_edid_extension(struct edid * edid,int ext_id)3338*4882a593Smuzhiyun static u8 *drm_find_edid_extension(struct edid *edid, int ext_id)
3339*4882a593Smuzhiyun {
3340*4882a593Smuzhiyun 	u8 *edid_ext = NULL;
3341*4882a593Smuzhiyun 	int i;
3342*4882a593Smuzhiyun 
3343*4882a593Smuzhiyun 	/* No EDID or EDID extensions */
3344*4882a593Smuzhiyun 	if (!edid || !edid->extensions)
3345*4882a593Smuzhiyun 		return NULL;
3346*4882a593Smuzhiyun 
3347*4882a593Smuzhiyun 	/* Find CEA extension */
3348*4882a593Smuzhiyun 	for (i = 0; i < edid->extensions; i++) {
3349*4882a593Smuzhiyun 		edid_ext = (u8 *)edid + EDID_SIZE * (i + 1);
3350*4882a593Smuzhiyun 		if (edid_ext[0] == ext_id)
3351*4882a593Smuzhiyun 			break;
3352*4882a593Smuzhiyun 	}
3353*4882a593Smuzhiyun 
3354*4882a593Smuzhiyun 	if (i == edid->extensions)
3355*4882a593Smuzhiyun 		return NULL;
3356*4882a593Smuzhiyun 
3357*4882a593Smuzhiyun 	return edid_ext;
3358*4882a593Smuzhiyun }
3359*4882a593Smuzhiyun 
drm_find_cea_extension(struct edid * edid)3360*4882a593Smuzhiyun static u8 *drm_find_cea_extension(struct edid *edid)
3361*4882a593Smuzhiyun {
3362*4882a593Smuzhiyun 	return drm_find_edid_extension(edid, 0x02);
3363*4882a593Smuzhiyun }
3364*4882a593Smuzhiyun 
3365*4882a593Smuzhiyun #define AUDIO_BLOCK	0x01
3366*4882a593Smuzhiyun #define VIDEO_BLOCK     0x02
3367*4882a593Smuzhiyun #define VENDOR_BLOCK    0x03
3368*4882a593Smuzhiyun #define SPEAKER_BLOCK	0x04
3369*4882a593Smuzhiyun #define EDID_BASIC_AUDIO BIT(6)
3370*4882a593Smuzhiyun 
3371*4882a593Smuzhiyun /**
3372*4882a593Smuzhiyun  * drm_detect_hdmi_monitor - detect whether monitor is HDMI
3373*4882a593Smuzhiyun  * @edid: monitor EDID information
3374*4882a593Smuzhiyun  *
3375*4882a593Smuzhiyun  * Parse the CEA extension according to CEA-861-B.
3376*4882a593Smuzhiyun  *
3377*4882a593Smuzhiyun  * Return: True if the monitor is HDMI, false if not or unknown.
3378*4882a593Smuzhiyun  */
drm_detect_hdmi_monitor(struct edid * edid)3379*4882a593Smuzhiyun bool drm_detect_hdmi_monitor(struct edid *edid)
3380*4882a593Smuzhiyun {
3381*4882a593Smuzhiyun 	u8 *edid_ext;
3382*4882a593Smuzhiyun 	int i;
3383*4882a593Smuzhiyun 	int start_offset, end_offset;
3384*4882a593Smuzhiyun 
3385*4882a593Smuzhiyun 	edid_ext = drm_find_cea_extension(edid);
3386*4882a593Smuzhiyun 	if (!edid_ext)
3387*4882a593Smuzhiyun 		return false;
3388*4882a593Smuzhiyun 
3389*4882a593Smuzhiyun 	if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
3390*4882a593Smuzhiyun 		return false;
3391*4882a593Smuzhiyun 
3392*4882a593Smuzhiyun 	/*
3393*4882a593Smuzhiyun 	 * Because HDMI identifier is in Vendor Specific Block,
3394*4882a593Smuzhiyun 	 * search it from all data blocks of CEA extension.
3395*4882a593Smuzhiyun 	 */
3396*4882a593Smuzhiyun 	for_each_cea_db(edid_ext, i, start_offset, end_offset) {
3397*4882a593Smuzhiyun 		if (cea_db_is_hdmi_vsdb(&edid_ext[i]))
3398*4882a593Smuzhiyun 			return true;
3399*4882a593Smuzhiyun 	}
3400*4882a593Smuzhiyun 
3401*4882a593Smuzhiyun 	return false;
3402*4882a593Smuzhiyun }
3403*4882a593Smuzhiyun 
3404*4882a593Smuzhiyun /**
3405*4882a593Smuzhiyun  * drm_detect_monitor_audio - check monitor audio capability
3406*4882a593Smuzhiyun  * @edid: EDID block to scan
3407*4882a593Smuzhiyun  *
3408*4882a593Smuzhiyun  * Monitor should have CEA extension block.
3409*4882a593Smuzhiyun  * If monitor has 'basic audio', but no CEA audio blocks, it's 'basic
3410*4882a593Smuzhiyun  * audio' only. If there is any audio extension block and supported
3411*4882a593Smuzhiyun  * audio format, assume at least 'basic audio' support, even if 'basic
3412*4882a593Smuzhiyun  * audio' is not defined in EDID.
3413*4882a593Smuzhiyun  *
3414*4882a593Smuzhiyun  * Return: True if the monitor supports audio, false otherwise.
3415*4882a593Smuzhiyun  */
drm_detect_monitor_audio(struct edid * edid)3416*4882a593Smuzhiyun bool drm_detect_monitor_audio(struct edid *edid)
3417*4882a593Smuzhiyun {
3418*4882a593Smuzhiyun 	u8 *edid_ext;
3419*4882a593Smuzhiyun 	int i, j;
3420*4882a593Smuzhiyun 	bool has_audio = false;
3421*4882a593Smuzhiyun 	int start_offset, end_offset;
3422*4882a593Smuzhiyun 
3423*4882a593Smuzhiyun 	edid_ext = drm_find_cea_extension(edid);
3424*4882a593Smuzhiyun 	if (!edid_ext)
3425*4882a593Smuzhiyun 		goto end;
3426*4882a593Smuzhiyun 
3427*4882a593Smuzhiyun 	has_audio = ((edid_ext[3] & EDID_BASIC_AUDIO) != 0);
3428*4882a593Smuzhiyun 
3429*4882a593Smuzhiyun 	if (has_audio) {
3430*4882a593Smuzhiyun 		printf("Monitor has basic audio support\n");
3431*4882a593Smuzhiyun 		goto end;
3432*4882a593Smuzhiyun 	}
3433*4882a593Smuzhiyun 
3434*4882a593Smuzhiyun 	if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
3435*4882a593Smuzhiyun 		goto end;
3436*4882a593Smuzhiyun 
3437*4882a593Smuzhiyun 	for_each_cea_db(edid_ext, i, start_offset, end_offset) {
3438*4882a593Smuzhiyun 		if (cea_db_tag(&edid_ext[i]) == AUDIO_BLOCK) {
3439*4882a593Smuzhiyun 			has_audio = true;
3440*4882a593Smuzhiyun 			for (j = 1; j < cea_db_payload_len(&edid_ext[i]) + 1;
3441*4882a593Smuzhiyun 			     j += 3)
3442*4882a593Smuzhiyun 				debug("CEA audio format %d\n",
3443*4882a593Smuzhiyun 				      (edid_ext[i + j] >> 3) & 0xf);
3444*4882a593Smuzhiyun 			goto end;
3445*4882a593Smuzhiyun 		}
3446*4882a593Smuzhiyun 	}
3447*4882a593Smuzhiyun end:
3448*4882a593Smuzhiyun 	return has_audio;
3449*4882a593Smuzhiyun }
3450*4882a593Smuzhiyun 
3451*4882a593Smuzhiyun static void
drm_parse_hdmi_vsdb_video(struct hdmi_edid_data * data,const u8 * db)3452*4882a593Smuzhiyun drm_parse_hdmi_vsdb_video(struct hdmi_edid_data *data, const u8 *db)
3453*4882a593Smuzhiyun {
3454*4882a593Smuzhiyun 	struct drm_display_info *info = &data->display_info;
3455*4882a593Smuzhiyun 	u8 len = cea_db_payload_len(db);
3456*4882a593Smuzhiyun 
3457*4882a593Smuzhiyun 	if (len >= 6)
3458*4882a593Smuzhiyun 		info->dvi_dual = db[6] & 1;
3459*4882a593Smuzhiyun 	if (len >= 7)
3460*4882a593Smuzhiyun 		info->max_tmds_clock = db[7] * 5000;
3461*4882a593Smuzhiyun 
3462*4882a593Smuzhiyun 	drm_parse_hdmi_deep_color_info(data, db);
3463*4882a593Smuzhiyun }
3464*4882a593Smuzhiyun 
drm_parse_cea_ext(struct hdmi_edid_data * data,struct edid * edid)3465*4882a593Smuzhiyun static void drm_parse_cea_ext(struct hdmi_edid_data *data,
3466*4882a593Smuzhiyun 			      struct edid *edid)
3467*4882a593Smuzhiyun {
3468*4882a593Smuzhiyun 	struct drm_display_info *info = &data->display_info;
3469*4882a593Smuzhiyun 	const u8 *edid_ext;
3470*4882a593Smuzhiyun 	int i, start, end;
3471*4882a593Smuzhiyun 
3472*4882a593Smuzhiyun 	edid_ext = drm_find_cea_extension(edid);
3473*4882a593Smuzhiyun 	if (!edid_ext)
3474*4882a593Smuzhiyun 		return;
3475*4882a593Smuzhiyun 
3476*4882a593Smuzhiyun 	info->cea_rev = edid_ext[1];
3477*4882a593Smuzhiyun 
3478*4882a593Smuzhiyun 	/* The existence of a CEA block should imply RGB support */
3479*4882a593Smuzhiyun 	info->color_formats = DRM_COLOR_FORMAT_RGB444;
3480*4882a593Smuzhiyun 	if (edid_ext[3] & EDID_CEA_YCRCB444)
3481*4882a593Smuzhiyun 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
3482*4882a593Smuzhiyun 	if (edid_ext[3] & EDID_CEA_YCRCB422)
3483*4882a593Smuzhiyun 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
3484*4882a593Smuzhiyun 
3485*4882a593Smuzhiyun 	if (cea_db_offsets(edid_ext, &start, &end))
3486*4882a593Smuzhiyun 		return;
3487*4882a593Smuzhiyun 
3488*4882a593Smuzhiyun 	for_each_cea_db(edid_ext, i, start, end) {
3489*4882a593Smuzhiyun 		const u8 *db = &edid_ext[i];
3490*4882a593Smuzhiyun 
3491*4882a593Smuzhiyun 		if (cea_db_is_hdmi_vsdb(db))
3492*4882a593Smuzhiyun 			drm_parse_hdmi_vsdb_video(data, db);
3493*4882a593Smuzhiyun 		if (cea_db_is_hdmi_forum_vsdb(db))
3494*4882a593Smuzhiyun 			drm_parse_hdmi_forum_vsdb(data, db);
3495*4882a593Smuzhiyun 		if (cea_db_is_y420cmdb(db))
3496*4882a593Smuzhiyun 			drm_parse_y420cmdb_bitmap(data, db);
3497*4882a593Smuzhiyun 	}
3498*4882a593Smuzhiyun }
3499*4882a593Smuzhiyun 
drm_add_display_info(struct hdmi_edid_data * data,struct edid * edid)3500*4882a593Smuzhiyun static void drm_add_display_info(struct hdmi_edid_data *data, struct edid *edid)
3501*4882a593Smuzhiyun {
3502*4882a593Smuzhiyun 	struct drm_display_info *info = &data->display_info;
3503*4882a593Smuzhiyun 
3504*4882a593Smuzhiyun 	info->width_mm = edid->width_cm * 10;
3505*4882a593Smuzhiyun 	info->height_mm = edid->height_cm * 10;
3506*4882a593Smuzhiyun 
3507*4882a593Smuzhiyun 	/* driver figures it out in this case */
3508*4882a593Smuzhiyun 	info->bpc = 0;
3509*4882a593Smuzhiyun 	info->color_formats = 0;
3510*4882a593Smuzhiyun 	info->cea_rev = 0;
3511*4882a593Smuzhiyun 	info->max_tmds_clock = 0;
3512*4882a593Smuzhiyun 	info->dvi_dual = false;
3513*4882a593Smuzhiyun 	info->edid_hdmi_dc_modes = 0;
3514*4882a593Smuzhiyun 
3515*4882a593Smuzhiyun 	memset(&info->hdmi, 0, sizeof(info->hdmi));
3516*4882a593Smuzhiyun 
3517*4882a593Smuzhiyun 	if (edid->revision < 3)
3518*4882a593Smuzhiyun 		return;
3519*4882a593Smuzhiyun 
3520*4882a593Smuzhiyun 	if (!(edid->input & DRM_EDID_INPUT_DIGITAL))
3521*4882a593Smuzhiyun 		return;
3522*4882a593Smuzhiyun 
3523*4882a593Smuzhiyun 	drm_parse_cea_ext(data, edid);
3524*4882a593Smuzhiyun 
3525*4882a593Smuzhiyun 	/*
3526*4882a593Smuzhiyun 	 * Digital sink with "DFP 1.x compliant TMDS" according to EDID 1.3?
3527*4882a593Smuzhiyun 	 *
3528*4882a593Smuzhiyun 	 * For such displays, the DFP spec 1.0, section 3.10 "EDID support"
3529*4882a593Smuzhiyun 	 * tells us to assume 8 bpc color depth if the EDID doesn't have
3530*4882a593Smuzhiyun 	 * extensions which tell otherwise.
3531*4882a593Smuzhiyun 	 */
3532*4882a593Smuzhiyun 	if ((info->bpc == 0) && (edid->revision < 4) &&
3533*4882a593Smuzhiyun 	    (edid->input & DRM_EDID_DIGITAL_TYPE_DVI)) {
3534*4882a593Smuzhiyun 		info->bpc = 8;
3535*4882a593Smuzhiyun 		debug("Assigning DFP sink color depth as %d bpc.\n", info->bpc);
3536*4882a593Smuzhiyun 	}
3537*4882a593Smuzhiyun 
3538*4882a593Smuzhiyun 	/* Only defined for 1.4 with digital displays */
3539*4882a593Smuzhiyun 	if (edid->revision < 4)
3540*4882a593Smuzhiyun 		return;
3541*4882a593Smuzhiyun 
3542*4882a593Smuzhiyun 	switch (edid->input & DRM_EDID_DIGITAL_DEPTH_MASK) {
3543*4882a593Smuzhiyun 	case DRM_EDID_DIGITAL_DEPTH_6:
3544*4882a593Smuzhiyun 		info->bpc = 6;
3545*4882a593Smuzhiyun 		break;
3546*4882a593Smuzhiyun 	case DRM_EDID_DIGITAL_DEPTH_8:
3547*4882a593Smuzhiyun 		info->bpc = 8;
3548*4882a593Smuzhiyun 		break;
3549*4882a593Smuzhiyun 	case DRM_EDID_DIGITAL_DEPTH_10:
3550*4882a593Smuzhiyun 		info->bpc = 10;
3551*4882a593Smuzhiyun 		break;
3552*4882a593Smuzhiyun 	case DRM_EDID_DIGITAL_DEPTH_12:
3553*4882a593Smuzhiyun 		info->bpc = 12;
3554*4882a593Smuzhiyun 		break;
3555*4882a593Smuzhiyun 	case DRM_EDID_DIGITAL_DEPTH_14:
3556*4882a593Smuzhiyun 		info->bpc = 14;
3557*4882a593Smuzhiyun 		break;
3558*4882a593Smuzhiyun 	case DRM_EDID_DIGITAL_DEPTH_16:
3559*4882a593Smuzhiyun 		info->bpc = 16;
3560*4882a593Smuzhiyun 		break;
3561*4882a593Smuzhiyun 	case DRM_EDID_DIGITAL_DEPTH_UNDEF:
3562*4882a593Smuzhiyun 	default:
3563*4882a593Smuzhiyun 		info->bpc = 0;
3564*4882a593Smuzhiyun 		break;
3565*4882a593Smuzhiyun 	}
3566*4882a593Smuzhiyun 
3567*4882a593Smuzhiyun 	debug("Assigning EDID-1.4 digital sink color depth as %d bpc.\n",
3568*4882a593Smuzhiyun 	      info->bpc);
3569*4882a593Smuzhiyun 
3570*4882a593Smuzhiyun 	info->color_formats |= DRM_COLOR_FORMAT_RGB444;
3571*4882a593Smuzhiyun 	if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB444)
3572*4882a593Smuzhiyun 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
3573*4882a593Smuzhiyun 	if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB422)
3574*4882a593Smuzhiyun 		info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
3575*4882a593Smuzhiyun }
3576*4882a593Smuzhiyun 
3577*4882a593Smuzhiyun static
add_cea_modes(struct hdmi_edid_data * data,struct edid * edid)3578*4882a593Smuzhiyun int add_cea_modes(struct hdmi_edid_data *data, struct edid *edid)
3579*4882a593Smuzhiyun {
3580*4882a593Smuzhiyun 	const u8 *cea = drm_find_cea_extension(edid);
3581*4882a593Smuzhiyun 	const u8 *db, *hdmi = NULL, *video = NULL;
3582*4882a593Smuzhiyun 	u8 dbl, hdmi_len, video_len = 0;
3583*4882a593Smuzhiyun 	int modes = 0;
3584*4882a593Smuzhiyun 
3585*4882a593Smuzhiyun 	if (cea && cea_revision(cea) >= 3) {
3586*4882a593Smuzhiyun 		int i, start, end;
3587*4882a593Smuzhiyun 
3588*4882a593Smuzhiyun 		if (cea_db_offsets(cea, &start, &end))
3589*4882a593Smuzhiyun 			return 0;
3590*4882a593Smuzhiyun 
3591*4882a593Smuzhiyun 		for_each_cea_db(cea, i, start, end) {
3592*4882a593Smuzhiyun 			db = &cea[i];
3593*4882a593Smuzhiyun 			dbl = cea_db_payload_len(db);
3594*4882a593Smuzhiyun 
3595*4882a593Smuzhiyun 			if (cea_db_tag(db) == EDID_CEA861_DB_VIDEO) {
3596*4882a593Smuzhiyun 				video = db + 1;
3597*4882a593Smuzhiyun 				video_len = dbl;
3598*4882a593Smuzhiyun 				modes += do_cea_modes(data, video, dbl);
3599*4882a593Smuzhiyun 			} else if (cea_db_is_hdmi_vsdb(db)) {
3600*4882a593Smuzhiyun 				hdmi = db;
3601*4882a593Smuzhiyun 				hdmi_len = dbl;
3602*4882a593Smuzhiyun 			} else if (cea_db_is_y420vdb(db)) {
3603*4882a593Smuzhiyun 				const u8 *vdb420 = &db[2];
3604*4882a593Smuzhiyun 
3605*4882a593Smuzhiyun 				/* Add 4:2:0(only) modes present in EDID */
3606*4882a593Smuzhiyun 				modes += do_y420vdb_modes(data, vdb420,
3607*4882a593Smuzhiyun 							  dbl - 1);
3608*4882a593Smuzhiyun 			}
3609*4882a593Smuzhiyun 		}
3610*4882a593Smuzhiyun 	}
3611*4882a593Smuzhiyun 
3612*4882a593Smuzhiyun 	/*
3613*4882a593Smuzhiyun 	 * We parse the HDMI VSDB after having added the cea modes as we will
3614*4882a593Smuzhiyun 	 * be patching their flags when the sink supports stereo 3D.
3615*4882a593Smuzhiyun 	 */
3616*4882a593Smuzhiyun 	if (hdmi)
3617*4882a593Smuzhiyun 		modes += do_hdmi_vsdb_modes(hdmi, hdmi_len, video,
3618*4882a593Smuzhiyun 					    video_len, data);
3619*4882a593Smuzhiyun 
3620*4882a593Smuzhiyun 	return modes;
3621*4882a593Smuzhiyun }
3622*4882a593Smuzhiyun 
3623*4882a593Smuzhiyun typedef void detailed_cb(struct detailed_timing *timing, void *closure);
3624*4882a593Smuzhiyun 
3625*4882a593Smuzhiyun static void
cea_for_each_detailed_block(u8 * ext,detailed_cb * cb,void * closure)3626*4882a593Smuzhiyun cea_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
3627*4882a593Smuzhiyun {
3628*4882a593Smuzhiyun 	int i, n = 0;
3629*4882a593Smuzhiyun 	u8 d = ext[0x02];
3630*4882a593Smuzhiyun 	u8 *det_base = ext + d;
3631*4882a593Smuzhiyun 
3632*4882a593Smuzhiyun 	if (d < 4 || d > 127)
3633*4882a593Smuzhiyun 		return;
3634*4882a593Smuzhiyun 
3635*4882a593Smuzhiyun 	n = (127 - d) / 18;
3636*4882a593Smuzhiyun 	for (i = 0; i < n; i++)
3637*4882a593Smuzhiyun 		cb((struct detailed_timing *)(det_base + 18 * i), closure);
3638*4882a593Smuzhiyun }
3639*4882a593Smuzhiyun 
3640*4882a593Smuzhiyun static void
vtb_for_each_detailed_block(u8 * ext,detailed_cb * cb,void * closure)3641*4882a593Smuzhiyun vtb_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
3642*4882a593Smuzhiyun {
3643*4882a593Smuzhiyun 	unsigned int i, n = min((int)ext[0x02], 6);
3644*4882a593Smuzhiyun 	u8 *det_base = ext + 5;
3645*4882a593Smuzhiyun 
3646*4882a593Smuzhiyun 	if (ext[0x01] != 1)
3647*4882a593Smuzhiyun 		return; /* unknown version */
3648*4882a593Smuzhiyun 
3649*4882a593Smuzhiyun 	for (i = 0; i < n; i++)
3650*4882a593Smuzhiyun 		cb((struct detailed_timing *)(det_base + 18 * i), closure);
3651*4882a593Smuzhiyun }
3652*4882a593Smuzhiyun 
3653*4882a593Smuzhiyun static void
drm_for_each_detailed_block(u8 * raw_edid,detailed_cb * cb,void * closure)3654*4882a593Smuzhiyun drm_for_each_detailed_block(u8 *raw_edid, detailed_cb *cb, void *closure)
3655*4882a593Smuzhiyun {
3656*4882a593Smuzhiyun 	int i;
3657*4882a593Smuzhiyun 	struct edid *edid = (struct edid *)raw_edid;
3658*4882a593Smuzhiyun 
3659*4882a593Smuzhiyun 	if (!edid)
3660*4882a593Smuzhiyun 		return;
3661*4882a593Smuzhiyun 
3662*4882a593Smuzhiyun 	for (i = 0; i < EDID_DETAILED_TIMINGS; i++)
3663*4882a593Smuzhiyun 		cb(&edid->detailed_timings[i], closure);
3664*4882a593Smuzhiyun 
3665*4882a593Smuzhiyun 	for (i = 1; i <= raw_edid[0x7e]; i++) {
3666*4882a593Smuzhiyun 		u8 *ext = raw_edid + (i * EDID_SIZE);
3667*4882a593Smuzhiyun 
3668*4882a593Smuzhiyun 		switch (*ext) {
3669*4882a593Smuzhiyun 		case CEA_EXT:
3670*4882a593Smuzhiyun 			cea_for_each_detailed_block(ext, cb, closure);
3671*4882a593Smuzhiyun 			break;
3672*4882a593Smuzhiyun 		case VTB_EXT:
3673*4882a593Smuzhiyun 			vtb_for_each_detailed_block(ext, cb, closure);
3674*4882a593Smuzhiyun 			break;
3675*4882a593Smuzhiyun 		default:
3676*4882a593Smuzhiyun 			break;
3677*4882a593Smuzhiyun 		}
3678*4882a593Smuzhiyun 	}
3679*4882a593Smuzhiyun }
3680*4882a593Smuzhiyun 
3681*4882a593Smuzhiyun /*
3682*4882a593Smuzhiyun  * EDID is delightfully ambiguous about how interlaced modes are to be
3683*4882a593Smuzhiyun  * encoded.  Our internal representation is of frame height, but some
3684*4882a593Smuzhiyun  * HDTV detailed timings are encoded as field height.
3685*4882a593Smuzhiyun  *
3686*4882a593Smuzhiyun  * The format list here is from CEA, in frame size.  Technically we
3687*4882a593Smuzhiyun  * should be checking refresh rate too.  Whatever.
3688*4882a593Smuzhiyun  */
3689*4882a593Smuzhiyun static void
drm_mode_do_interlace_quirk(struct drm_display_mode * mode,struct detailed_pixel_timing * pt)3690*4882a593Smuzhiyun drm_mode_do_interlace_quirk(struct drm_display_mode *mode,
3691*4882a593Smuzhiyun 			    struct detailed_pixel_timing *pt)
3692*4882a593Smuzhiyun {
3693*4882a593Smuzhiyun 	int i;
3694*4882a593Smuzhiyun 
3695*4882a593Smuzhiyun 	static const struct {
3696*4882a593Smuzhiyun 		int w, h;
3697*4882a593Smuzhiyun 	} cea_interlaced[] = {
3698*4882a593Smuzhiyun 		{ 1920, 1080 },
3699*4882a593Smuzhiyun 		{  720,  480 },
3700*4882a593Smuzhiyun 		{ 1440,  480 },
3701*4882a593Smuzhiyun 		{ 2880,  480 },
3702*4882a593Smuzhiyun 		{  720,  576 },
3703*4882a593Smuzhiyun 		{ 1440,  576 },
3704*4882a593Smuzhiyun 		{ 2880,  576 },
3705*4882a593Smuzhiyun 	};
3706*4882a593Smuzhiyun 
3707*4882a593Smuzhiyun 	if (!(pt->misc & DRM_EDID_PT_INTERLACED))
3708*4882a593Smuzhiyun 		return;
3709*4882a593Smuzhiyun 
3710*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(cea_interlaced); i++) {
3711*4882a593Smuzhiyun 		if ((mode->hdisplay == cea_interlaced[i].w) &&
3712*4882a593Smuzhiyun 		    (mode->vdisplay == cea_interlaced[i].h / 2)) {
3713*4882a593Smuzhiyun 			mode->vdisplay *= 2;
3714*4882a593Smuzhiyun 			mode->vsync_start *= 2;
3715*4882a593Smuzhiyun 			mode->vsync_end *= 2;
3716*4882a593Smuzhiyun 			mode->vtotal *= 2;
3717*4882a593Smuzhiyun 			mode->vtotal |= 1;
3718*4882a593Smuzhiyun 		}
3719*4882a593Smuzhiyun 	}
3720*4882a593Smuzhiyun 
3721*4882a593Smuzhiyun 	mode->flags |= DRM_MODE_FLAG_INTERLACE;
3722*4882a593Smuzhiyun }
3723*4882a593Smuzhiyun 
3724*4882a593Smuzhiyun /**
3725*4882a593Smuzhiyun  * drm_mode_detailed - create a new mode from an EDID detailed timing section
3726*4882a593Smuzhiyun  * @edid: EDID block
3727*4882a593Smuzhiyun  * @timing: EDID detailed timing info
3728*4882a593Smuzhiyun  * @quirks: quirks to apply
3729*4882a593Smuzhiyun  *
3730*4882a593Smuzhiyun  * An EDID detailed timing block contains enough info for us to create and
3731*4882a593Smuzhiyun  * return a new struct drm_display_mode.
3732*4882a593Smuzhiyun  */
3733*4882a593Smuzhiyun static
drm_mode_detailed(struct edid * edid,struct detailed_timing * timing,u32 quirks)3734*4882a593Smuzhiyun struct drm_display_mode *drm_mode_detailed(struct edid *edid,
3735*4882a593Smuzhiyun 					   struct detailed_timing *timing,
3736*4882a593Smuzhiyun 					   u32 quirks)
3737*4882a593Smuzhiyun {
3738*4882a593Smuzhiyun 	struct drm_display_mode *mode;
3739*4882a593Smuzhiyun 	struct detailed_pixel_timing *pt = &timing->data.pixel_data;
3740*4882a593Smuzhiyun 	unsigned hactive = (pt->hactive_hblank_hi & 0xf0) << 4 | pt->hactive_lo;
3741*4882a593Smuzhiyun 	unsigned vactive = (pt->vactive_vblank_hi & 0xf0) << 4 | pt->vactive_lo;
3742*4882a593Smuzhiyun 	unsigned hblank = (pt->hactive_hblank_hi & 0xf) << 8 | pt->hblank_lo;
3743*4882a593Smuzhiyun 	unsigned vblank = (pt->vactive_vblank_hi & 0xf) << 8 | pt->vblank_lo;
3744*4882a593Smuzhiyun 	unsigned hsync_offset =
3745*4882a593Smuzhiyun 		(pt->hsync_vsync_offset_pulse_width_hi & 0xc0) << 2 |
3746*4882a593Smuzhiyun 		pt->hsync_offset_lo;
3747*4882a593Smuzhiyun 	unsigned hsync_pulse_width =
3748*4882a593Smuzhiyun 		(pt->hsync_vsync_offset_pulse_width_hi & 0x30) << 4 |
3749*4882a593Smuzhiyun 		pt->hsync_pulse_width_lo;
3750*4882a593Smuzhiyun 	unsigned vsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc) <<
3751*4882a593Smuzhiyun 		2 | pt->vsync_offset_pulse_width_lo >> 4;
3752*4882a593Smuzhiyun 	unsigned vsync_pulse_width =
3753*4882a593Smuzhiyun 		(pt->hsync_vsync_offset_pulse_width_hi & 0x3) << 4 |
3754*4882a593Smuzhiyun 		(pt->vsync_offset_pulse_width_lo & 0xf);
3755*4882a593Smuzhiyun 
3756*4882a593Smuzhiyun 	/* ignore tiny modes */
3757*4882a593Smuzhiyun 	if (hactive < 64 || vactive < 64)
3758*4882a593Smuzhiyun 		return NULL;
3759*4882a593Smuzhiyun 
3760*4882a593Smuzhiyun 	if (pt->misc & DRM_EDID_PT_STEREO) {
3761*4882a593Smuzhiyun 		debug("stereo mode not supported\n");
3762*4882a593Smuzhiyun 		return NULL;
3763*4882a593Smuzhiyun 	}
3764*4882a593Smuzhiyun 	if (!(pt->misc & DRM_EDID_PT_SEPARATE_SYNC))
3765*4882a593Smuzhiyun 		debug("composite sync not supported\n");
3766*4882a593Smuzhiyun 
3767*4882a593Smuzhiyun 	/* it is incorrect if hsync/vsync width is zero */
3768*4882a593Smuzhiyun 	if (!hsync_pulse_width || !vsync_pulse_width) {
3769*4882a593Smuzhiyun 		debug("Incorrect Detailed timing. ");
3770*4882a593Smuzhiyun 		debug("Wrong Hsync/Vsync pulse width\n");
3771*4882a593Smuzhiyun 		return NULL;
3772*4882a593Smuzhiyun 	}
3773*4882a593Smuzhiyun 
3774*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_FORCE_REDUCED_BLANKING) {
3775*4882a593Smuzhiyun 		mode = drm_cvt_mode(hactive, vactive, 60, true, false, false);
3776*4882a593Smuzhiyun 		if (!mode)
3777*4882a593Smuzhiyun 			return NULL;
3778*4882a593Smuzhiyun 
3779*4882a593Smuzhiyun 		goto set_refresh;
3780*4882a593Smuzhiyun 	}
3781*4882a593Smuzhiyun 
3782*4882a593Smuzhiyun 	mode = drm_mode_create();
3783*4882a593Smuzhiyun 	if (!mode)
3784*4882a593Smuzhiyun 		return NULL;
3785*4882a593Smuzhiyun 
3786*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_135_CLOCK_TOO_HIGH)
3787*4882a593Smuzhiyun 		timing->pixel_clock = cpu_to_le16(1088);
3788*4882a593Smuzhiyun 
3789*4882a593Smuzhiyun 	mode->clock = le16_to_cpu(timing->pixel_clock) * 10;
3790*4882a593Smuzhiyun 
3791*4882a593Smuzhiyun 	mode->hdisplay = hactive;
3792*4882a593Smuzhiyun 	mode->hsync_start = mode->hdisplay + hsync_offset;
3793*4882a593Smuzhiyun 	mode->hsync_end = mode->hsync_start + hsync_pulse_width;
3794*4882a593Smuzhiyun 	mode->htotal = mode->hdisplay + hblank;
3795*4882a593Smuzhiyun 
3796*4882a593Smuzhiyun 	mode->vdisplay = vactive;
3797*4882a593Smuzhiyun 	mode->vsync_start = mode->vdisplay + vsync_offset;
3798*4882a593Smuzhiyun 	mode->vsync_end = mode->vsync_start + vsync_pulse_width;
3799*4882a593Smuzhiyun 	mode->vtotal = mode->vdisplay + vblank;
3800*4882a593Smuzhiyun 
3801*4882a593Smuzhiyun 	/* Some EDIDs have bogus h/vtotal values */
3802*4882a593Smuzhiyun 	if (mode->hsync_end > mode->htotal)
3803*4882a593Smuzhiyun 		mode->htotal = mode->hsync_end + 1;
3804*4882a593Smuzhiyun 	if (mode->vsync_end > mode->vtotal)
3805*4882a593Smuzhiyun 		mode->vtotal = mode->vsync_end + 1;
3806*4882a593Smuzhiyun 
3807*4882a593Smuzhiyun 	drm_mode_do_interlace_quirk(mode, pt);
3808*4882a593Smuzhiyun 
3809*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_DETAILED_SYNC_PP)
3810*4882a593Smuzhiyun 		pt->misc |= DRM_EDID_PT_HSYNC_POSITIVE |
3811*4882a593Smuzhiyun 			DRM_EDID_PT_VSYNC_POSITIVE;
3812*4882a593Smuzhiyun 
3813*4882a593Smuzhiyun 	mode->flags |= (pt->misc & DRM_EDID_PT_HSYNC_POSITIVE) ?
3814*4882a593Smuzhiyun 		DRM_MODE_FLAG_PHSYNC : DRM_MODE_FLAG_NHSYNC;
3815*4882a593Smuzhiyun 	mode->flags |= (pt->misc & DRM_EDID_PT_VSYNC_POSITIVE) ?
3816*4882a593Smuzhiyun 		DRM_MODE_FLAG_PVSYNC : DRM_MODE_FLAG_NVSYNC;
3817*4882a593Smuzhiyun 
3818*4882a593Smuzhiyun set_refresh:
3819*4882a593Smuzhiyun 
3820*4882a593Smuzhiyun 	mode->type = DRM_MODE_TYPE_DRIVER;
3821*4882a593Smuzhiyun 	mode->vrefresh = drm_get_vrefresh(mode);
3822*4882a593Smuzhiyun 
3823*4882a593Smuzhiyun 	return mode;
3824*4882a593Smuzhiyun }
3825*4882a593Smuzhiyun 
3826*4882a593Smuzhiyun /*
3827*4882a593Smuzhiyun  * Calculate the alternate clock for the CEA mode
3828*4882a593Smuzhiyun  * (60Hz vs. 59.94Hz etc.)
3829*4882a593Smuzhiyun  */
3830*4882a593Smuzhiyun static unsigned int
cea_mode_alternate_clock(const struct drm_display_mode * cea_mode)3831*4882a593Smuzhiyun cea_mode_alternate_clock(const struct drm_display_mode *cea_mode)
3832*4882a593Smuzhiyun {
3833*4882a593Smuzhiyun 	unsigned int clock = cea_mode->clock;
3834*4882a593Smuzhiyun 
3835*4882a593Smuzhiyun 	if (cea_mode->vrefresh % 6 != 0)
3836*4882a593Smuzhiyun 		return clock;
3837*4882a593Smuzhiyun 
3838*4882a593Smuzhiyun 	/*
3839*4882a593Smuzhiyun 	 * edid_cea_modes contains the 59.94Hz
3840*4882a593Smuzhiyun 	 * variant for 240 and 480 line modes,
3841*4882a593Smuzhiyun 	 * and the 60Hz variant otherwise.
3842*4882a593Smuzhiyun 	 */
3843*4882a593Smuzhiyun 	if (cea_mode->vdisplay == 240 || cea_mode->vdisplay == 480)
3844*4882a593Smuzhiyun 		clock = DIV_ROUND_CLOSEST(clock * 1001, 1000);
3845*4882a593Smuzhiyun 	else
3846*4882a593Smuzhiyun 		clock = DIV_ROUND_CLOSEST(clock * 1000, 1001);
3847*4882a593Smuzhiyun 
3848*4882a593Smuzhiyun 	return clock;
3849*4882a593Smuzhiyun }
3850*4882a593Smuzhiyun 
3851*4882a593Smuzhiyun /**
3852*4882a593Smuzhiyun  * drm_mode_equal_no_clocks_no_stereo - test modes for equality
3853*4882a593Smuzhiyun  * @mode1: first mode
3854*4882a593Smuzhiyun  * @mode2: second mode
3855*4882a593Smuzhiyun  *
3856*4882a593Smuzhiyun  * Check to see if @mode1 and @mode2 are equivalent, but
3857*4882a593Smuzhiyun  * don't check the pixel clocks nor the stereo layout.
3858*4882a593Smuzhiyun  *
3859*4882a593Smuzhiyun  * Returns:
3860*4882a593Smuzhiyun  * True if the modes are equal, false otherwise.
3861*4882a593Smuzhiyun  */
3862*4882a593Smuzhiyun 
3863*4882a593Smuzhiyun static
drm_mode_equal_no_clocks_no_stereo(const struct drm_display_mode * mode1,const struct drm_display_mode * mode2)3864*4882a593Smuzhiyun bool drm_mode_equal_no_clocks_no_stereo(const struct drm_display_mode *mode1,
3865*4882a593Smuzhiyun 					const struct drm_display_mode *mode2)
3866*4882a593Smuzhiyun {
3867*4882a593Smuzhiyun 	unsigned int flags_mask =
3868*4882a593Smuzhiyun 		~(DRM_MODE_FLAG_3D_MASK | DRM_MODE_FLAG_420_MASK);
3869*4882a593Smuzhiyun 
3870*4882a593Smuzhiyun 	if (mode1->hdisplay == mode2->hdisplay &&
3871*4882a593Smuzhiyun 	    mode1->hsync_start == mode2->hsync_start &&
3872*4882a593Smuzhiyun 	    mode1->hsync_end == mode2->hsync_end &&
3873*4882a593Smuzhiyun 	    mode1->htotal == mode2->htotal &&
3874*4882a593Smuzhiyun 	    mode1->vdisplay == mode2->vdisplay &&
3875*4882a593Smuzhiyun 	    mode1->vsync_start == mode2->vsync_start &&
3876*4882a593Smuzhiyun 	    mode1->vsync_end == mode2->vsync_end &&
3877*4882a593Smuzhiyun 	    mode1->vtotal == mode2->vtotal &&
3878*4882a593Smuzhiyun 	    mode1->vscan == mode2->vscan &&
3879*4882a593Smuzhiyun 	    (mode1->flags & flags_mask) == (mode2->flags & flags_mask))
3880*4882a593Smuzhiyun 		return true;
3881*4882a593Smuzhiyun 
3882*4882a593Smuzhiyun 	return false;
3883*4882a593Smuzhiyun }
3884*4882a593Smuzhiyun 
3885*4882a593Smuzhiyun /**
3886*4882a593Smuzhiyun  * drm_mode_equal_no_clocks - test modes for equality
3887*4882a593Smuzhiyun  * @mode1: first mode
3888*4882a593Smuzhiyun  * @mode2: second mode
3889*4882a593Smuzhiyun  *
3890*4882a593Smuzhiyun  * Check to see if @mode1 and @mode2 are equivalent, but
3891*4882a593Smuzhiyun  * don't check the pixel clocks.
3892*4882a593Smuzhiyun  *
3893*4882a593Smuzhiyun  * Returns:
3894*4882a593Smuzhiyun  * True if the modes are equal, false otherwise.
3895*4882a593Smuzhiyun  */
drm_mode_equal_no_clocks(const struct drm_display_mode * mode1,const struct drm_display_mode * mode2)3896*4882a593Smuzhiyun static bool drm_mode_equal_no_clocks(const struct drm_display_mode *mode1,
3897*4882a593Smuzhiyun 				     const struct drm_display_mode *mode2)
3898*4882a593Smuzhiyun {
3899*4882a593Smuzhiyun 	if ((mode1->flags & DRM_MODE_FLAG_3D_MASK) !=
3900*4882a593Smuzhiyun 	    (mode2->flags & DRM_MODE_FLAG_3D_MASK))
3901*4882a593Smuzhiyun 		return false;
3902*4882a593Smuzhiyun 
3903*4882a593Smuzhiyun 	return drm_mode_equal_no_clocks_no_stereo(mode1, mode2);
3904*4882a593Smuzhiyun }
3905*4882a593Smuzhiyun 
3906*4882a593Smuzhiyun static
drm_match_cea_mode_clock_tolerance(const struct drm_display_mode * to_match,unsigned int clock_tolerance)3907*4882a593Smuzhiyun u8 drm_match_cea_mode_clock_tolerance(const struct drm_display_mode *to_match,
3908*4882a593Smuzhiyun 				      unsigned int clock_tolerance)
3909*4882a593Smuzhiyun {
3910*4882a593Smuzhiyun 	u8 vic;
3911*4882a593Smuzhiyun 
3912*4882a593Smuzhiyun 	if (!to_match->clock)
3913*4882a593Smuzhiyun 		return 0;
3914*4882a593Smuzhiyun 
3915*4882a593Smuzhiyun 	for (vic = 1; vic < cea_num_vics(); vic = cea_next_vic(vic)) {
3916*4882a593Smuzhiyun 		const struct drm_display_mode *cea_mode = cea_mode_for_vic(vic);
3917*4882a593Smuzhiyun 		unsigned int clock1, clock2;
3918*4882a593Smuzhiyun 
3919*4882a593Smuzhiyun 		/* Check both 60Hz and 59.94Hz */
3920*4882a593Smuzhiyun 		clock1 = cea_mode->clock;
3921*4882a593Smuzhiyun 		clock2 = cea_mode_alternate_clock(cea_mode);
3922*4882a593Smuzhiyun 
3923*4882a593Smuzhiyun 		if (abs(to_match->clock - clock1) > clock_tolerance &&
3924*4882a593Smuzhiyun 		    abs(to_match->clock - clock2) > clock_tolerance)
3925*4882a593Smuzhiyun 			continue;
3926*4882a593Smuzhiyun 
3927*4882a593Smuzhiyun 		if (drm_mode_equal_no_clocks(to_match, cea_mode))
3928*4882a593Smuzhiyun 			return vic;
3929*4882a593Smuzhiyun 	}
3930*4882a593Smuzhiyun 
3931*4882a593Smuzhiyun 	return 0;
3932*4882a593Smuzhiyun }
3933*4882a593Smuzhiyun 
3934*4882a593Smuzhiyun static unsigned int
hdmi_mode_alternate_clock(const struct drm_display_mode * hdmi_mode)3935*4882a593Smuzhiyun hdmi_mode_alternate_clock(const struct drm_display_mode *hdmi_mode)
3936*4882a593Smuzhiyun {
3937*4882a593Smuzhiyun 	if (hdmi_mode->vdisplay == 4096 && hdmi_mode->hdisplay == 2160)
3938*4882a593Smuzhiyun 		return hdmi_mode->clock;
3939*4882a593Smuzhiyun 
3940*4882a593Smuzhiyun 	return cea_mode_alternate_clock(hdmi_mode);
3941*4882a593Smuzhiyun }
3942*4882a593Smuzhiyun 
3943*4882a593Smuzhiyun static
drm_match_hdmi_mode_clock_tolerance(const struct drm_display_mode * to_match,unsigned int clock_tolerance)3944*4882a593Smuzhiyun u8 drm_match_hdmi_mode_clock_tolerance(const struct drm_display_mode *to_match,
3945*4882a593Smuzhiyun 				       unsigned int clock_tolerance)
3946*4882a593Smuzhiyun {
3947*4882a593Smuzhiyun 	u8 vic;
3948*4882a593Smuzhiyun 
3949*4882a593Smuzhiyun 	if (!to_match->clock)
3950*4882a593Smuzhiyun 		return 0;
3951*4882a593Smuzhiyun 
3952*4882a593Smuzhiyun 	for (vic = 1; vic < ARRAY_SIZE(edid_4k_modes); vic++) {
3953*4882a593Smuzhiyun 		const struct drm_display_mode *hdmi_mode = &edid_4k_modes[vic];
3954*4882a593Smuzhiyun 		unsigned int clock1, clock2;
3955*4882a593Smuzhiyun 
3956*4882a593Smuzhiyun 		/* Make sure to also match alternate clocks */
3957*4882a593Smuzhiyun 		clock1 = hdmi_mode->clock;
3958*4882a593Smuzhiyun 		clock2 = hdmi_mode_alternate_clock(hdmi_mode);
3959*4882a593Smuzhiyun 
3960*4882a593Smuzhiyun 		if (abs(to_match->clock - clock1) > clock_tolerance &&
3961*4882a593Smuzhiyun 		    abs(to_match->clock - clock2) > clock_tolerance)
3962*4882a593Smuzhiyun 			continue;
3963*4882a593Smuzhiyun 
3964*4882a593Smuzhiyun 		if (drm_mode_equal_no_clocks(to_match, hdmi_mode))
3965*4882a593Smuzhiyun 			return vic;
3966*4882a593Smuzhiyun 	}
3967*4882a593Smuzhiyun 
3968*4882a593Smuzhiyun 	return 0;
3969*4882a593Smuzhiyun }
3970*4882a593Smuzhiyun 
fixup_detailed_cea_mode_clock(struct drm_display_mode * mode)3971*4882a593Smuzhiyun static void fixup_detailed_cea_mode_clock(struct drm_display_mode *mode)
3972*4882a593Smuzhiyun {
3973*4882a593Smuzhiyun 	const struct drm_display_mode *cea_mode;
3974*4882a593Smuzhiyun 	int clock1, clock2, clock;
3975*4882a593Smuzhiyun 	u8 vic;
3976*4882a593Smuzhiyun 	const char *type;
3977*4882a593Smuzhiyun 
3978*4882a593Smuzhiyun 	/*
3979*4882a593Smuzhiyun 	 * allow 5kHz clock difference either way to account for
3980*4882a593Smuzhiyun 	 * the 10kHz clock resolution limit of detailed timings.
3981*4882a593Smuzhiyun 	 */
3982*4882a593Smuzhiyun 	vic = drm_match_cea_mode_clock_tolerance(mode, 5);
3983*4882a593Smuzhiyun 	if (drm_valid_cea_vic(vic)) {
3984*4882a593Smuzhiyun 		type = "CEA";
3985*4882a593Smuzhiyun 		cea_mode = cea_mode_for_vic(vic);
3986*4882a593Smuzhiyun 		clock1 = cea_mode->clock;
3987*4882a593Smuzhiyun 		clock2 = cea_mode_alternate_clock(cea_mode);
3988*4882a593Smuzhiyun 	} else {
3989*4882a593Smuzhiyun 		vic = drm_match_hdmi_mode_clock_tolerance(mode, 5);
3990*4882a593Smuzhiyun 		if (drm_valid_hdmi_vic(vic)) {
3991*4882a593Smuzhiyun 			type = "HDMI";
3992*4882a593Smuzhiyun 			cea_mode = &edid_4k_modes[vic];
3993*4882a593Smuzhiyun 			clock1 = cea_mode->clock;
3994*4882a593Smuzhiyun 			clock2 = hdmi_mode_alternate_clock(cea_mode);
3995*4882a593Smuzhiyun 		} else {
3996*4882a593Smuzhiyun 			return;
3997*4882a593Smuzhiyun 		}
3998*4882a593Smuzhiyun 	}
3999*4882a593Smuzhiyun 
4000*4882a593Smuzhiyun 	/* pick whichever is closest */
4001*4882a593Smuzhiyun 	if (abs(mode->clock - clock1) < abs(mode->clock - clock2))
4002*4882a593Smuzhiyun 		clock = clock1;
4003*4882a593Smuzhiyun 	else
4004*4882a593Smuzhiyun 		clock = clock2;
4005*4882a593Smuzhiyun 
4006*4882a593Smuzhiyun 	if (mode->clock == clock)
4007*4882a593Smuzhiyun 		return;
4008*4882a593Smuzhiyun 
4009*4882a593Smuzhiyun 	debug("detailed mode matches %s VIC %d, adjusting clock %d -> %d\n",
4010*4882a593Smuzhiyun 	      type, vic, mode->clock, clock);
4011*4882a593Smuzhiyun 	mode->clock = clock;
4012*4882a593Smuzhiyun }
4013*4882a593Smuzhiyun 
4014*4882a593Smuzhiyun static void
do_detailed_mode(struct detailed_timing * timing,void * c)4015*4882a593Smuzhiyun do_detailed_mode(struct detailed_timing *timing, void *c)
4016*4882a593Smuzhiyun {
4017*4882a593Smuzhiyun 	struct detailed_mode_closure *closure = c;
4018*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
4019*4882a593Smuzhiyun 
4020*4882a593Smuzhiyun 	if (timing->pixel_clock) {
4021*4882a593Smuzhiyun 		newmode = drm_mode_detailed(
4022*4882a593Smuzhiyun 					    closure->edid, timing,
4023*4882a593Smuzhiyun 					    closure->quirks);
4024*4882a593Smuzhiyun 		if (!newmode)
4025*4882a593Smuzhiyun 			return;
4026*4882a593Smuzhiyun 
4027*4882a593Smuzhiyun 		if (closure->preferred)
4028*4882a593Smuzhiyun 			newmode->type |= DRM_MODE_TYPE_PREFERRED;
4029*4882a593Smuzhiyun 
4030*4882a593Smuzhiyun 		/*
4031*4882a593Smuzhiyun 		 * Detailed modes are limited to 10kHz pixel clock resolution,
4032*4882a593Smuzhiyun 		 * so fix up anything that looks like CEA/HDMI mode,
4033*4882a593Smuzhiyun 		 * but the clock is just slightly off.
4034*4882a593Smuzhiyun 		 */
4035*4882a593Smuzhiyun 		fixup_detailed_cea_mode_clock(newmode);
4036*4882a593Smuzhiyun 		drm_add_hdmi_modes(closure->data, newmode);
4037*4882a593Smuzhiyun 		drm_mode_destroy(newmode);
4038*4882a593Smuzhiyun 		closure->modes++;
4039*4882a593Smuzhiyun 		closure->preferred = 0;
4040*4882a593Smuzhiyun 	}
4041*4882a593Smuzhiyun }
4042*4882a593Smuzhiyun 
4043*4882a593Smuzhiyun /*
4044*4882a593Smuzhiyun  * add_detailed_modes - Add modes from detailed timings
4045*4882a593Smuzhiyun  * @data: attached data
4046*4882a593Smuzhiyun  * @edid: EDID block to scan
4047*4882a593Smuzhiyun  * @quirks: quirks to apply
4048*4882a593Smuzhiyun  */
4049*4882a593Smuzhiyun static int
add_detailed_modes(struct hdmi_edid_data * data,struct edid * edid,u32 quirks)4050*4882a593Smuzhiyun add_detailed_modes(struct hdmi_edid_data *data, struct edid *edid,
4051*4882a593Smuzhiyun 		   u32 quirks)
4052*4882a593Smuzhiyun {
4053*4882a593Smuzhiyun 	struct detailed_mode_closure closure = {
4054*4882a593Smuzhiyun 		.data = data,
4055*4882a593Smuzhiyun 		.edid = edid,
4056*4882a593Smuzhiyun 		.preferred = 1,
4057*4882a593Smuzhiyun 		.quirks = quirks,
4058*4882a593Smuzhiyun 	};
4059*4882a593Smuzhiyun 
4060*4882a593Smuzhiyun 	if (closure.preferred && !version_greater(edid, 1, 3))
4061*4882a593Smuzhiyun 		closure.preferred =
4062*4882a593Smuzhiyun 			(edid->features & DRM_EDID_FEATURE_PREFERRED_TIMING);
4063*4882a593Smuzhiyun 
4064*4882a593Smuzhiyun 	drm_for_each_detailed_block((u8 *)edid, do_detailed_mode, &closure);
4065*4882a593Smuzhiyun 
4066*4882a593Smuzhiyun 	return closure.modes;
4067*4882a593Smuzhiyun }
4068*4882a593Smuzhiyun 
drm_cvt_modes(struct hdmi_edid_data * data,struct detailed_timing * timing)4069*4882a593Smuzhiyun static int drm_cvt_modes(struct hdmi_edid_data *data,
4070*4882a593Smuzhiyun 			 struct detailed_timing *timing)
4071*4882a593Smuzhiyun {
4072*4882a593Smuzhiyun 	int i, j, modes = 0;
4073*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
4074*4882a593Smuzhiyun 	struct cvt_timing *cvt;
4075*4882a593Smuzhiyun 	const int rates[] = { 60, 85, 75, 60, 50 };
4076*4882a593Smuzhiyun 	const u8 empty[3] = { 0, 0, 0 };
4077*4882a593Smuzhiyun 
4078*4882a593Smuzhiyun 	for (i = 0; i < 4; i++) {
4079*4882a593Smuzhiyun 		int uninitialized_var(width), height;
4080*4882a593Smuzhiyun 
4081*4882a593Smuzhiyun 		cvt = &timing->data.other_data.data.cvt[i];
4082*4882a593Smuzhiyun 
4083*4882a593Smuzhiyun 		if (!memcmp(cvt->code, empty, 3))
4084*4882a593Smuzhiyun 			continue;
4085*4882a593Smuzhiyun 
4086*4882a593Smuzhiyun 		height = (cvt->code[0] + ((cvt->code[1] & 0xf0) << 4) + 1) * 2;
4087*4882a593Smuzhiyun 		switch (cvt->code[1] & 0x0c) {
4088*4882a593Smuzhiyun 		case 0x00:
4089*4882a593Smuzhiyun 			width = height * 4 / 3;
4090*4882a593Smuzhiyun 			break;
4091*4882a593Smuzhiyun 		case 0x04:
4092*4882a593Smuzhiyun 			width = height * 16 / 9;
4093*4882a593Smuzhiyun 			break;
4094*4882a593Smuzhiyun 		case 0x08:
4095*4882a593Smuzhiyun 			width = height * 16 / 10;
4096*4882a593Smuzhiyun 			break;
4097*4882a593Smuzhiyun 		case 0x0c:
4098*4882a593Smuzhiyun 			width = height * 15 / 9;
4099*4882a593Smuzhiyun 			break;
4100*4882a593Smuzhiyun 		}
4101*4882a593Smuzhiyun 
4102*4882a593Smuzhiyun 		for (j = 1; j < 5; j++) {
4103*4882a593Smuzhiyun 			if (cvt->code[2] & (1 << j)) {
4104*4882a593Smuzhiyun 				newmode = drm_cvt_mode(width, height,
4105*4882a593Smuzhiyun 						       rates[j], j == 0,
4106*4882a593Smuzhiyun 						       false, false);
4107*4882a593Smuzhiyun 				if (newmode) {
4108*4882a593Smuzhiyun 					drm_add_hdmi_modes(data, newmode);
4109*4882a593Smuzhiyun 					modes++;
4110*4882a593Smuzhiyun 					drm_mode_destroy(newmode);
4111*4882a593Smuzhiyun 				}
4112*4882a593Smuzhiyun 			}
4113*4882a593Smuzhiyun 		}
4114*4882a593Smuzhiyun 	}
4115*4882a593Smuzhiyun 
4116*4882a593Smuzhiyun 	return modes;
4117*4882a593Smuzhiyun }
4118*4882a593Smuzhiyun 
4119*4882a593Smuzhiyun static void
do_cvt_mode(struct detailed_timing * timing,void * c)4120*4882a593Smuzhiyun do_cvt_mode(struct detailed_timing *timing, void *c)
4121*4882a593Smuzhiyun {
4122*4882a593Smuzhiyun 	struct detailed_mode_closure *closure = c;
4123*4882a593Smuzhiyun 	struct detailed_non_pixel *data = &timing->data.other_data;
4124*4882a593Smuzhiyun 
4125*4882a593Smuzhiyun 	if (data->type == EDID_DETAIL_CVT_3BYTE)
4126*4882a593Smuzhiyun 		closure->modes += drm_cvt_modes(closure->data, timing);
4127*4882a593Smuzhiyun }
4128*4882a593Smuzhiyun 
4129*4882a593Smuzhiyun static int
add_cvt_modes(struct hdmi_edid_data * data,struct edid * edid)4130*4882a593Smuzhiyun add_cvt_modes(struct hdmi_edid_data *data, struct edid *edid)
4131*4882a593Smuzhiyun {
4132*4882a593Smuzhiyun 	struct detailed_mode_closure closure = {
4133*4882a593Smuzhiyun 		.data = data,
4134*4882a593Smuzhiyun 		.edid = edid,
4135*4882a593Smuzhiyun 	};
4136*4882a593Smuzhiyun 
4137*4882a593Smuzhiyun 	if (version_greater(edid, 1, 2))
4138*4882a593Smuzhiyun 		drm_for_each_detailed_block((u8 *)edid, do_cvt_mode, &closure);
4139*4882a593Smuzhiyun 
4140*4882a593Smuzhiyun 	/* XXX should also look for CVT codes in VTB blocks */
4141*4882a593Smuzhiyun 
4142*4882a593Smuzhiyun 	return closure.modes;
4143*4882a593Smuzhiyun }
4144*4882a593Smuzhiyun 
4145*4882a593Smuzhiyun static void
find_gtf2(struct detailed_timing * t,void * data)4146*4882a593Smuzhiyun find_gtf2(struct detailed_timing *t, void *data)
4147*4882a593Smuzhiyun {
4148*4882a593Smuzhiyun 	u8 *r = (u8 *)t;
4149*4882a593Smuzhiyun 
4150*4882a593Smuzhiyun 	if (r[3] == EDID_DETAIL_MONITOR_RANGE && r[10] == 0x02)
4151*4882a593Smuzhiyun 		*(u8 **)data = r;
4152*4882a593Smuzhiyun }
4153*4882a593Smuzhiyun 
4154*4882a593Smuzhiyun /* Secondary GTF curve kicks in above some break frequency */
4155*4882a593Smuzhiyun static int
drm_gtf2_hbreak(struct edid * edid)4156*4882a593Smuzhiyun drm_gtf2_hbreak(struct edid *edid)
4157*4882a593Smuzhiyun {
4158*4882a593Smuzhiyun 	u8 *r = NULL;
4159*4882a593Smuzhiyun 
4160*4882a593Smuzhiyun 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
4161*4882a593Smuzhiyun 	return r ? (r[12] * 2) : 0;
4162*4882a593Smuzhiyun }
4163*4882a593Smuzhiyun 
4164*4882a593Smuzhiyun static int
drm_gtf2_2c(struct edid * edid)4165*4882a593Smuzhiyun drm_gtf2_2c(struct edid *edid)
4166*4882a593Smuzhiyun {
4167*4882a593Smuzhiyun 	u8 *r = NULL;
4168*4882a593Smuzhiyun 
4169*4882a593Smuzhiyun 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
4170*4882a593Smuzhiyun 	return r ? r[13] : 0;
4171*4882a593Smuzhiyun }
4172*4882a593Smuzhiyun 
4173*4882a593Smuzhiyun static int
drm_gtf2_m(struct edid * edid)4174*4882a593Smuzhiyun drm_gtf2_m(struct edid *edid)
4175*4882a593Smuzhiyun {
4176*4882a593Smuzhiyun 	u8 *r = NULL;
4177*4882a593Smuzhiyun 
4178*4882a593Smuzhiyun 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
4179*4882a593Smuzhiyun 	return r ? (r[15] << 8) + r[14] : 0;
4180*4882a593Smuzhiyun }
4181*4882a593Smuzhiyun 
4182*4882a593Smuzhiyun static int
drm_gtf2_k(struct edid * edid)4183*4882a593Smuzhiyun drm_gtf2_k(struct edid *edid)
4184*4882a593Smuzhiyun {
4185*4882a593Smuzhiyun 	u8 *r = NULL;
4186*4882a593Smuzhiyun 
4187*4882a593Smuzhiyun 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
4188*4882a593Smuzhiyun 	return r ? r[16] : 0;
4189*4882a593Smuzhiyun }
4190*4882a593Smuzhiyun 
4191*4882a593Smuzhiyun static int
drm_gtf2_2j(struct edid * edid)4192*4882a593Smuzhiyun drm_gtf2_2j(struct edid *edid)
4193*4882a593Smuzhiyun {
4194*4882a593Smuzhiyun 	u8 *r = NULL;
4195*4882a593Smuzhiyun 
4196*4882a593Smuzhiyun 	drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
4197*4882a593Smuzhiyun 	return r ? r[17] : 0;
4198*4882a593Smuzhiyun }
4199*4882a593Smuzhiyun 
4200*4882a593Smuzhiyun /**
4201*4882a593Smuzhiyun  * standard_timing_level - get std. timing level(CVT/GTF/DMT)
4202*4882a593Smuzhiyun  * @edid: EDID block to scan
4203*4882a593Smuzhiyun  */
standard_timing_level(struct edid * edid)4204*4882a593Smuzhiyun static int standard_timing_level(struct edid *edid)
4205*4882a593Smuzhiyun {
4206*4882a593Smuzhiyun 	if (edid->revision >= 2) {
4207*4882a593Smuzhiyun 		if (edid->revision >= 4 &&
4208*4882a593Smuzhiyun 		    (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF))
4209*4882a593Smuzhiyun 			return LEVEL_CVT;
4210*4882a593Smuzhiyun 		if (drm_gtf2_hbreak(edid))
4211*4882a593Smuzhiyun 			return LEVEL_GTF2;
4212*4882a593Smuzhiyun 		return LEVEL_GTF;
4213*4882a593Smuzhiyun 	}
4214*4882a593Smuzhiyun 	return LEVEL_DMT;
4215*4882a593Smuzhiyun }
4216*4882a593Smuzhiyun 
4217*4882a593Smuzhiyun /*
4218*4882a593Smuzhiyun  * 0 is reserved.  The spec says 0x01 fill for unused timings.  Some old
4219*4882a593Smuzhiyun  * monitors fill with ascii space (0x20) instead.
4220*4882a593Smuzhiyun  */
4221*4882a593Smuzhiyun static int
bad_std_timing(u8 a,u8 b)4222*4882a593Smuzhiyun bad_std_timing(u8 a, u8 b)
4223*4882a593Smuzhiyun {
4224*4882a593Smuzhiyun 	return (a == 0x00 && b == 0x00) ||
4225*4882a593Smuzhiyun 	       (a == 0x01 && b == 0x01) ||
4226*4882a593Smuzhiyun 	       (a == 0x20 && b == 0x20);
4227*4882a593Smuzhiyun }
4228*4882a593Smuzhiyun 
4229*4882a593Smuzhiyun static void
is_rb(struct detailed_timing * t,void * data)4230*4882a593Smuzhiyun is_rb(struct detailed_timing *t, void *data)
4231*4882a593Smuzhiyun {
4232*4882a593Smuzhiyun 	u8 *r = (u8 *)t;
4233*4882a593Smuzhiyun 
4234*4882a593Smuzhiyun 	if (r[3] == EDID_DETAIL_MONITOR_RANGE)
4235*4882a593Smuzhiyun 		if (r[15] & 0x10)
4236*4882a593Smuzhiyun 			*(bool *)data = true;
4237*4882a593Smuzhiyun }
4238*4882a593Smuzhiyun 
4239*4882a593Smuzhiyun /* EDID 1.4 defines this explicitly.  For EDID 1.3, we guess, badly. */
4240*4882a593Smuzhiyun static bool
drm_monitor_supports_rb(struct edid * edid)4241*4882a593Smuzhiyun drm_monitor_supports_rb(struct edid *edid)
4242*4882a593Smuzhiyun {
4243*4882a593Smuzhiyun 	if (edid->revision >= 4) {
4244*4882a593Smuzhiyun 		bool ret = false;
4245*4882a593Smuzhiyun 
4246*4882a593Smuzhiyun 		drm_for_each_detailed_block((u8 *)edid, is_rb, &ret);
4247*4882a593Smuzhiyun 		return ret;
4248*4882a593Smuzhiyun 	}
4249*4882a593Smuzhiyun 
4250*4882a593Smuzhiyun 	return ((edid->input & DRM_EDID_INPUT_DIGITAL) != 0);
4251*4882a593Smuzhiyun }
4252*4882a593Smuzhiyun 
4253*4882a593Smuzhiyun static bool
mode_is_rb(const struct drm_display_mode * mode)4254*4882a593Smuzhiyun mode_is_rb(const struct drm_display_mode *mode)
4255*4882a593Smuzhiyun {
4256*4882a593Smuzhiyun 	return (mode->htotal - mode->hdisplay == 160) &&
4257*4882a593Smuzhiyun 	       (mode->hsync_end - mode->hdisplay == 80) &&
4258*4882a593Smuzhiyun 	       (mode->hsync_end - mode->hsync_start == 32) &&
4259*4882a593Smuzhiyun 	       (mode->vsync_start - mode->vdisplay == 3);
4260*4882a593Smuzhiyun }
4261*4882a593Smuzhiyun 
4262*4882a593Smuzhiyun /*
4263*4882a593Smuzhiyun  * drm_mode_find_dmt - Create a copy of a mode if present in DMT
4264*4882a593Smuzhiyun  * @hsize: Mode width
4265*4882a593Smuzhiyun  * @vsize: Mode height
4266*4882a593Smuzhiyun  * @fresh: Mode refresh rate
4267*4882a593Smuzhiyun  * @rb: Mode reduced-blanking-ness
4268*4882a593Smuzhiyun  *
4269*4882a593Smuzhiyun  * Walk the DMT mode list looking for a match for the given parameters.
4270*4882a593Smuzhiyun  *
4271*4882a593Smuzhiyun  * Return: A newly allocated copy of the mode, or NULL if not found.
4272*4882a593Smuzhiyun  */
drm_mode_find_dmt(int hsize,int vsize,int fresh,bool rb)4273*4882a593Smuzhiyun static struct drm_display_mode *drm_mode_find_dmt(
4274*4882a593Smuzhiyun 					   int hsize, int vsize, int fresh,
4275*4882a593Smuzhiyun 					   bool rb)
4276*4882a593Smuzhiyun {
4277*4882a593Smuzhiyun 	int i;
4278*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
4279*4882a593Smuzhiyun 
4280*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(drm_dmt_modes); i++) {
4281*4882a593Smuzhiyun 		const struct drm_display_mode *ptr = &drm_dmt_modes[i];
4282*4882a593Smuzhiyun 
4283*4882a593Smuzhiyun 		if (hsize != ptr->hdisplay)
4284*4882a593Smuzhiyun 			continue;
4285*4882a593Smuzhiyun 		if (vsize != ptr->vdisplay)
4286*4882a593Smuzhiyun 			continue;
4287*4882a593Smuzhiyun 		if (fresh != drm_get_vrefresh(ptr))
4288*4882a593Smuzhiyun 			continue;
4289*4882a593Smuzhiyun 		if (rb != mode_is_rb(ptr))
4290*4882a593Smuzhiyun 			continue;
4291*4882a593Smuzhiyun 
4292*4882a593Smuzhiyun 		newmode = drm_mode_create();
4293*4882a593Smuzhiyun 		*newmode = *ptr;
4294*4882a593Smuzhiyun 		return newmode;
4295*4882a593Smuzhiyun 	}
4296*4882a593Smuzhiyun 
4297*4882a593Smuzhiyun 	return NULL;
4298*4882a593Smuzhiyun }
4299*4882a593Smuzhiyun 
4300*4882a593Smuzhiyun static struct drm_display_mode *
drm_gtf_mode_complex(int hdisplay,int vdisplay,int vrefresh,bool interlaced,int margins,int GTF_M,int GTF_2C,int GTF_K,int GTF_2J)4301*4882a593Smuzhiyun drm_gtf_mode_complex(int hdisplay, int vdisplay,
4302*4882a593Smuzhiyun 		     int vrefresh, bool interlaced, int margins,
4303*4882a593Smuzhiyun 		     int GTF_M, int GTF_2C, int GTF_K, int GTF_2J)
4304*4882a593Smuzhiyun {	/* 1) top/bottom margin size (% of height) - default: 1.8, */
4305*4882a593Smuzhiyun #define	GTF_MARGIN_PERCENTAGE		18
4306*4882a593Smuzhiyun 	/* 2) character cell horizontal granularity (pixels) - default 8 */
4307*4882a593Smuzhiyun #define	GTF_CELL_GRAN			8
4308*4882a593Smuzhiyun 	/* 3) Minimum vertical porch (lines) - default 3 */
4309*4882a593Smuzhiyun #define	GTF_MIN_V_PORCH			1
4310*4882a593Smuzhiyun 	/* width of vsync in lines */
4311*4882a593Smuzhiyun #define V_SYNC_RQD			3
4312*4882a593Smuzhiyun 	/* width of hsync as % of total line */
4313*4882a593Smuzhiyun #define H_SYNC_PERCENT			8
4314*4882a593Smuzhiyun 	/* min time of vsync + back porch (microsec) */
4315*4882a593Smuzhiyun #define MIN_VSYNC_PLUS_BP		550
4316*4882a593Smuzhiyun 	/* C' and M' are part of the Blanking Duty Cycle computation */
4317*4882a593Smuzhiyun #define GTF_C_PRIME	((((GTF_2C - GTF_2J) * GTF_K / 256) + GTF_2J) / 2)
4318*4882a593Smuzhiyun #define GTF_M_PRIME	(GTF_K * GTF_M / 256)
4319*4882a593Smuzhiyun 	struct drm_display_mode *drm_mode;
4320*4882a593Smuzhiyun 	unsigned int hdisplay_rnd, vdisplay_rnd, vfieldrate_rqd;
4321*4882a593Smuzhiyun 	int top_margin, bottom_margin;
4322*4882a593Smuzhiyun 	int interlace;
4323*4882a593Smuzhiyun 	unsigned int hfreq_est;
4324*4882a593Smuzhiyun 	int vsync_plus_bp;
4325*4882a593Smuzhiyun 	unsigned int vtotal_lines;
4326*4882a593Smuzhiyun 	int left_margin, right_margin;
4327*4882a593Smuzhiyun 	unsigned int total_active_pixels, ideal_duty_cycle;
4328*4882a593Smuzhiyun 	unsigned int hblank, total_pixels, pixel_freq;
4329*4882a593Smuzhiyun 	int hsync, hfront_porch, vodd_front_porch_lines;
4330*4882a593Smuzhiyun 	unsigned int tmp1, tmp2;
4331*4882a593Smuzhiyun 
4332*4882a593Smuzhiyun 	drm_mode = drm_mode_create();
4333*4882a593Smuzhiyun 	if (!drm_mode)
4334*4882a593Smuzhiyun 		return NULL;
4335*4882a593Smuzhiyun 
4336*4882a593Smuzhiyun 	/* 1. In order to give correct results, the number of horizontal
4337*4882a593Smuzhiyun 	 * pixels requested is first processed to ensure that it is divisible
4338*4882a593Smuzhiyun 	 * by the character size, by rounding it to the nearest character
4339*4882a593Smuzhiyun 	 * cell boundary:
4340*4882a593Smuzhiyun 	 */
4341*4882a593Smuzhiyun 	hdisplay_rnd = (hdisplay + GTF_CELL_GRAN / 2) / GTF_CELL_GRAN;
4342*4882a593Smuzhiyun 	hdisplay_rnd = hdisplay_rnd * GTF_CELL_GRAN;
4343*4882a593Smuzhiyun 
4344*4882a593Smuzhiyun 	/* 2. If interlace is requested, the number of vertical lines assumed
4345*4882a593Smuzhiyun 	 * by the calculation must be halved, as the computation calculates
4346*4882a593Smuzhiyun 	 * the number of vertical lines per field.
4347*4882a593Smuzhiyun 	 */
4348*4882a593Smuzhiyun 	if (interlaced)
4349*4882a593Smuzhiyun 		vdisplay_rnd = vdisplay / 2;
4350*4882a593Smuzhiyun 	else
4351*4882a593Smuzhiyun 		vdisplay_rnd = vdisplay;
4352*4882a593Smuzhiyun 
4353*4882a593Smuzhiyun 	/* 3. Find the frame rate required: */
4354*4882a593Smuzhiyun 	if (interlaced)
4355*4882a593Smuzhiyun 		vfieldrate_rqd = vrefresh * 2;
4356*4882a593Smuzhiyun 	else
4357*4882a593Smuzhiyun 		vfieldrate_rqd = vrefresh;
4358*4882a593Smuzhiyun 
4359*4882a593Smuzhiyun 	/* 4. Find number of lines in Top margin: */
4360*4882a593Smuzhiyun 	top_margin = 0;
4361*4882a593Smuzhiyun 	if (margins)
4362*4882a593Smuzhiyun 		top_margin = (vdisplay_rnd * GTF_MARGIN_PERCENTAGE + 500) /
4363*4882a593Smuzhiyun 				1000;
4364*4882a593Smuzhiyun 	/* 5. Find number of lines in bottom margin: */
4365*4882a593Smuzhiyun 	bottom_margin = top_margin;
4366*4882a593Smuzhiyun 
4367*4882a593Smuzhiyun 	/* 6. If interlace is required, then set variable interlace: */
4368*4882a593Smuzhiyun 	if (interlaced)
4369*4882a593Smuzhiyun 		interlace = 1;
4370*4882a593Smuzhiyun 	else
4371*4882a593Smuzhiyun 		interlace = 0;
4372*4882a593Smuzhiyun 
4373*4882a593Smuzhiyun 	/* 7. Estimate the Horizontal frequency */
4374*4882a593Smuzhiyun 	{
4375*4882a593Smuzhiyun 		tmp1 = (1000000  - MIN_VSYNC_PLUS_BP * vfieldrate_rqd) / 500;
4376*4882a593Smuzhiyun 		tmp2 = (vdisplay_rnd + 2 * top_margin + GTF_MIN_V_PORCH) *
4377*4882a593Smuzhiyun 				2 + interlace;
4378*4882a593Smuzhiyun 		hfreq_est = (tmp2 * 1000 * vfieldrate_rqd) / tmp1;
4379*4882a593Smuzhiyun 	}
4380*4882a593Smuzhiyun 
4381*4882a593Smuzhiyun 	/* 8. Find the number of lines in V sync + back porch */
4382*4882a593Smuzhiyun 	/* [V SYNC+BP] = RINT(([MIN VSYNC+BP] * hfreq_est / 1000000)) */
4383*4882a593Smuzhiyun 	vsync_plus_bp = MIN_VSYNC_PLUS_BP * hfreq_est / 1000;
4384*4882a593Smuzhiyun 	vsync_plus_bp = (vsync_plus_bp + 500) / 1000;
4385*4882a593Smuzhiyun 	/*  9. Find the number of lines in V back porch alone:
4386*4882a593Smuzhiyun 	 *	vback_porch = vsync_plus_bp - V_SYNC_RQD;
4387*4882a593Smuzhiyun 	 */
4388*4882a593Smuzhiyun 	/*  10. Find the total number of lines in Vertical field period: */
4389*4882a593Smuzhiyun 	vtotal_lines = vdisplay_rnd + top_margin + bottom_margin +
4390*4882a593Smuzhiyun 			vsync_plus_bp + GTF_MIN_V_PORCH;
4391*4882a593Smuzhiyun 	/*  11. Estimate the Vertical field frequency:
4392*4882a593Smuzhiyun 	 *  vfieldrate_est = hfreq_est / vtotal_lines;
4393*4882a593Smuzhiyun 	 */
4394*4882a593Smuzhiyun 
4395*4882a593Smuzhiyun 	/*  12. Find the actual horizontal period:
4396*4882a593Smuzhiyun 	 *	hperiod = 1000000 / (vfieldrate_rqd * vtotal_lines);
4397*4882a593Smuzhiyun 	 */
4398*4882a593Smuzhiyun 	/*  13. Find the actual Vertical field frequency:
4399*4882a593Smuzhiyun 	 *	vfield_rate = hfreq_est / vtotal_lines;
4400*4882a593Smuzhiyun 	 */
4401*4882a593Smuzhiyun 	/*  14. Find the Vertical frame frequency:
4402*4882a593Smuzhiyun 	 *	if (interlaced)
4403*4882a593Smuzhiyun 	 *		vframe_rate = vfield_rate / 2;
4404*4882a593Smuzhiyun 	 *	else
4405*4882a593Smuzhiyun 	 *		vframe_rate = vfield_rate;
4406*4882a593Smuzhiyun 	 */
4407*4882a593Smuzhiyun 	/*  15. Find number of pixels in left margin: */
4408*4882a593Smuzhiyun 	if (margins)
4409*4882a593Smuzhiyun 		left_margin = (hdisplay_rnd * GTF_MARGIN_PERCENTAGE + 500) /
4410*4882a593Smuzhiyun 				1000;
4411*4882a593Smuzhiyun 	else
4412*4882a593Smuzhiyun 		left_margin = 0;
4413*4882a593Smuzhiyun 
4414*4882a593Smuzhiyun 	/* 16.Find number of pixels in right margin: */
4415*4882a593Smuzhiyun 	right_margin = left_margin;
4416*4882a593Smuzhiyun 	/* 17.Find total number of active pixels in image and left and right */
4417*4882a593Smuzhiyun 	total_active_pixels = hdisplay_rnd + left_margin + right_margin;
4418*4882a593Smuzhiyun 	/* 18.Find the ideal blanking duty cycle from blanking duty cycle */
4419*4882a593Smuzhiyun 	ideal_duty_cycle = GTF_C_PRIME * 1000 -
4420*4882a593Smuzhiyun 				(GTF_M_PRIME * 1000000 / hfreq_est);
4421*4882a593Smuzhiyun 	/* 19.Find the number of pixels in the blanking time to the nearest
4422*4882a593Smuzhiyun 	 * double character cell:
4423*4882a593Smuzhiyun 	 */
4424*4882a593Smuzhiyun 	hblank = total_active_pixels * ideal_duty_cycle /
4425*4882a593Smuzhiyun 			(100000 - ideal_duty_cycle);
4426*4882a593Smuzhiyun 	hblank = (hblank + GTF_CELL_GRAN) / (2 * GTF_CELL_GRAN);
4427*4882a593Smuzhiyun 	hblank = hblank * 2 * GTF_CELL_GRAN;
4428*4882a593Smuzhiyun 	/* 20.Find total number of pixels: */
4429*4882a593Smuzhiyun 	total_pixels = total_active_pixels + hblank;
4430*4882a593Smuzhiyun 	/* 21.Find pixel clock frequency: */
4431*4882a593Smuzhiyun 	pixel_freq = total_pixels * hfreq_est / 1000;
4432*4882a593Smuzhiyun 	/* Stage 1 computations are now complete; I should really pass
4433*4882a593Smuzhiyun 	 * the results to another function and do the Stage 2 computations,
4434*4882a593Smuzhiyun 	 * but I only need a few more values so I'll just append the
4435*4882a593Smuzhiyun 	 * computations here for now
4436*4882a593Smuzhiyun 	 */
4437*4882a593Smuzhiyun 
4438*4882a593Smuzhiyun 	/* 17. Find the number of pixels in the horizontal sync period: */
4439*4882a593Smuzhiyun 	hsync = H_SYNC_PERCENT * total_pixels / 100;
4440*4882a593Smuzhiyun 	hsync = (hsync + GTF_CELL_GRAN / 2) / GTF_CELL_GRAN;
4441*4882a593Smuzhiyun 	hsync = hsync * GTF_CELL_GRAN;
4442*4882a593Smuzhiyun 	/* 18. Find the number of pixels in horizontal front porch period */
4443*4882a593Smuzhiyun 	hfront_porch = hblank / 2 - hsync;
4444*4882a593Smuzhiyun 	/*  36. Find the number of lines in the odd front porch period: */
4445*4882a593Smuzhiyun 	vodd_front_porch_lines = GTF_MIN_V_PORCH;
4446*4882a593Smuzhiyun 
4447*4882a593Smuzhiyun 	/* finally, pack the results in the mode struct */
4448*4882a593Smuzhiyun 	drm_mode->hdisplay = hdisplay_rnd;
4449*4882a593Smuzhiyun 	drm_mode->hsync_start = hdisplay_rnd + hfront_porch;
4450*4882a593Smuzhiyun 	drm_mode->hsync_end = drm_mode->hsync_start + hsync;
4451*4882a593Smuzhiyun 	drm_mode->htotal = total_pixels;
4452*4882a593Smuzhiyun 	drm_mode->vdisplay = vdisplay_rnd;
4453*4882a593Smuzhiyun 	drm_mode->vsync_start = vdisplay_rnd + vodd_front_porch_lines;
4454*4882a593Smuzhiyun 	drm_mode->vsync_end = drm_mode->vsync_start + V_SYNC_RQD;
4455*4882a593Smuzhiyun 	drm_mode->vtotal = vtotal_lines;
4456*4882a593Smuzhiyun 
4457*4882a593Smuzhiyun 	drm_mode->clock = pixel_freq;
4458*4882a593Smuzhiyun 
4459*4882a593Smuzhiyun 	if (interlaced) {
4460*4882a593Smuzhiyun 		drm_mode->vtotal *= 2;
4461*4882a593Smuzhiyun 		drm_mode->flags |= DRM_MODE_FLAG_INTERLACE;
4462*4882a593Smuzhiyun 	}
4463*4882a593Smuzhiyun 
4464*4882a593Smuzhiyun 	if (GTF_M == 600 && GTF_2C == 80 && GTF_K == 128 && GTF_2J == 40)
4465*4882a593Smuzhiyun 		drm_mode->flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC;
4466*4882a593Smuzhiyun 	else
4467*4882a593Smuzhiyun 		drm_mode->flags = DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC;
4468*4882a593Smuzhiyun 
4469*4882a593Smuzhiyun 	return drm_mode;
4470*4882a593Smuzhiyun }
4471*4882a593Smuzhiyun 
4472*4882a593Smuzhiyun /**
4473*4882a593Smuzhiyun  * drm_gtf_mode - create the mode based on the GTF algorithm
4474*4882a593Smuzhiyun  * @hdisplay: hdisplay size
4475*4882a593Smuzhiyun  * @vdisplay: vdisplay size
4476*4882a593Smuzhiyun  * @vrefresh: vrefresh rate.
4477*4882a593Smuzhiyun  * @interlaced: whether to compute an interlaced mode
4478*4882a593Smuzhiyun  * @margins: desired margin (borders) size
4479*4882a593Smuzhiyun  *
4480*4882a593Smuzhiyun  * return the mode based on GTF algorithm
4481*4882a593Smuzhiyun  *
4482*4882a593Smuzhiyun  * This function is to create the mode based on the GTF algorithm.
4483*4882a593Smuzhiyun  * Generalized Timing Formula is derived from:
4484*4882a593Smuzhiyun  *	GTF Spreadsheet by Andy Morrish (1/5/97)
4485*4882a593Smuzhiyun  *	available at http://www.vesa.org
4486*4882a593Smuzhiyun  *
4487*4882a593Smuzhiyun  * And it is copied from the file of xserver/hw/xfree86/modes/xf86gtf.c.
4488*4882a593Smuzhiyun  * What I have done is to translate it by using integer calculation.
4489*4882a593Smuzhiyun  * I also refer to the function of fb_get_mode in the file of
4490*4882a593Smuzhiyun  * drivers/video/fbmon.c
4491*4882a593Smuzhiyun  *
4492*4882a593Smuzhiyun  * Standard GTF parameters:
4493*4882a593Smuzhiyun  * M = 600
4494*4882a593Smuzhiyun  * C = 40
4495*4882a593Smuzhiyun  * K = 128
4496*4882a593Smuzhiyun  * J = 20
4497*4882a593Smuzhiyun  *
4498*4882a593Smuzhiyun  * Returns:
4499*4882a593Smuzhiyun  * The modeline based on the GTF algorithm stored in a drm_display_mode object.
4500*4882a593Smuzhiyun  * The display mode object is allocated with drm_mode_create(). Returns NULL
4501*4882a593Smuzhiyun  * when no mode could be allocated.
4502*4882a593Smuzhiyun  */
4503*4882a593Smuzhiyun static struct drm_display_mode *
drm_gtf_mode(int hdisplay,int vdisplay,int vrefresh,bool interlaced,int margins)4504*4882a593Smuzhiyun drm_gtf_mode(int hdisplay, int vdisplay, int vrefresh,
4505*4882a593Smuzhiyun 	     bool interlaced, int margins)
4506*4882a593Smuzhiyun {
4507*4882a593Smuzhiyun 	return drm_gtf_mode_complex(hdisplay, vdisplay, vrefresh,
4508*4882a593Smuzhiyun 				    interlaced, margins,
4509*4882a593Smuzhiyun 				    600, 40 * 2, 128, 20 * 2);
4510*4882a593Smuzhiyun }
4511*4882a593Smuzhiyun 
4512*4882a593Smuzhiyun /** drm_mode_hsync - get the hsync of a mode
4513*4882a593Smuzhiyun  * @mode: mode
4514*4882a593Smuzhiyun  *
4515*4882a593Smuzhiyun  * Returns:
4516*4882a593Smuzhiyun  * @modes's hsync rate in kHz, rounded to the nearest integer. Calculates the
4517*4882a593Smuzhiyun  * value first if it is not yet set.
4518*4882a593Smuzhiyun  */
drm_mode_hsync(const struct drm_display_mode * mode)4519*4882a593Smuzhiyun static int drm_mode_hsync(const struct drm_display_mode *mode)
4520*4882a593Smuzhiyun {
4521*4882a593Smuzhiyun 	unsigned int calc_val;
4522*4882a593Smuzhiyun 
4523*4882a593Smuzhiyun 	if (mode->htotal < 0)
4524*4882a593Smuzhiyun 		return 0;
4525*4882a593Smuzhiyun 
4526*4882a593Smuzhiyun 	calc_val = (mode->clock * 1000) / mode->htotal; /* hsync in Hz */
4527*4882a593Smuzhiyun 	calc_val += 500;				/* round to 1000Hz */
4528*4882a593Smuzhiyun 	calc_val /= 1000;				/* truncate to kHz */
4529*4882a593Smuzhiyun 
4530*4882a593Smuzhiyun 	return calc_val;
4531*4882a593Smuzhiyun }
4532*4882a593Smuzhiyun 
4533*4882a593Smuzhiyun /**
4534*4882a593Smuzhiyun  * drm_mode_std - convert standard mode info (width, height, refresh) into mode
4535*4882a593Smuzhiyun  * @data: the structure that save parsed hdmi edid data
4536*4882a593Smuzhiyun  * @edid: EDID block to scan
4537*4882a593Smuzhiyun  * @t: standard timing params
4538*4882a593Smuzhiyun  *
4539*4882a593Smuzhiyun  * Take the standard timing params (in this case width, aspect, and refresh)
4540*4882a593Smuzhiyun  * and convert them into a real mode using CVT/GTF/DMT.
4541*4882a593Smuzhiyun  */
4542*4882a593Smuzhiyun static struct drm_display_mode *
drm_mode_std(struct hdmi_edid_data * data,struct edid * edid,struct std_timing * t)4543*4882a593Smuzhiyun drm_mode_std(struct hdmi_edid_data *data, struct edid *edid,
4544*4882a593Smuzhiyun 	     struct std_timing *t)
4545*4882a593Smuzhiyun {
4546*4882a593Smuzhiyun 	struct drm_display_mode *mode = NULL;
4547*4882a593Smuzhiyun 	int i, hsize, vsize;
4548*4882a593Smuzhiyun 	int vrefresh_rate;
4549*4882a593Smuzhiyun 	int num = data->modes;
4550*4882a593Smuzhiyun 	unsigned aspect_ratio = (t->vfreq_aspect & EDID_TIMING_ASPECT_MASK)
4551*4882a593Smuzhiyun 		>> EDID_TIMING_ASPECT_SHIFT;
4552*4882a593Smuzhiyun 	unsigned vfreq = (t->vfreq_aspect & EDID_TIMING_VFREQ_MASK)
4553*4882a593Smuzhiyun 		>> EDID_TIMING_VFREQ_SHIFT;
4554*4882a593Smuzhiyun 	int timing_level = standard_timing_level(edid);
4555*4882a593Smuzhiyun 
4556*4882a593Smuzhiyun 	if (bad_std_timing(t->hsize, t->vfreq_aspect))
4557*4882a593Smuzhiyun 		return NULL;
4558*4882a593Smuzhiyun 
4559*4882a593Smuzhiyun 	/* According to the EDID spec, the hdisplay = hsize * 8 + 248 */
4560*4882a593Smuzhiyun 	hsize = t->hsize * 8 + 248;
4561*4882a593Smuzhiyun 	/* vrefresh_rate = vfreq + 60 */
4562*4882a593Smuzhiyun 	vrefresh_rate = vfreq + 60;
4563*4882a593Smuzhiyun 	/* the vdisplay is calculated based on the aspect ratio */
4564*4882a593Smuzhiyun 	if (aspect_ratio == 0) {
4565*4882a593Smuzhiyun 		if (edid->revision < 3)
4566*4882a593Smuzhiyun 			vsize = hsize;
4567*4882a593Smuzhiyun 		else
4568*4882a593Smuzhiyun 			vsize = (hsize * 10) / 16;
4569*4882a593Smuzhiyun 	} else if (aspect_ratio == 1) {
4570*4882a593Smuzhiyun 		vsize = (hsize * 3) / 4;
4571*4882a593Smuzhiyun 	} else if (aspect_ratio == 2) {
4572*4882a593Smuzhiyun 		vsize = (hsize * 4) / 5;
4573*4882a593Smuzhiyun 	} else {
4574*4882a593Smuzhiyun 		vsize = (hsize * 9) / 16;
4575*4882a593Smuzhiyun 	}
4576*4882a593Smuzhiyun 
4577*4882a593Smuzhiyun 	/* HDTV hack, part 1 */
4578*4882a593Smuzhiyun 	if (vrefresh_rate == 60 &&
4579*4882a593Smuzhiyun 	    ((hsize == 1360 && vsize == 765) ||
4580*4882a593Smuzhiyun 	     (hsize == 1368 && vsize == 769))) {
4581*4882a593Smuzhiyun 		hsize = 1366;
4582*4882a593Smuzhiyun 		vsize = 768;
4583*4882a593Smuzhiyun 	}
4584*4882a593Smuzhiyun 
4585*4882a593Smuzhiyun 	/*
4586*4882a593Smuzhiyun 	 * If we already has a mode for this size and refresh
4587*4882a593Smuzhiyun 	 * rate (because it came from detailed or CVT info), use that
4588*4882a593Smuzhiyun 	 * instead.  This way we don't have to guess at interlace or
4589*4882a593Smuzhiyun 	 * reduced blanking.
4590*4882a593Smuzhiyun 	 */
4591*4882a593Smuzhiyun 	for (i = 0; i < num; i++)
4592*4882a593Smuzhiyun 		if (data->mode_buf[i].hdisplay == hsize &&
4593*4882a593Smuzhiyun 		    data->mode_buf[i].vdisplay == vsize &&
4594*4882a593Smuzhiyun 		    drm_get_vrefresh(&data->mode_buf[i]) == vrefresh_rate)
4595*4882a593Smuzhiyun 			return NULL;
4596*4882a593Smuzhiyun 
4597*4882a593Smuzhiyun 	/* HDTV hack, part 2 */
4598*4882a593Smuzhiyun 	if (hsize == 1366 && vsize == 768 && vrefresh_rate == 60) {
4599*4882a593Smuzhiyun 		mode = drm_cvt_mode(1366, 768, vrefresh_rate, 0, 0,
4600*4882a593Smuzhiyun 				    false);
4601*4882a593Smuzhiyun 		mode->hdisplay = 1366;
4602*4882a593Smuzhiyun 		mode->hsync_start = mode->hsync_start - 1;
4603*4882a593Smuzhiyun 		mode->hsync_end = mode->hsync_end - 1;
4604*4882a593Smuzhiyun 		return mode;
4605*4882a593Smuzhiyun 	}
4606*4882a593Smuzhiyun 
4607*4882a593Smuzhiyun 	/* check whether it can be found in default mode table */
4608*4882a593Smuzhiyun 	if (drm_monitor_supports_rb(edid)) {
4609*4882a593Smuzhiyun 		mode = drm_mode_find_dmt(hsize, vsize, vrefresh_rate,
4610*4882a593Smuzhiyun 					 true);
4611*4882a593Smuzhiyun 		if (mode)
4612*4882a593Smuzhiyun 			return mode;
4613*4882a593Smuzhiyun 	}
4614*4882a593Smuzhiyun 
4615*4882a593Smuzhiyun 	mode = drm_mode_find_dmt(hsize, vsize, vrefresh_rate, false);
4616*4882a593Smuzhiyun 	if (mode)
4617*4882a593Smuzhiyun 		return mode;
4618*4882a593Smuzhiyun 
4619*4882a593Smuzhiyun 	/* okay, generate it */
4620*4882a593Smuzhiyun 	switch (timing_level) {
4621*4882a593Smuzhiyun 	case LEVEL_DMT:
4622*4882a593Smuzhiyun 		break;
4623*4882a593Smuzhiyun 	case LEVEL_GTF:
4624*4882a593Smuzhiyun 		mode = drm_gtf_mode(hsize, vsize, vrefresh_rate, 0, 0);
4625*4882a593Smuzhiyun 		break;
4626*4882a593Smuzhiyun 	case LEVEL_GTF2:
4627*4882a593Smuzhiyun 		/*
4628*4882a593Smuzhiyun 		 * This is potentially wrong if there's ever a monitor with
4629*4882a593Smuzhiyun 		 * more than one ranges section, each claiming a different
4630*4882a593Smuzhiyun 		 * secondary GTF curve.  Please don't do that.
4631*4882a593Smuzhiyun 		 */
4632*4882a593Smuzhiyun 		mode = drm_gtf_mode(hsize, vsize, vrefresh_rate, 0, 0);
4633*4882a593Smuzhiyun 		if (!mode)
4634*4882a593Smuzhiyun 			return NULL;
4635*4882a593Smuzhiyun 		if (drm_mode_hsync(mode) > drm_gtf2_hbreak(edid)) {
4636*4882a593Smuzhiyun 			drm_mode_destroy(mode);
4637*4882a593Smuzhiyun 			mode = drm_gtf_mode_complex(hsize, vsize,
4638*4882a593Smuzhiyun 						    vrefresh_rate, 0, 0,
4639*4882a593Smuzhiyun 						    drm_gtf2_m(edid),
4640*4882a593Smuzhiyun 						    drm_gtf2_2c(edid),
4641*4882a593Smuzhiyun 						    drm_gtf2_k(edid),
4642*4882a593Smuzhiyun 						    drm_gtf2_2j(edid));
4643*4882a593Smuzhiyun 		}
4644*4882a593Smuzhiyun 		break;
4645*4882a593Smuzhiyun 	case LEVEL_CVT:
4646*4882a593Smuzhiyun 		mode = drm_cvt_mode(hsize, vsize, vrefresh_rate, 0, 0,
4647*4882a593Smuzhiyun 				    false);
4648*4882a593Smuzhiyun 		break;
4649*4882a593Smuzhiyun 	}
4650*4882a593Smuzhiyun 
4651*4882a593Smuzhiyun 	return mode;
4652*4882a593Smuzhiyun }
4653*4882a593Smuzhiyun 
4654*4882a593Smuzhiyun static void
do_standard_modes(struct detailed_timing * timing,void * c)4655*4882a593Smuzhiyun do_standard_modes(struct detailed_timing *timing, void *c)
4656*4882a593Smuzhiyun {
4657*4882a593Smuzhiyun 	struct detailed_mode_closure *closure = c;
4658*4882a593Smuzhiyun 	struct detailed_non_pixel *data = &timing->data.other_data;
4659*4882a593Smuzhiyun 	struct edid *edid = closure->edid;
4660*4882a593Smuzhiyun 
4661*4882a593Smuzhiyun 	if (data->type == EDID_DETAIL_STD_MODES) {
4662*4882a593Smuzhiyun 		int i;
4663*4882a593Smuzhiyun 
4664*4882a593Smuzhiyun 		for (i = 0; i < 6; i++) {
4665*4882a593Smuzhiyun 			struct std_timing *std;
4666*4882a593Smuzhiyun 			struct drm_display_mode *newmode;
4667*4882a593Smuzhiyun 
4668*4882a593Smuzhiyun 			std = &data->data.timings[i];
4669*4882a593Smuzhiyun 			newmode = drm_mode_std(closure->data, edid, std);
4670*4882a593Smuzhiyun 			if (newmode) {
4671*4882a593Smuzhiyun 				drm_add_hdmi_modes(closure->data, newmode);
4672*4882a593Smuzhiyun 				closure->modes++;
4673*4882a593Smuzhiyun 				drm_mode_destroy(newmode);
4674*4882a593Smuzhiyun 			}
4675*4882a593Smuzhiyun 		}
4676*4882a593Smuzhiyun 	}
4677*4882a593Smuzhiyun }
4678*4882a593Smuzhiyun 
4679*4882a593Smuzhiyun /**
4680*4882a593Smuzhiyun  * add_standard_modes - get std. modes from EDID and add them
4681*4882a593Smuzhiyun  * @data: data to add mode(s) to
4682*4882a593Smuzhiyun  * @edid: EDID block to scan
4683*4882a593Smuzhiyun  *
4684*4882a593Smuzhiyun  * Standard modes can be calculated using the appropriate standard (DMT,
4685*4882a593Smuzhiyun  * GTF or CVT. Grab them from @edid and add them to the list.
4686*4882a593Smuzhiyun  */
4687*4882a593Smuzhiyun static int
add_standard_modes(struct hdmi_edid_data * data,struct edid * edid)4688*4882a593Smuzhiyun add_standard_modes(struct hdmi_edid_data *data, struct edid *edid)
4689*4882a593Smuzhiyun {
4690*4882a593Smuzhiyun 	int i, modes = 0;
4691*4882a593Smuzhiyun 	struct detailed_mode_closure closure = {
4692*4882a593Smuzhiyun 		.data = data,
4693*4882a593Smuzhiyun 		.edid = edid,
4694*4882a593Smuzhiyun 	};
4695*4882a593Smuzhiyun 
4696*4882a593Smuzhiyun 	for (i = 0; i < EDID_STD_TIMINGS; i++) {
4697*4882a593Smuzhiyun 		struct drm_display_mode *newmode;
4698*4882a593Smuzhiyun 
4699*4882a593Smuzhiyun 		newmode = drm_mode_std(data, edid,
4700*4882a593Smuzhiyun 				       &edid->standard_timings[i]);
4701*4882a593Smuzhiyun 		if (newmode) {
4702*4882a593Smuzhiyun 			drm_add_hdmi_modes(data, newmode);
4703*4882a593Smuzhiyun 			modes++;
4704*4882a593Smuzhiyun 			drm_mode_destroy(newmode);
4705*4882a593Smuzhiyun 		}
4706*4882a593Smuzhiyun 	}
4707*4882a593Smuzhiyun 
4708*4882a593Smuzhiyun 	if (version_greater(edid, 1, 0))
4709*4882a593Smuzhiyun 		drm_for_each_detailed_block((u8 *)edid, do_standard_modes,
4710*4882a593Smuzhiyun 					    &closure);
4711*4882a593Smuzhiyun 
4712*4882a593Smuzhiyun 	/* XXX should also look for standard codes in VTB blocks */
4713*4882a593Smuzhiyun 
4714*4882a593Smuzhiyun 	return modes + closure.modes;
4715*4882a593Smuzhiyun }
4716*4882a593Smuzhiyun 
4717*4882a593Smuzhiyun static int
drm_est3_modes(struct hdmi_edid_data * data,struct detailed_timing * timing)4718*4882a593Smuzhiyun drm_est3_modes(struct hdmi_edid_data *data, struct detailed_timing *timing)
4719*4882a593Smuzhiyun {
4720*4882a593Smuzhiyun 	int i, j, m, modes = 0;
4721*4882a593Smuzhiyun 	struct drm_display_mode *mode;
4722*4882a593Smuzhiyun 	u8 *est = ((u8 *)timing) + 6;
4723*4882a593Smuzhiyun 
4724*4882a593Smuzhiyun 	for (i = 0; i < 6; i++) {
4725*4882a593Smuzhiyun 		for (j = 7; j >= 0; j--) {
4726*4882a593Smuzhiyun 			m = (i * 8) + (7 - j);
4727*4882a593Smuzhiyun 			if (m >= ARRAY_SIZE(est3_modes))
4728*4882a593Smuzhiyun 				break;
4729*4882a593Smuzhiyun 			if (est[i] & (1 << j)) {
4730*4882a593Smuzhiyun 				mode = drm_mode_find_dmt(
4731*4882a593Smuzhiyun 							 est3_modes[m].w,
4732*4882a593Smuzhiyun 							 est3_modes[m].h,
4733*4882a593Smuzhiyun 							 est3_modes[m].r,
4734*4882a593Smuzhiyun 							 est3_modes[m].rb);
4735*4882a593Smuzhiyun 				if (mode) {
4736*4882a593Smuzhiyun 					drm_add_hdmi_modes(data, mode);
4737*4882a593Smuzhiyun 					modes++;
4738*4882a593Smuzhiyun 					drm_mode_destroy(mode);
4739*4882a593Smuzhiyun 				}
4740*4882a593Smuzhiyun 			}
4741*4882a593Smuzhiyun 		}
4742*4882a593Smuzhiyun 	}
4743*4882a593Smuzhiyun 
4744*4882a593Smuzhiyun 	return modes;
4745*4882a593Smuzhiyun }
4746*4882a593Smuzhiyun 
4747*4882a593Smuzhiyun static void
do_established_modes(struct detailed_timing * timing,void * c)4748*4882a593Smuzhiyun do_established_modes(struct detailed_timing *timing, void *c)
4749*4882a593Smuzhiyun {
4750*4882a593Smuzhiyun 	struct detailed_mode_closure *closure = c;
4751*4882a593Smuzhiyun 	struct detailed_non_pixel *data = &timing->data.other_data;
4752*4882a593Smuzhiyun 
4753*4882a593Smuzhiyun 	if (data->type == EDID_DETAIL_EST_TIMINGS)
4754*4882a593Smuzhiyun 		closure->modes += drm_est3_modes(closure->data, timing);
4755*4882a593Smuzhiyun }
4756*4882a593Smuzhiyun 
4757*4882a593Smuzhiyun /**
4758*4882a593Smuzhiyun  * add_established_modes - get est. modes from EDID and add them
4759*4882a593Smuzhiyun  * @data: data to add mode(s) to
4760*4882a593Smuzhiyun  * @edid: EDID block to scan
4761*4882a593Smuzhiyun  *
4762*4882a593Smuzhiyun  * Each EDID block contains a bitmap of the supported "established modes" list
4763*4882a593Smuzhiyun  * (defined above).  Tease them out and add them to the modes list.
4764*4882a593Smuzhiyun  */
4765*4882a593Smuzhiyun static int
add_established_modes(struct hdmi_edid_data * data,struct edid * edid)4766*4882a593Smuzhiyun add_established_modes(struct hdmi_edid_data *data, struct edid *edid)
4767*4882a593Smuzhiyun {
4768*4882a593Smuzhiyun 	unsigned long est_bits = edid->established_timings.t1 |
4769*4882a593Smuzhiyun 		(edid->established_timings.t2 << 8) |
4770*4882a593Smuzhiyun 		((edid->established_timings.mfg_rsvd & 0x80) << 9);
4771*4882a593Smuzhiyun 	int i, modes = 0;
4772*4882a593Smuzhiyun 	struct detailed_mode_closure closure = {
4773*4882a593Smuzhiyun 		.data = data,
4774*4882a593Smuzhiyun 		.edid = edid,
4775*4882a593Smuzhiyun 	};
4776*4882a593Smuzhiyun 
4777*4882a593Smuzhiyun 	for (i = 0; i <= EDID_EST_TIMINGS; i++) {
4778*4882a593Smuzhiyun 		if (est_bits & (1 << i)) {
4779*4882a593Smuzhiyun 			struct drm_display_mode *newmode = drm_mode_create();
4780*4882a593Smuzhiyun 			*newmode = edid_est_modes[i];
4781*4882a593Smuzhiyun 			if (newmode) {
4782*4882a593Smuzhiyun 				drm_add_hdmi_modes(data, newmode);
4783*4882a593Smuzhiyun 				modes++;
4784*4882a593Smuzhiyun 				drm_mode_destroy(newmode);
4785*4882a593Smuzhiyun 			}
4786*4882a593Smuzhiyun 		}
4787*4882a593Smuzhiyun 	}
4788*4882a593Smuzhiyun 
4789*4882a593Smuzhiyun 	if (version_greater(edid, 1, 0))
4790*4882a593Smuzhiyun 		drm_for_each_detailed_block((u8 *)edid,
4791*4882a593Smuzhiyun 					    do_established_modes, &closure);
4792*4882a593Smuzhiyun 
4793*4882a593Smuzhiyun 	return modes + closure.modes;
4794*4882a593Smuzhiyun }
4795*4882a593Smuzhiyun 
drm_match_hdmi_mode(const struct drm_display_mode * to_match)4796*4882a593Smuzhiyun static u8 drm_match_hdmi_mode(const struct drm_display_mode *to_match)
4797*4882a593Smuzhiyun {
4798*4882a593Smuzhiyun 	u8 vic;
4799*4882a593Smuzhiyun 
4800*4882a593Smuzhiyun 	if (!to_match->clock)
4801*4882a593Smuzhiyun 		return 0;
4802*4882a593Smuzhiyun 
4803*4882a593Smuzhiyun 	for (vic = 1; vic < ARRAY_SIZE(edid_4k_modes); vic++) {
4804*4882a593Smuzhiyun 		const struct drm_display_mode *hdmi_mode = &edid_4k_modes[vic];
4805*4882a593Smuzhiyun 		unsigned int clock1, clock2;
4806*4882a593Smuzhiyun 
4807*4882a593Smuzhiyun 		/* Make sure to also match alternate clocks */
4808*4882a593Smuzhiyun 		clock1 = hdmi_mode->clock;
4809*4882a593Smuzhiyun 		clock2 = hdmi_mode_alternate_clock(hdmi_mode);
4810*4882a593Smuzhiyun 
4811*4882a593Smuzhiyun 		if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
4812*4882a593Smuzhiyun 		     KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
4813*4882a593Smuzhiyun 		    drm_mode_equal_no_clocks_no_stereo(to_match, hdmi_mode))
4814*4882a593Smuzhiyun 			return vic;
4815*4882a593Smuzhiyun 	}
4816*4882a593Smuzhiyun 	return 0;
4817*4882a593Smuzhiyun }
4818*4882a593Smuzhiyun 
4819*4882a593Smuzhiyun static int
add_alternate_cea_modes(struct hdmi_edid_data * data,struct edid * edid)4820*4882a593Smuzhiyun add_alternate_cea_modes(struct hdmi_edid_data *data, struct edid *edid)
4821*4882a593Smuzhiyun {
4822*4882a593Smuzhiyun 	struct drm_display_mode *mode;
4823*4882a593Smuzhiyun 	int i, num, modes = 0;
4824*4882a593Smuzhiyun 
4825*4882a593Smuzhiyun 	/* Don't add CEA modes if the CEA extension block is missing */
4826*4882a593Smuzhiyun 	if (!drm_find_cea_extension(edid))
4827*4882a593Smuzhiyun 		return 0;
4828*4882a593Smuzhiyun 
4829*4882a593Smuzhiyun 	/*
4830*4882a593Smuzhiyun 	 * Go through all probed modes and create a new mode
4831*4882a593Smuzhiyun 	 * with the alternate clock for certain CEA modes.
4832*4882a593Smuzhiyun 	 */
4833*4882a593Smuzhiyun 	num = data->modes;
4834*4882a593Smuzhiyun 
4835*4882a593Smuzhiyun 	for (i = 0; i < num; i++) {
4836*4882a593Smuzhiyun 		const struct drm_display_mode *cea_mode = NULL;
4837*4882a593Smuzhiyun 		struct drm_display_mode *newmode;
4838*4882a593Smuzhiyun 		u8 vic;
4839*4882a593Smuzhiyun 		unsigned int clock1, clock2;
4840*4882a593Smuzhiyun 
4841*4882a593Smuzhiyun 		mode = &data->mode_buf[i];
4842*4882a593Smuzhiyun 		vic = drm_match_cea_mode(mode);
4843*4882a593Smuzhiyun 
4844*4882a593Smuzhiyun 		if (drm_valid_cea_vic(vic)) {
4845*4882a593Smuzhiyun 			cea_mode = cea_mode_for_vic(vic);
4846*4882a593Smuzhiyun 			clock2 = cea_mode_alternate_clock(cea_mode);
4847*4882a593Smuzhiyun 		} else {
4848*4882a593Smuzhiyun 			vic = drm_match_hdmi_mode(mode);
4849*4882a593Smuzhiyun 			if (drm_valid_hdmi_vic(vic)) {
4850*4882a593Smuzhiyun 				cea_mode = &edid_4k_modes[vic];
4851*4882a593Smuzhiyun 				clock2 = hdmi_mode_alternate_clock(cea_mode);
4852*4882a593Smuzhiyun 			}
4853*4882a593Smuzhiyun 		}
4854*4882a593Smuzhiyun 
4855*4882a593Smuzhiyun 		if (!cea_mode)
4856*4882a593Smuzhiyun 			continue;
4857*4882a593Smuzhiyun 
4858*4882a593Smuzhiyun 		clock1 = cea_mode->clock;
4859*4882a593Smuzhiyun 
4860*4882a593Smuzhiyun 		if (clock1 == clock2)
4861*4882a593Smuzhiyun 			continue;
4862*4882a593Smuzhiyun 
4863*4882a593Smuzhiyun 		if (mode->clock != clock1 && mode->clock != clock2)
4864*4882a593Smuzhiyun 			continue;
4865*4882a593Smuzhiyun 
4866*4882a593Smuzhiyun 		newmode = drm_mode_create();
4867*4882a593Smuzhiyun 		*newmode = *cea_mode;
4868*4882a593Smuzhiyun 		if (!newmode)
4869*4882a593Smuzhiyun 			continue;
4870*4882a593Smuzhiyun 
4871*4882a593Smuzhiyun 		/* Carry over the stereo flags */
4872*4882a593Smuzhiyun 		newmode->flags |= mode->flags & DRM_MODE_FLAG_3D_MASK;
4873*4882a593Smuzhiyun 
4874*4882a593Smuzhiyun 		/*
4875*4882a593Smuzhiyun 		 * The current mode could be either variant. Make
4876*4882a593Smuzhiyun 		 * sure to pick the "other" clock for the new mode.
4877*4882a593Smuzhiyun 		 */
4878*4882a593Smuzhiyun 		if (mode->clock != clock1)
4879*4882a593Smuzhiyun 			newmode->clock = clock1;
4880*4882a593Smuzhiyun 		else
4881*4882a593Smuzhiyun 			newmode->clock = clock2;
4882*4882a593Smuzhiyun 
4883*4882a593Smuzhiyun 		drm_add_hdmi_modes(data, newmode);
4884*4882a593Smuzhiyun 		modes++;
4885*4882a593Smuzhiyun 		drm_mode_destroy(newmode);
4886*4882a593Smuzhiyun 	}
4887*4882a593Smuzhiyun 
4888*4882a593Smuzhiyun 	return modes;
4889*4882a593Smuzhiyun }
4890*4882a593Smuzhiyun 
drm_find_displayid_extension(struct edid * edid)4891*4882a593Smuzhiyun static u8 *drm_find_displayid_extension(struct edid *edid)
4892*4882a593Smuzhiyun {
4893*4882a593Smuzhiyun 	return drm_find_edid_extension(edid, DISPLAYID_EXT);
4894*4882a593Smuzhiyun }
4895*4882a593Smuzhiyun 
validate_displayid(u8 * displayid,int length,int idx)4896*4882a593Smuzhiyun static int validate_displayid(u8 *displayid, int length, int idx)
4897*4882a593Smuzhiyun {
4898*4882a593Smuzhiyun 	int i;
4899*4882a593Smuzhiyun 	u8 csum = 0;
4900*4882a593Smuzhiyun 	struct displayid_hdr *base;
4901*4882a593Smuzhiyun 
4902*4882a593Smuzhiyun 	base = (struct displayid_hdr *)&displayid[idx];
4903*4882a593Smuzhiyun 
4904*4882a593Smuzhiyun 	debug("base revision 0x%x, length %d, %d %d\n",
4905*4882a593Smuzhiyun 	      base->rev, base->bytes, base->prod_id, base->ext_count);
4906*4882a593Smuzhiyun 
4907*4882a593Smuzhiyun 	if (base->bytes + 5 > length - idx)
4908*4882a593Smuzhiyun 		return -EINVAL;
4909*4882a593Smuzhiyun 	for (i = idx; i <= base->bytes + 5; i++)
4910*4882a593Smuzhiyun 		csum += displayid[i];
4911*4882a593Smuzhiyun 	if (csum) {
4912*4882a593Smuzhiyun 		debug("DisplayID checksum invalid, remainder is %d\n", csum);
4913*4882a593Smuzhiyun 		return -EINVAL;
4914*4882a593Smuzhiyun 	}
4915*4882a593Smuzhiyun 	return 0;
4916*4882a593Smuzhiyun }
4917*4882a593Smuzhiyun 
4918*4882a593Smuzhiyun static struct
drm_displayid_detailed(struct displayid_detailed_timings_1 * timings)4919*4882a593Smuzhiyun drm_display_mode *drm_displayid_detailed(struct displayid_detailed_timings_1
4920*4882a593Smuzhiyun 					      *timings)
4921*4882a593Smuzhiyun {
4922*4882a593Smuzhiyun 	struct drm_display_mode *mode;
4923*4882a593Smuzhiyun 	unsigned pixel_clock = (timings->pixel_clock[0] |
4924*4882a593Smuzhiyun 				(timings->pixel_clock[1] << 8) |
4925*4882a593Smuzhiyun 				(timings->pixel_clock[2] << 16));
4926*4882a593Smuzhiyun 	unsigned hactive = (timings->hactive[0] | timings->hactive[1] << 8) + 1;
4927*4882a593Smuzhiyun 	unsigned hblank = (timings->hblank[0] | timings->hblank[1] << 8) + 1;
4928*4882a593Smuzhiyun 	unsigned hsync = (timings->hsync[0] |
4929*4882a593Smuzhiyun 		(timings->hsync[1] & 0x7f) << 8) + 1;
4930*4882a593Smuzhiyun 	unsigned hsync_width = (timings->hsw[0] | timings->hsw[1] << 8) + 1;
4931*4882a593Smuzhiyun 	unsigned vactive = (timings->vactive[0] |
4932*4882a593Smuzhiyun 		timings->vactive[1] << 8) + 1;
4933*4882a593Smuzhiyun 	unsigned vblank = (timings->vblank[0] | timings->vblank[1] << 8) + 1;
4934*4882a593Smuzhiyun 	unsigned vsync = (timings->vsync[0] |
4935*4882a593Smuzhiyun 		(timings->vsync[1] & 0x7f) << 8) + 1;
4936*4882a593Smuzhiyun 	unsigned vsync_width = (timings->vsw[0] | timings->vsw[1] << 8) + 1;
4937*4882a593Smuzhiyun 	bool hsync_positive = (timings->hsync[1] >> 7) & 0x1;
4938*4882a593Smuzhiyun 	bool vsync_positive = (timings->vsync[1] >> 7) & 0x1;
4939*4882a593Smuzhiyun 
4940*4882a593Smuzhiyun 	mode = drm_mode_create();
4941*4882a593Smuzhiyun 	if (!mode)
4942*4882a593Smuzhiyun 		return NULL;
4943*4882a593Smuzhiyun 
4944*4882a593Smuzhiyun 	mode->clock = pixel_clock * 10;
4945*4882a593Smuzhiyun 	mode->hdisplay = hactive;
4946*4882a593Smuzhiyun 	mode->hsync_start = mode->hdisplay + hsync;
4947*4882a593Smuzhiyun 	mode->hsync_end = mode->hsync_start + hsync_width;
4948*4882a593Smuzhiyun 	mode->htotal = mode->hdisplay + hblank;
4949*4882a593Smuzhiyun 
4950*4882a593Smuzhiyun 	mode->vdisplay = vactive;
4951*4882a593Smuzhiyun 	mode->vsync_start = mode->vdisplay + vsync;
4952*4882a593Smuzhiyun 	mode->vsync_end = mode->vsync_start + vsync_width;
4953*4882a593Smuzhiyun 	mode->vtotal = mode->vdisplay + vblank;
4954*4882a593Smuzhiyun 
4955*4882a593Smuzhiyun 	mode->flags = 0;
4956*4882a593Smuzhiyun 	mode->flags |=
4957*4882a593Smuzhiyun 		hsync_positive ? DRM_MODE_FLAG_PHSYNC : DRM_MODE_FLAG_NHSYNC;
4958*4882a593Smuzhiyun 	mode->flags |=
4959*4882a593Smuzhiyun 		vsync_positive ? DRM_MODE_FLAG_PVSYNC : DRM_MODE_FLAG_NVSYNC;
4960*4882a593Smuzhiyun 	mode->type = DRM_MODE_TYPE_DRIVER;
4961*4882a593Smuzhiyun 
4962*4882a593Smuzhiyun 	if (timings->flags & 0x80)
4963*4882a593Smuzhiyun 		mode->type |= DRM_MODE_TYPE_PREFERRED;
4964*4882a593Smuzhiyun 	mode->vrefresh = drm_get_vrefresh(mode);
4965*4882a593Smuzhiyun 
4966*4882a593Smuzhiyun 	return mode;
4967*4882a593Smuzhiyun }
4968*4882a593Smuzhiyun 
add_displayid_detailed_1_modes(struct hdmi_edid_data * data,struct displayid_block * block)4969*4882a593Smuzhiyun static int add_displayid_detailed_1_modes(struct hdmi_edid_data *data,
4970*4882a593Smuzhiyun 					  struct displayid_block *block)
4971*4882a593Smuzhiyun {
4972*4882a593Smuzhiyun 	struct displayid_detailed_timing_block *det;
4973*4882a593Smuzhiyun 	int i;
4974*4882a593Smuzhiyun 	int num_timings;
4975*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
4976*4882a593Smuzhiyun 	int num_modes = 0;
4977*4882a593Smuzhiyun 
4978*4882a593Smuzhiyun 	det = (struct displayid_detailed_timing_block *)block;
4979*4882a593Smuzhiyun 	/* blocks must be multiple of 20 bytes length */
4980*4882a593Smuzhiyun 	if (block->num_bytes % 20)
4981*4882a593Smuzhiyun 		return 0;
4982*4882a593Smuzhiyun 
4983*4882a593Smuzhiyun 	num_timings = block->num_bytes / 20;
4984*4882a593Smuzhiyun 	for (i = 0; i < num_timings; i++) {
4985*4882a593Smuzhiyun 		struct displayid_detailed_timings_1 *timings =
4986*4882a593Smuzhiyun 			&det->timings[i];
4987*4882a593Smuzhiyun 
4988*4882a593Smuzhiyun 		newmode = drm_displayid_detailed(timings);
4989*4882a593Smuzhiyun 		if (!newmode)
4990*4882a593Smuzhiyun 			continue;
4991*4882a593Smuzhiyun 
4992*4882a593Smuzhiyun 		drm_add_hdmi_modes(data, newmode);
4993*4882a593Smuzhiyun 		num_modes++;
4994*4882a593Smuzhiyun 		drm_mode_destroy(newmode);
4995*4882a593Smuzhiyun 	}
4996*4882a593Smuzhiyun 	return num_modes;
4997*4882a593Smuzhiyun }
4998*4882a593Smuzhiyun 
add_displayid_detailed_modes(struct hdmi_edid_data * data,struct edid * edid)4999*4882a593Smuzhiyun static int add_displayid_detailed_modes(struct hdmi_edid_data *data,
5000*4882a593Smuzhiyun 					struct edid *edid)
5001*4882a593Smuzhiyun {
5002*4882a593Smuzhiyun 	u8 *displayid;
5003*4882a593Smuzhiyun 	int ret;
5004*4882a593Smuzhiyun 	int idx = 1;
5005*4882a593Smuzhiyun 	int length = EDID_SIZE;
5006*4882a593Smuzhiyun 	struct displayid_block *block;
5007*4882a593Smuzhiyun 	int num_modes = 0;
5008*4882a593Smuzhiyun 
5009*4882a593Smuzhiyun 	displayid = drm_find_displayid_extension(edid);
5010*4882a593Smuzhiyun 	if (!displayid)
5011*4882a593Smuzhiyun 		return 0;
5012*4882a593Smuzhiyun 
5013*4882a593Smuzhiyun 	ret = validate_displayid(displayid, length, idx);
5014*4882a593Smuzhiyun 	if (ret)
5015*4882a593Smuzhiyun 		return 0;
5016*4882a593Smuzhiyun 
5017*4882a593Smuzhiyun 	idx += sizeof(struct displayid_hdr);
5018*4882a593Smuzhiyun 	while (block = (struct displayid_block *)&displayid[idx],
5019*4882a593Smuzhiyun 	       idx + sizeof(struct displayid_block) <= length &&
5020*4882a593Smuzhiyun 	       idx + sizeof(struct displayid_block) + block->num_bytes <=
5021*4882a593Smuzhiyun 	       length && block->num_bytes > 0) {
5022*4882a593Smuzhiyun 		idx += block->num_bytes + sizeof(struct displayid_block);
5023*4882a593Smuzhiyun 		switch (block->tag) {
5024*4882a593Smuzhiyun 		case DATA_BLOCK_TYPE_1_DETAILED_TIMING:
5025*4882a593Smuzhiyun 			num_modes +=
5026*4882a593Smuzhiyun 				add_displayid_detailed_1_modes(data, block);
5027*4882a593Smuzhiyun 			break;
5028*4882a593Smuzhiyun 		}
5029*4882a593Smuzhiyun 	}
5030*4882a593Smuzhiyun 	return num_modes;
5031*4882a593Smuzhiyun }
5032*4882a593Smuzhiyun 
5033*4882a593Smuzhiyun static bool
mode_in_hsync_range(const struct drm_display_mode * mode,struct edid * edid,u8 * t)5034*4882a593Smuzhiyun mode_in_hsync_range(const struct drm_display_mode *mode,
5035*4882a593Smuzhiyun 		    struct edid *edid, u8 *t)
5036*4882a593Smuzhiyun {
5037*4882a593Smuzhiyun 	int hsync, hmin, hmax;
5038*4882a593Smuzhiyun 
5039*4882a593Smuzhiyun 	hmin = t[7];
5040*4882a593Smuzhiyun 	if (edid->revision >= 4)
5041*4882a593Smuzhiyun 		hmin += ((t[4] & 0x04) ? 255 : 0);
5042*4882a593Smuzhiyun 	hmax = t[8];
5043*4882a593Smuzhiyun 	if (edid->revision >= 4)
5044*4882a593Smuzhiyun 		hmax += ((t[4] & 0x08) ? 255 : 0);
5045*4882a593Smuzhiyun 	hsync = drm_mode_hsync(mode);
5046*4882a593Smuzhiyun 
5047*4882a593Smuzhiyun 	return (hsync <= hmax && hsync >= hmin);
5048*4882a593Smuzhiyun }
5049*4882a593Smuzhiyun 
5050*4882a593Smuzhiyun static bool
mode_in_vsync_range(const struct drm_display_mode * mode,struct edid * edid,u8 * t)5051*4882a593Smuzhiyun mode_in_vsync_range(const struct drm_display_mode *mode,
5052*4882a593Smuzhiyun 		    struct edid *edid, u8 *t)
5053*4882a593Smuzhiyun {
5054*4882a593Smuzhiyun 	int vsync, vmin, vmax;
5055*4882a593Smuzhiyun 
5056*4882a593Smuzhiyun 	vmin = t[5];
5057*4882a593Smuzhiyun 	if (edid->revision >= 4)
5058*4882a593Smuzhiyun 		vmin += ((t[4] & 0x01) ? 255 : 0);
5059*4882a593Smuzhiyun 	vmax = t[6];
5060*4882a593Smuzhiyun 	if (edid->revision >= 4)
5061*4882a593Smuzhiyun 		vmax += ((t[4] & 0x02) ? 255 : 0);
5062*4882a593Smuzhiyun 	vsync = drm_get_vrefresh(mode);
5063*4882a593Smuzhiyun 
5064*4882a593Smuzhiyun 	return (vsync <= vmax && vsync >= vmin);
5065*4882a593Smuzhiyun }
5066*4882a593Smuzhiyun 
5067*4882a593Smuzhiyun static u32
range_pixel_clock(struct edid * edid,u8 * t)5068*4882a593Smuzhiyun range_pixel_clock(struct edid *edid, u8 *t)
5069*4882a593Smuzhiyun {
5070*4882a593Smuzhiyun 	/* unspecified */
5071*4882a593Smuzhiyun 	if (t[9] == 0 || t[9] == 255)
5072*4882a593Smuzhiyun 		return 0;
5073*4882a593Smuzhiyun 
5074*4882a593Smuzhiyun 	/* 1.4 with CVT support gives us real precision, yay */
5075*4882a593Smuzhiyun 	if (edid->revision >= 4 && t[10] == 0x04)
5076*4882a593Smuzhiyun 		return (t[9] * 10000) - ((t[12] >> 2) * 250);
5077*4882a593Smuzhiyun 
5078*4882a593Smuzhiyun 	/* 1.3 is pathetic, so fuzz up a bit */
5079*4882a593Smuzhiyun 	return t[9] * 10000 + 5001;
5080*4882a593Smuzhiyun }
5081*4882a593Smuzhiyun 
5082*4882a593Smuzhiyun static bool
mode_in_range(const struct drm_display_mode * mode,struct edid * edid,struct detailed_timing * timing)5083*4882a593Smuzhiyun mode_in_range(const struct drm_display_mode *mode, struct edid *edid,
5084*4882a593Smuzhiyun 	      struct detailed_timing *timing)
5085*4882a593Smuzhiyun {
5086*4882a593Smuzhiyun 	u32 max_clock;
5087*4882a593Smuzhiyun 	u8 *t = (u8 *)timing;
5088*4882a593Smuzhiyun 
5089*4882a593Smuzhiyun 	if (!mode_in_hsync_range(mode, edid, t))
5090*4882a593Smuzhiyun 		return false;
5091*4882a593Smuzhiyun 
5092*4882a593Smuzhiyun 	if (!mode_in_vsync_range(mode, edid, t))
5093*4882a593Smuzhiyun 		return false;
5094*4882a593Smuzhiyun 
5095*4882a593Smuzhiyun 	max_clock = range_pixel_clock(edid, t);
5096*4882a593Smuzhiyun 	if (max_clock)
5097*4882a593Smuzhiyun 		if (mode->clock > max_clock)
5098*4882a593Smuzhiyun 			return false;
5099*4882a593Smuzhiyun 
5100*4882a593Smuzhiyun 	/* 1.4 max horizontal check */
5101*4882a593Smuzhiyun 	if (edid->revision >= 4 && t[10] == 0x04)
5102*4882a593Smuzhiyun 		if (t[13] && mode->hdisplay > 8 *
5103*4882a593Smuzhiyun 		    (t[13] + (256 * (t[12] & 0x3))))
5104*4882a593Smuzhiyun 			return false;
5105*4882a593Smuzhiyun 
5106*4882a593Smuzhiyun 	if (mode_is_rb(mode) && !drm_monitor_supports_rb(edid))
5107*4882a593Smuzhiyun 		return false;
5108*4882a593Smuzhiyun 
5109*4882a593Smuzhiyun 	return true;
5110*4882a593Smuzhiyun }
5111*4882a593Smuzhiyun 
valid_inferred_mode(struct hdmi_edid_data * data,const struct drm_display_mode * mode)5112*4882a593Smuzhiyun static bool valid_inferred_mode(struct hdmi_edid_data *data,
5113*4882a593Smuzhiyun 				const struct drm_display_mode *mode)
5114*4882a593Smuzhiyun {
5115*4882a593Smuzhiyun 	const struct drm_display_mode *m;
5116*4882a593Smuzhiyun 	bool ok = false;
5117*4882a593Smuzhiyun 	int i;
5118*4882a593Smuzhiyun 
5119*4882a593Smuzhiyun 	for (i = 0; i < data->modes; i++) {
5120*4882a593Smuzhiyun 		m = &data->mode_buf[i];
5121*4882a593Smuzhiyun 		if (mode->hdisplay == m->hdisplay &&
5122*4882a593Smuzhiyun 		    mode->vdisplay == m->vdisplay &&
5123*4882a593Smuzhiyun 		    drm_get_vrefresh(mode) == drm_get_vrefresh(m))
5124*4882a593Smuzhiyun 			return false; /* duplicated */
5125*4882a593Smuzhiyun 		if (mode->hdisplay <= m->hdisplay &&
5126*4882a593Smuzhiyun 		    mode->vdisplay <= m->vdisplay)
5127*4882a593Smuzhiyun 			ok = true;
5128*4882a593Smuzhiyun 	}
5129*4882a593Smuzhiyun 	return ok;
5130*4882a593Smuzhiyun }
5131*4882a593Smuzhiyun 
5132*4882a593Smuzhiyun static int
drm_dmt_modes_for_range(struct hdmi_edid_data * data,struct edid * edid,struct detailed_timing * timing)5133*4882a593Smuzhiyun drm_dmt_modes_for_range(struct hdmi_edid_data *data, struct edid *edid,
5134*4882a593Smuzhiyun 			struct detailed_timing *timing)
5135*4882a593Smuzhiyun {
5136*4882a593Smuzhiyun 	int i, modes = 0;
5137*4882a593Smuzhiyun 
5138*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(drm_dmt_modes); i++) {
5139*4882a593Smuzhiyun 		if (mode_in_range(drm_dmt_modes + i, edid, timing) &&
5140*4882a593Smuzhiyun 		    valid_inferred_mode(data, drm_dmt_modes + i)) {
5141*4882a593Smuzhiyun 			drm_add_hdmi_modes(data, &drm_dmt_modes[i]);
5142*4882a593Smuzhiyun 			modes++;
5143*4882a593Smuzhiyun 		}
5144*4882a593Smuzhiyun 	}
5145*4882a593Smuzhiyun 
5146*4882a593Smuzhiyun 	return modes;
5147*4882a593Smuzhiyun }
5148*4882a593Smuzhiyun 
5149*4882a593Smuzhiyun /* fix up 1366x768 mode from 1368x768;
5150*4882a593Smuzhiyun  * GFT/CVT can't express 1366 width which isn't dividable by 8
5151*4882a593Smuzhiyun  */
fixup_mode_1366x768(struct drm_display_mode * mode)5152*4882a593Smuzhiyun static void fixup_mode_1366x768(struct drm_display_mode *mode)
5153*4882a593Smuzhiyun {
5154*4882a593Smuzhiyun 	if (mode->hdisplay == 1368 && mode->vdisplay == 768) {
5155*4882a593Smuzhiyun 		mode->hdisplay = 1366;
5156*4882a593Smuzhiyun 		mode->hsync_start--;
5157*4882a593Smuzhiyun 		mode->hsync_end--;
5158*4882a593Smuzhiyun 	}
5159*4882a593Smuzhiyun }
5160*4882a593Smuzhiyun 
5161*4882a593Smuzhiyun static int
drm_gtf_modes_for_range(struct hdmi_edid_data * data,struct edid * edid,struct detailed_timing * timing)5162*4882a593Smuzhiyun drm_gtf_modes_for_range(struct hdmi_edid_data *data, struct edid *edid,
5163*4882a593Smuzhiyun 			struct detailed_timing *timing)
5164*4882a593Smuzhiyun {
5165*4882a593Smuzhiyun 	int i, modes = 0;
5166*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
5167*4882a593Smuzhiyun 
5168*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(extra_modes); i++) {
5169*4882a593Smuzhiyun 		const struct minimode *m = &extra_modes[i];
5170*4882a593Smuzhiyun 
5171*4882a593Smuzhiyun 		newmode = drm_gtf_mode(m->w, m->h, m->r, 0, 0);
5172*4882a593Smuzhiyun 		if (!newmode)
5173*4882a593Smuzhiyun 			return modes;
5174*4882a593Smuzhiyun 
5175*4882a593Smuzhiyun 		fixup_mode_1366x768(newmode);
5176*4882a593Smuzhiyun 		if (!mode_in_range(newmode, edid, timing) ||
5177*4882a593Smuzhiyun 		    !valid_inferred_mode(data, newmode)) {
5178*4882a593Smuzhiyun 			drm_mode_destroy(newmode);
5179*4882a593Smuzhiyun 			continue;
5180*4882a593Smuzhiyun 		}
5181*4882a593Smuzhiyun 
5182*4882a593Smuzhiyun 		drm_add_hdmi_modes(data, newmode);
5183*4882a593Smuzhiyun 		modes++;
5184*4882a593Smuzhiyun 		drm_mode_destroy(newmode);
5185*4882a593Smuzhiyun 	}
5186*4882a593Smuzhiyun 
5187*4882a593Smuzhiyun 	return modes;
5188*4882a593Smuzhiyun }
5189*4882a593Smuzhiyun 
5190*4882a593Smuzhiyun static int
drm_cvt_modes_for_range(struct hdmi_edid_data * data,struct edid * edid,struct detailed_timing * timing)5191*4882a593Smuzhiyun drm_cvt_modes_for_range(struct hdmi_edid_data *data, struct edid *edid,
5192*4882a593Smuzhiyun 			struct detailed_timing *timing)
5193*4882a593Smuzhiyun {
5194*4882a593Smuzhiyun 	int i, modes = 0;
5195*4882a593Smuzhiyun 	struct drm_display_mode *newmode;
5196*4882a593Smuzhiyun 	bool rb = drm_monitor_supports_rb(edid);
5197*4882a593Smuzhiyun 
5198*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(extra_modes); i++) {
5199*4882a593Smuzhiyun 		const struct minimode *m = &extra_modes[i];
5200*4882a593Smuzhiyun 
5201*4882a593Smuzhiyun 		newmode = drm_cvt_mode(m->w, m->h, m->r, rb, 0, 0);
5202*4882a593Smuzhiyun 		if (!newmode)
5203*4882a593Smuzhiyun 			return modes;
5204*4882a593Smuzhiyun 
5205*4882a593Smuzhiyun 		fixup_mode_1366x768(newmode);
5206*4882a593Smuzhiyun 		if (!mode_in_range(newmode, edid, timing) ||
5207*4882a593Smuzhiyun 		    !valid_inferred_mode(data, newmode)) {
5208*4882a593Smuzhiyun 			drm_mode_destroy(newmode);
5209*4882a593Smuzhiyun 			continue;
5210*4882a593Smuzhiyun 		}
5211*4882a593Smuzhiyun 
5212*4882a593Smuzhiyun 		drm_add_hdmi_modes(data, newmode);
5213*4882a593Smuzhiyun 		modes++;
5214*4882a593Smuzhiyun 		drm_mode_destroy(newmode);
5215*4882a593Smuzhiyun 	}
5216*4882a593Smuzhiyun 
5217*4882a593Smuzhiyun 	return modes;
5218*4882a593Smuzhiyun }
5219*4882a593Smuzhiyun 
5220*4882a593Smuzhiyun static void
do_inferred_modes(struct detailed_timing * timing,void * c)5221*4882a593Smuzhiyun do_inferred_modes(struct detailed_timing *timing, void *c)
5222*4882a593Smuzhiyun {
5223*4882a593Smuzhiyun 	struct detailed_mode_closure *closure = c;
5224*4882a593Smuzhiyun 	struct detailed_non_pixel *data = &timing->data.other_data;
5225*4882a593Smuzhiyun 	struct detailed_data_monitor_range *range = &data->data.range;
5226*4882a593Smuzhiyun 
5227*4882a593Smuzhiyun 	if (data->type != EDID_DETAIL_MONITOR_RANGE)
5228*4882a593Smuzhiyun 		return;
5229*4882a593Smuzhiyun 
5230*4882a593Smuzhiyun 	closure->modes += drm_dmt_modes_for_range(closure->data,
5231*4882a593Smuzhiyun 						  closure->edid,
5232*4882a593Smuzhiyun 						  timing);
5233*4882a593Smuzhiyun 
5234*4882a593Smuzhiyun 	if (!version_greater(closure->edid, 1, 1))
5235*4882a593Smuzhiyun 		return; /* GTF not defined yet */
5236*4882a593Smuzhiyun 
5237*4882a593Smuzhiyun 	switch (range->flags) {
5238*4882a593Smuzhiyun 	case 0x02: /* secondary gtf, XXX could do more */
5239*4882a593Smuzhiyun 	case 0x00: /* default gtf */
5240*4882a593Smuzhiyun 		closure->modes += drm_gtf_modes_for_range(closure->data,
5241*4882a593Smuzhiyun 							  closure->edid,
5242*4882a593Smuzhiyun 							  timing);
5243*4882a593Smuzhiyun 		break;
5244*4882a593Smuzhiyun 	case 0x04: /* cvt, only in 1.4+ */
5245*4882a593Smuzhiyun 		if (!version_greater(closure->edid, 1, 3))
5246*4882a593Smuzhiyun 			break;
5247*4882a593Smuzhiyun 
5248*4882a593Smuzhiyun 		closure->modes += drm_cvt_modes_for_range(closure->data,
5249*4882a593Smuzhiyun 							  closure->edid,
5250*4882a593Smuzhiyun 							  timing);
5251*4882a593Smuzhiyun 		break;
5252*4882a593Smuzhiyun 	case 0x01: /* just the ranges, no formula */
5253*4882a593Smuzhiyun 	default:
5254*4882a593Smuzhiyun 		break;
5255*4882a593Smuzhiyun 	}
5256*4882a593Smuzhiyun }
5257*4882a593Smuzhiyun 
5258*4882a593Smuzhiyun static int
add_inferred_modes(struct hdmi_edid_data * data,struct edid * edid)5259*4882a593Smuzhiyun add_inferred_modes(struct hdmi_edid_data *data, struct edid *edid)
5260*4882a593Smuzhiyun {
5261*4882a593Smuzhiyun 	struct detailed_mode_closure closure = {
5262*4882a593Smuzhiyun 		.data = data,
5263*4882a593Smuzhiyun 		.edid = edid,
5264*4882a593Smuzhiyun 	};
5265*4882a593Smuzhiyun 
5266*4882a593Smuzhiyun 	if (version_greater(edid, 1, 0))
5267*4882a593Smuzhiyun 		drm_for_each_detailed_block((u8 *)edid, do_inferred_modes,
5268*4882a593Smuzhiyun 					    &closure);
5269*4882a593Smuzhiyun 
5270*4882a593Smuzhiyun 	return closure.modes;
5271*4882a593Smuzhiyun }
5272*4882a593Smuzhiyun 
5273*4882a593Smuzhiyun #define MODE_SIZE(m) ((m)->hdisplay * (m)->vdisplay)
5274*4882a593Smuzhiyun #define MODE_REFRESH_DIFF(c, t) (abs((c) - (t)))
5275*4882a593Smuzhiyun 
5276*4882a593Smuzhiyun /**
5277*4882a593Smuzhiyun  * edid_fixup_preferred - set preferred modes based on quirk list
5278*4882a593Smuzhiyun  * @data: the structure that save parsed hdmi edid data
5279*4882a593Smuzhiyun  * @quirks: quirks list
5280*4882a593Smuzhiyun  *
5281*4882a593Smuzhiyun  * Walk the mode list, clearing the preferred status
5282*4882a593Smuzhiyun  * on existing modes and setting it anew for the right mode ala @quirks.
5283*4882a593Smuzhiyun  */
edid_fixup_preferred(struct hdmi_edid_data * data,u32 quirks)5284*4882a593Smuzhiyun static void edid_fixup_preferred(struct hdmi_edid_data *data,
5285*4882a593Smuzhiyun 				 u32 quirks)
5286*4882a593Smuzhiyun {
5287*4882a593Smuzhiyun 	struct drm_display_mode *cur_mode, *preferred_mode;
5288*4882a593Smuzhiyun 	int i, target_refresh = 0;
5289*4882a593Smuzhiyun 	int num = data->modes;
5290*4882a593Smuzhiyun 	int cur_vrefresh, preferred_vrefresh;
5291*4882a593Smuzhiyun 
5292*4882a593Smuzhiyun 	if (!num)
5293*4882a593Smuzhiyun 		return;
5294*4882a593Smuzhiyun 
5295*4882a593Smuzhiyun 	preferred_mode = data->preferred_mode;
5296*4882a593Smuzhiyun 
5297*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_PREFER_LARGE_60)
5298*4882a593Smuzhiyun 		target_refresh = 60;
5299*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_PREFER_LARGE_75)
5300*4882a593Smuzhiyun 		target_refresh = 75;
5301*4882a593Smuzhiyun 
5302*4882a593Smuzhiyun 	for (i = 0; i < num; i++) {
5303*4882a593Smuzhiyun 		cur_mode = &data->mode_buf[i];
5304*4882a593Smuzhiyun 		cur_mode->type &= ~DRM_MODE_TYPE_PREFERRED;
5305*4882a593Smuzhiyun 
5306*4882a593Smuzhiyun 		if (cur_mode == preferred_mode)
5307*4882a593Smuzhiyun 			continue;
5308*4882a593Smuzhiyun 
5309*4882a593Smuzhiyun 		/* Largest mode is preferred */
5310*4882a593Smuzhiyun 		if (MODE_SIZE(cur_mode) > MODE_SIZE(preferred_mode))
5311*4882a593Smuzhiyun 			preferred_mode = cur_mode;
5312*4882a593Smuzhiyun 
5313*4882a593Smuzhiyun 		cur_vrefresh = cur_mode->vrefresh ?
5314*4882a593Smuzhiyun 		cur_mode->vrefresh : drm_get_vrefresh(cur_mode);
5315*4882a593Smuzhiyun 		preferred_vrefresh = preferred_mode->vrefresh ?
5316*4882a593Smuzhiyun 		preferred_mode->vrefresh : drm_get_vrefresh(preferred_mode);
5317*4882a593Smuzhiyun 		/* At a given size, try to get closest to target refresh */
5318*4882a593Smuzhiyun 		if ((MODE_SIZE(cur_mode) == MODE_SIZE(preferred_mode)) &&
5319*4882a593Smuzhiyun 		    MODE_REFRESH_DIFF(cur_vrefresh, target_refresh) <
5320*4882a593Smuzhiyun 		    MODE_REFRESH_DIFF(preferred_vrefresh, target_refresh)) {
5321*4882a593Smuzhiyun 			preferred_mode = cur_mode;
5322*4882a593Smuzhiyun 		}
5323*4882a593Smuzhiyun 	}
5324*4882a593Smuzhiyun 	preferred_mode->type |= DRM_MODE_TYPE_PREFERRED;
5325*4882a593Smuzhiyun 	data->preferred_mode = preferred_mode;
5326*4882a593Smuzhiyun }
5327*4882a593Smuzhiyun 
5328*4882a593Smuzhiyun static const u8 edid_header[] = {
5329*4882a593Smuzhiyun 	0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00
5330*4882a593Smuzhiyun };
5331*4882a593Smuzhiyun 
5332*4882a593Smuzhiyun /**
5333*4882a593Smuzhiyun  * drm_edid_header_is_valid - sanity check the header of the base EDID block
5334*4882a593Smuzhiyun  * @raw_edid: pointer to raw base EDID block
5335*4882a593Smuzhiyun  *
5336*4882a593Smuzhiyun  * Sanity check the header of the base EDID block.
5337*4882a593Smuzhiyun  *
5338*4882a593Smuzhiyun  * Return: 8 if the header is perfect, down to 0 if it's totally wrong.
5339*4882a593Smuzhiyun  */
drm_edid_header_is_valid(const u8 * raw_edid)5340*4882a593Smuzhiyun static int drm_edid_header_is_valid(const u8 *raw_edid)
5341*4882a593Smuzhiyun {
5342*4882a593Smuzhiyun 	int i, score = 0;
5343*4882a593Smuzhiyun 
5344*4882a593Smuzhiyun 	for (i = 0; i < sizeof(edid_header); i++)
5345*4882a593Smuzhiyun 		if (raw_edid[i] == edid_header[i])
5346*4882a593Smuzhiyun 			score++;
5347*4882a593Smuzhiyun 
5348*4882a593Smuzhiyun 	return score;
5349*4882a593Smuzhiyun }
5350*4882a593Smuzhiyun 
drm_edid_block_checksum(const u8 * raw_edid)5351*4882a593Smuzhiyun static int drm_edid_block_checksum(const u8 *raw_edid)
5352*4882a593Smuzhiyun {
5353*4882a593Smuzhiyun 	int i;
5354*4882a593Smuzhiyun 	u8 csum = 0;
5355*4882a593Smuzhiyun 
5356*4882a593Smuzhiyun 	for (i = 0; i < EDID_SIZE; i++)
5357*4882a593Smuzhiyun 		csum += raw_edid[i];
5358*4882a593Smuzhiyun 
5359*4882a593Smuzhiyun 	return csum;
5360*4882a593Smuzhiyun }
5361*4882a593Smuzhiyun 
drm_edid_is_zero(const u8 * in_edid,int length)5362*4882a593Smuzhiyun static bool drm_edid_is_zero(const u8 *in_edid, int length)
5363*4882a593Smuzhiyun {
5364*4882a593Smuzhiyun 	if (memchr_inv(in_edid, 0, length))
5365*4882a593Smuzhiyun 		return false;
5366*4882a593Smuzhiyun 
5367*4882a593Smuzhiyun 	return true;
5368*4882a593Smuzhiyun }
5369*4882a593Smuzhiyun 
5370*4882a593Smuzhiyun /**
5371*4882a593Smuzhiyun  * drm_edid_block_valid - Sanity check the EDID block (base or extension)
5372*4882a593Smuzhiyun  * @raw_edid: pointer to raw EDID block
5373*4882a593Smuzhiyun  * @block: type of block to validate (0 for base, extension otherwise)
5374*4882a593Smuzhiyun  * @print_bad_edid: if true, dump bad EDID blocks to the console
5375*4882a593Smuzhiyun  * @edid_corrupt: if true, the header or checksum is invalid
5376*4882a593Smuzhiyun  *
5377*4882a593Smuzhiyun  * Validate a base or extension EDID block and optionally dump bad blocks to
5378*4882a593Smuzhiyun  * the console.
5379*4882a593Smuzhiyun  *
5380*4882a593Smuzhiyun  * Return: True if the block is valid, false otherwise.
5381*4882a593Smuzhiyun  */
5382*4882a593Smuzhiyun static
drm_edid_block_valid(u8 * raw_edid,int block,bool print_bad_edid,bool * edid_corrupt)5383*4882a593Smuzhiyun bool drm_edid_block_valid(u8 *raw_edid, int block, bool print_bad_edid,
5384*4882a593Smuzhiyun 			  bool *edid_corrupt)
5385*4882a593Smuzhiyun {
5386*4882a593Smuzhiyun 	u8 csum;
5387*4882a593Smuzhiyun 	int edid_fixup = 6;
5388*4882a593Smuzhiyun 	struct edid *edid = (struct edid *)raw_edid;
5389*4882a593Smuzhiyun 
5390*4882a593Smuzhiyun 	if ((!raw_edid))
5391*4882a593Smuzhiyun 		return false;
5392*4882a593Smuzhiyun 
5393*4882a593Smuzhiyun 	if (block == 0) {
5394*4882a593Smuzhiyun 		int score = drm_edid_header_is_valid(raw_edid);
5395*4882a593Smuzhiyun 
5396*4882a593Smuzhiyun 		if (score == 8) {
5397*4882a593Smuzhiyun 			if (edid_corrupt)
5398*4882a593Smuzhiyun 				*edid_corrupt = false;
5399*4882a593Smuzhiyun 		} else if (score >= edid_fixup) {
5400*4882a593Smuzhiyun 			/* Displayport Link CTS Core 1.2 rev1.1 test 4.2.2.6
5401*4882a593Smuzhiyun 			 * The corrupt flag needs to be set here otherwise, the
5402*4882a593Smuzhiyun 			 * fix-up code here will correct the problem, the
5403*4882a593Smuzhiyun 			 * checksum is correct and the test fails
5404*4882a593Smuzhiyun 			 */
5405*4882a593Smuzhiyun 			if (edid_corrupt)
5406*4882a593Smuzhiyun 				*edid_corrupt = true;
5407*4882a593Smuzhiyun 			debug("Fixing header, your hardware may be failing\n");
5408*4882a593Smuzhiyun 			memcpy(raw_edid, edid_header, sizeof(edid_header));
5409*4882a593Smuzhiyun 		} else {
5410*4882a593Smuzhiyun 			if (edid_corrupt)
5411*4882a593Smuzhiyun 				*edid_corrupt = true;
5412*4882a593Smuzhiyun 			goto bad;
5413*4882a593Smuzhiyun 		}
5414*4882a593Smuzhiyun 	}
5415*4882a593Smuzhiyun 
5416*4882a593Smuzhiyun 	csum = drm_edid_block_checksum(raw_edid);
5417*4882a593Smuzhiyun 	if (csum) {
5418*4882a593Smuzhiyun 		if (print_bad_edid) {
5419*4882a593Smuzhiyun 			debug("EDID checksum is invalid, remainder is %d\n",
5420*4882a593Smuzhiyun 			      csum);
5421*4882a593Smuzhiyun 		}
5422*4882a593Smuzhiyun 
5423*4882a593Smuzhiyun 		if (edid_corrupt)
5424*4882a593Smuzhiyun 			*edid_corrupt = true;
5425*4882a593Smuzhiyun 
5426*4882a593Smuzhiyun 		/* allow CEA to slide through, switches mangle this */
5427*4882a593Smuzhiyun 		if (raw_edid[0] != 0x02)
5428*4882a593Smuzhiyun 			goto bad;
5429*4882a593Smuzhiyun 	}
5430*4882a593Smuzhiyun 
5431*4882a593Smuzhiyun 	/* per-block-type checks */
5432*4882a593Smuzhiyun 	switch (raw_edid[0]) {
5433*4882a593Smuzhiyun 	case 0: /* base */
5434*4882a593Smuzhiyun 		if (edid->version != 1) {
5435*4882a593Smuzhiyun 			debug("EDID has major version %d, instead of 1\n",
5436*4882a593Smuzhiyun 			      edid->version);
5437*4882a593Smuzhiyun 			goto bad;
5438*4882a593Smuzhiyun 		}
5439*4882a593Smuzhiyun 
5440*4882a593Smuzhiyun 		if (edid->revision > 4)
5441*4882a593Smuzhiyun 			debug("minor > 4, assuming backward compatibility\n");
5442*4882a593Smuzhiyun 		break;
5443*4882a593Smuzhiyun 
5444*4882a593Smuzhiyun 	default:
5445*4882a593Smuzhiyun 		break;
5446*4882a593Smuzhiyun 	}
5447*4882a593Smuzhiyun 
5448*4882a593Smuzhiyun 	return true;
5449*4882a593Smuzhiyun 
5450*4882a593Smuzhiyun bad:
5451*4882a593Smuzhiyun 	if (print_bad_edid) {
5452*4882a593Smuzhiyun 		if (drm_edid_is_zero(raw_edid, EDID_SIZE)) {
5453*4882a593Smuzhiyun 			debug("EDID block is all zeroes\n");
5454*4882a593Smuzhiyun 		} else {
5455*4882a593Smuzhiyun 			debug("Raw EDID:\n");
5456*4882a593Smuzhiyun 			print_hex_dump("", DUMP_PREFIX_NONE, 16, 1,
5457*4882a593Smuzhiyun 				       raw_edid, EDID_SIZE, false);
5458*4882a593Smuzhiyun 		}
5459*4882a593Smuzhiyun 	}
5460*4882a593Smuzhiyun 	return false;
5461*4882a593Smuzhiyun }
5462*4882a593Smuzhiyun 
5463*4882a593Smuzhiyun /**
5464*4882a593Smuzhiyun  * drm_edid_is_valid - sanity check EDID data
5465*4882a593Smuzhiyun  * @edid: EDID data
5466*4882a593Smuzhiyun  *
5467*4882a593Smuzhiyun  * Sanity-check an entire EDID record (including extensions)
5468*4882a593Smuzhiyun  *
5469*4882a593Smuzhiyun  * Return: True if the EDID data is valid, false otherwise.
5470*4882a593Smuzhiyun  */
drm_edid_is_valid(struct edid * edid)5471*4882a593Smuzhiyun static bool drm_edid_is_valid(struct edid *edid)
5472*4882a593Smuzhiyun {
5473*4882a593Smuzhiyun 	int i;
5474*4882a593Smuzhiyun 	u8 *raw = (u8 *)edid;
5475*4882a593Smuzhiyun 
5476*4882a593Smuzhiyun 	if (!edid)
5477*4882a593Smuzhiyun 		return false;
5478*4882a593Smuzhiyun 
5479*4882a593Smuzhiyun 	for (i = 0; i <= edid->extensions; i++)
5480*4882a593Smuzhiyun 		if (!drm_edid_block_valid(raw + i * EDID_SIZE, i, true, NULL))
5481*4882a593Smuzhiyun 			return false;
5482*4882a593Smuzhiyun 
5483*4882a593Smuzhiyun 	return true;
5484*4882a593Smuzhiyun }
5485*4882a593Smuzhiyun 
5486*4882a593Smuzhiyun /**
5487*4882a593Smuzhiyun  * drm_add_edid_modes - add modes from EDID data, if available
5488*4882a593Smuzhiyun  * @data: data we're probing
5489*4882a593Smuzhiyun  * @edid: EDID data
5490*4882a593Smuzhiyun  *
5491*4882a593Smuzhiyun  * Add the specified modes to the data's mode list.
5492*4882a593Smuzhiyun  *
5493*4882a593Smuzhiyun  * Return: The number of modes added or 0 if we couldn't find any.
5494*4882a593Smuzhiyun  */
drm_add_edid_modes(struct hdmi_edid_data * data,u8 * raw_edid)5495*4882a593Smuzhiyun int drm_add_edid_modes(struct hdmi_edid_data *data, u8 *raw_edid)
5496*4882a593Smuzhiyun {
5497*4882a593Smuzhiyun 	int num_modes = 0;
5498*4882a593Smuzhiyun 	u32 quirks;
5499*4882a593Smuzhiyun 	struct edid *edid = (struct edid *)raw_edid;
5500*4882a593Smuzhiyun 
5501*4882a593Smuzhiyun 	if (!edid) {
5502*4882a593Smuzhiyun 		debug("no edid\n");
5503*4882a593Smuzhiyun 		return 0;
5504*4882a593Smuzhiyun 	}
5505*4882a593Smuzhiyun 
5506*4882a593Smuzhiyun 	if (!drm_edid_is_valid(edid)) {
5507*4882a593Smuzhiyun 		debug("EDID invalid\n");
5508*4882a593Smuzhiyun 		return 0;
5509*4882a593Smuzhiyun 	}
5510*4882a593Smuzhiyun 
5511*4882a593Smuzhiyun 	if (!data->mode_buf) {
5512*4882a593Smuzhiyun 		debug("mode buff is null\n");
5513*4882a593Smuzhiyun 		return 0;
5514*4882a593Smuzhiyun 	}
5515*4882a593Smuzhiyun 
5516*4882a593Smuzhiyun 	quirks = edid_get_quirks(edid);
5517*4882a593Smuzhiyun 	/*
5518*4882a593Smuzhiyun 	 * CEA-861-F adds ycbcr capability map block, for HDMI 2.0 sinks.
5519*4882a593Smuzhiyun 	 * To avoid multiple parsing of same block, lets parse that map
5520*4882a593Smuzhiyun 	 * from sink info, before parsing CEA modes.
5521*4882a593Smuzhiyun 	 */
5522*4882a593Smuzhiyun 	drm_add_display_info(data, edid);
5523*4882a593Smuzhiyun 
5524*4882a593Smuzhiyun 	/*
5525*4882a593Smuzhiyun 	 * EDID spec says modes should be preferred in this order:
5526*4882a593Smuzhiyun 	 * - preferred detailed mode
5527*4882a593Smuzhiyun 	 * - other detailed modes from base block
5528*4882a593Smuzhiyun 	 * - detailed modes from extension blocks
5529*4882a593Smuzhiyun 	 * - CVT 3-byte code modes
5530*4882a593Smuzhiyun 	 * - standard timing codes
5531*4882a593Smuzhiyun 	 * - established timing codes
5532*4882a593Smuzhiyun 	 * - modes inferred from GTF or CVT range information
5533*4882a593Smuzhiyun 	 *
5534*4882a593Smuzhiyun 	 * We get this pretty much right.
5535*4882a593Smuzhiyun 	 *
5536*4882a593Smuzhiyun 	 * XXX order for additional mode types in extension blocks?
5537*4882a593Smuzhiyun 	 */
5538*4882a593Smuzhiyun 	num_modes += add_detailed_modes(data, edid, quirks);
5539*4882a593Smuzhiyun 	num_modes += add_cvt_modes(data, edid);
5540*4882a593Smuzhiyun 	num_modes += add_standard_modes(data, edid);
5541*4882a593Smuzhiyun 	num_modes += add_established_modes(data, edid);
5542*4882a593Smuzhiyun 	num_modes += add_cea_modes(data, edid);
5543*4882a593Smuzhiyun 	num_modes += add_alternate_cea_modes(data, edid);
5544*4882a593Smuzhiyun 	num_modes += add_displayid_detailed_modes(data, edid);
5545*4882a593Smuzhiyun 
5546*4882a593Smuzhiyun 	if (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF)
5547*4882a593Smuzhiyun 		num_modes += add_inferred_modes(data, edid);
5548*4882a593Smuzhiyun 
5549*4882a593Smuzhiyun 	if (num_modes > 0)
5550*4882a593Smuzhiyun 		data->preferred_mode = &data->mode_buf[0];
5551*4882a593Smuzhiyun 
5552*4882a593Smuzhiyun 	if (quirks & (EDID_QUIRK_PREFER_LARGE_60 | EDID_QUIRK_PREFER_LARGE_75))
5553*4882a593Smuzhiyun 		edid_fixup_preferred(data, quirks);
5554*4882a593Smuzhiyun 
5555*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_FORCE_6BPC)
5556*4882a593Smuzhiyun 		data->display_info.bpc = 6;
5557*4882a593Smuzhiyun 
5558*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_FORCE_8BPC)
5559*4882a593Smuzhiyun 		data->display_info.bpc = 8;
5560*4882a593Smuzhiyun 
5561*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_FORCE_10BPC)
5562*4882a593Smuzhiyun 		data->display_info.bpc = 10;
5563*4882a593Smuzhiyun 
5564*4882a593Smuzhiyun 	if (quirks & EDID_QUIRK_FORCE_12BPC)
5565*4882a593Smuzhiyun 		data->display_info.bpc = 12;
5566*4882a593Smuzhiyun 
5567*4882a593Smuzhiyun 	return num_modes;
5568*4882a593Smuzhiyun }
5569*4882a593Smuzhiyun 
drm_match_cea_mode(struct drm_display_mode * to_match)5570*4882a593Smuzhiyun u8 drm_match_cea_mode(struct drm_display_mode *to_match)
5571*4882a593Smuzhiyun {
5572*4882a593Smuzhiyun 	u8 vic;
5573*4882a593Smuzhiyun 
5574*4882a593Smuzhiyun 	if (!to_match->clock) {
5575*4882a593Smuzhiyun 		printf("can't find to match\n");
5576*4882a593Smuzhiyun 		return 0;
5577*4882a593Smuzhiyun 	}
5578*4882a593Smuzhiyun 
5579*4882a593Smuzhiyun 	for (vic = 1; vic < cea_num_vics(); vic = cea_next_vic(vic)) {
5580*4882a593Smuzhiyun 		const struct drm_display_mode *cea_mode = cea_mode_for_vic(vic);
5581*4882a593Smuzhiyun 		unsigned int clock1, clock2;
5582*4882a593Smuzhiyun 
5583*4882a593Smuzhiyun 		/* Check both 60Hz and 59.94Hz */
5584*4882a593Smuzhiyun 		clock1 = cea_mode->clock;
5585*4882a593Smuzhiyun 		clock2 = cea_mode_alternate_clock(cea_mode);
5586*4882a593Smuzhiyun 		if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
5587*4882a593Smuzhiyun 		     KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
5588*4882a593Smuzhiyun 		    drm_mode_equal_no_clocks_no_stereo(to_match, cea_mode))
5589*4882a593Smuzhiyun 			return vic;
5590*4882a593Smuzhiyun 	}
5591*4882a593Smuzhiyun 
5592*4882a593Smuzhiyun 	return 0;
5593*4882a593Smuzhiyun }
5594*4882a593Smuzhiyun 
drm_get_cea_aspect_ratio(const u8 video_code)5595*4882a593Smuzhiyun static enum hdmi_picture_aspect drm_get_cea_aspect_ratio(const u8 video_code)
5596*4882a593Smuzhiyun {
5597*4882a593Smuzhiyun 	const struct drm_display_mode *mode = cea_mode_for_vic(video_code);
5598*4882a593Smuzhiyun 
5599*4882a593Smuzhiyun 	if (mode)
5600*4882a593Smuzhiyun 		return mode->picture_aspect_ratio;
5601*4882a593Smuzhiyun 
5602*4882a593Smuzhiyun 	return HDMI_PICTURE_ASPECT_NONE;
5603*4882a593Smuzhiyun }
5604*4882a593Smuzhiyun 
5605*4882a593Smuzhiyun int
drm_hdmi_avi_infoframe_from_display_mode(struct hdmi_avi_infoframe * frame,struct drm_display_mode * mode,bool is_hdmi2_sink)5606*4882a593Smuzhiyun drm_hdmi_avi_infoframe_from_display_mode(struct hdmi_avi_infoframe *frame,
5607*4882a593Smuzhiyun 					 struct drm_display_mode *mode,
5608*4882a593Smuzhiyun 					 bool is_hdmi2_sink)
5609*4882a593Smuzhiyun {
5610*4882a593Smuzhiyun 	int err;
5611*4882a593Smuzhiyun 
5612*4882a593Smuzhiyun 	if (!frame || !mode)
5613*4882a593Smuzhiyun 		return -EINVAL;
5614*4882a593Smuzhiyun 
5615*4882a593Smuzhiyun 	err = hdmi_avi_infoframe_init(frame);
5616*4882a593Smuzhiyun 	if (err < 0)
5617*4882a593Smuzhiyun 		return err;
5618*4882a593Smuzhiyun 
5619*4882a593Smuzhiyun 	if (mode->flags & DRM_MODE_FLAG_DBLCLK)
5620*4882a593Smuzhiyun 		frame->pixel_repeat = 1;
5621*4882a593Smuzhiyun 
5622*4882a593Smuzhiyun 	frame->video_code = drm_match_cea_mode(mode);
5623*4882a593Smuzhiyun 
5624*4882a593Smuzhiyun 	/*
5625*4882a593Smuzhiyun 	 * HDMI 1.4 VIC range: 1 <= VIC <= 64 (CEA-861-D) but
5626*4882a593Smuzhiyun 	 * HDMI 2.0 VIC range: 1 <= VIC <= 107 (CEA-861-F). So we
5627*4882a593Smuzhiyun 	 * have to make sure we dont break HDMI 1.4 sinks.
5628*4882a593Smuzhiyun 	 */
5629*4882a593Smuzhiyun 	if (!is_hdmi2_sink && frame->video_code > 64)
5630*4882a593Smuzhiyun 		frame->video_code = 0;
5631*4882a593Smuzhiyun 
5632*4882a593Smuzhiyun 	/*
5633*4882a593Smuzhiyun 	 * HDMI spec says if a mode is found in HDMI 1.4b 4K modes
5634*4882a593Smuzhiyun 	 * we should send its VIC in vendor infoframes, else send the
5635*4882a593Smuzhiyun 	 * VIC in AVI infoframes. Lets check if this mode is present in
5636*4882a593Smuzhiyun 	 * HDMI 1.4b 4K modes
5637*4882a593Smuzhiyun 	 */
5638*4882a593Smuzhiyun 	if (frame->video_code) {
5639*4882a593Smuzhiyun 		u8 vendor_if_vic = drm_match_hdmi_mode(mode);
5640*4882a593Smuzhiyun 		bool is_s3d = mode->flags & DRM_MODE_FLAG_3D_MASK;
5641*4882a593Smuzhiyun 
5642*4882a593Smuzhiyun 		if (drm_valid_hdmi_vic(vendor_if_vic) && !is_s3d)
5643*4882a593Smuzhiyun 			frame->video_code = 0;
5644*4882a593Smuzhiyun 	}
5645*4882a593Smuzhiyun 
5646*4882a593Smuzhiyun 	frame->picture_aspect = HDMI_PICTURE_ASPECT_NONE;
5647*4882a593Smuzhiyun 
5648*4882a593Smuzhiyun 	/*
5649*4882a593Smuzhiyun 	 * Populate picture aspect ratio from either
5650*4882a593Smuzhiyun 	 * user input (if specified) or from the CEA mode list.
5651*4882a593Smuzhiyun 	 */
5652*4882a593Smuzhiyun 	if (mode->picture_aspect_ratio == HDMI_PICTURE_ASPECT_4_3 ||
5653*4882a593Smuzhiyun 	    mode->picture_aspect_ratio == HDMI_PICTURE_ASPECT_16_9)
5654*4882a593Smuzhiyun 		frame->picture_aspect = mode->picture_aspect_ratio;
5655*4882a593Smuzhiyun 	else if (frame->video_code > 0)
5656*4882a593Smuzhiyun 		frame->picture_aspect = drm_get_cea_aspect_ratio(
5657*4882a593Smuzhiyun 						frame->video_code);
5658*4882a593Smuzhiyun 
5659*4882a593Smuzhiyun 	if (frame->picture_aspect > HDMI_PICTURE_ASPECT_16_9)
5660*4882a593Smuzhiyun 		frame->picture_aspect = HDMI_PICTURE_ASPECT_NONE;
5661*4882a593Smuzhiyun 	frame->active_aspect = HDMI_ACTIVE_ASPECT_PICTURE;
5662*4882a593Smuzhiyun 	frame->scan_mode = HDMI_SCAN_MODE_UNDERSCAN;
5663*4882a593Smuzhiyun 
5664*4882a593Smuzhiyun 	return 0;
5665*4882a593Smuzhiyun }
5666*4882a593Smuzhiyun 
5667*4882a593Smuzhiyun /**
5668*4882a593Smuzhiyun  * hdmi_vendor_infoframe_init() - initialize an HDMI vendor infoframe
5669*4882a593Smuzhiyun  * @frame: HDMI vendor infoframe
5670*4882a593Smuzhiyun  *
5671*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
5672*4882a593Smuzhiyun  */
hdmi_vendor_infoframe_init(struct hdmi_vendor_infoframe * frame)5673*4882a593Smuzhiyun int hdmi_vendor_infoframe_init(struct hdmi_vendor_infoframe *frame)
5674*4882a593Smuzhiyun {
5675*4882a593Smuzhiyun 	memset(frame, 0, sizeof(*frame));
5676*4882a593Smuzhiyun 
5677*4882a593Smuzhiyun 	frame->type = HDMI_INFOFRAME_TYPE_VENDOR;
5678*4882a593Smuzhiyun 	frame->version = 1;
5679*4882a593Smuzhiyun 
5680*4882a593Smuzhiyun 	frame->oui = HDMI_IEEE_OUI;
5681*4882a593Smuzhiyun 
5682*4882a593Smuzhiyun 	/*
5683*4882a593Smuzhiyun 	 * 0 is a valid value for s3d_struct, so we use a special "not set"
5684*4882a593Smuzhiyun 	 * value
5685*4882a593Smuzhiyun 	 */
5686*4882a593Smuzhiyun 	frame->s3d_struct = HDMI_3D_STRUCTURE_INVALID;
5687*4882a593Smuzhiyun 
5688*4882a593Smuzhiyun 	return 0;
5689*4882a593Smuzhiyun }
5690*4882a593Smuzhiyun 
5691*4882a593Smuzhiyun /**
5692*4882a593Smuzhiyun  * drm_hdmi_avi_infoframe_quant_range() - fill the HDMI AVI infoframe
5693*4882a593Smuzhiyun  *                                        quantization range information
5694*4882a593Smuzhiyun  * @frame: HDMI AVI infoframe
5695*4882a593Smuzhiyun  * @rgb_quant_range: RGB quantization range (Q)
5696*4882a593Smuzhiyun  * @rgb_quant_range_selectable: Sink support selectable RGB quantization range (QS)
5697*4882a593Smuzhiyun  */
5698*4882a593Smuzhiyun void
drm_hdmi_avi_infoframe_quant_range(struct hdmi_avi_infoframe * frame,struct drm_display_mode * mode,enum hdmi_quantization_range rgb_quant_range,bool rgb_quant_range_selectable)5699*4882a593Smuzhiyun drm_hdmi_avi_infoframe_quant_range(struct hdmi_avi_infoframe *frame,
5700*4882a593Smuzhiyun 				   struct drm_display_mode *mode,
5701*4882a593Smuzhiyun 				   enum hdmi_quantization_range rgb_quant_range,
5702*4882a593Smuzhiyun 				   bool rgb_quant_range_selectable)
5703*4882a593Smuzhiyun {
5704*4882a593Smuzhiyun 	/*
5705*4882a593Smuzhiyun 	 * CEA-861:
5706*4882a593Smuzhiyun 	 * "A Source shall not send a non-zero Q value that does not correspond
5707*4882a593Smuzhiyun 	 *  to the default RGB Quantization Range for the transmitted Picture
5708*4882a593Smuzhiyun 	 *  unless the Sink indicates support for the Q bit in a Video
5709*4882a593Smuzhiyun 	 *  Capabilities Data Block."
5710*4882a593Smuzhiyun 	 *
5711*4882a593Smuzhiyun 	 * HDMI 2.0 recommends sending non-zero Q when it does match the
5712*4882a593Smuzhiyun 	 * default RGB quantization range for the mode, even when QS=0.
5713*4882a593Smuzhiyun 	 */
5714*4882a593Smuzhiyun 	if (rgb_quant_range_selectable ||
5715*4882a593Smuzhiyun 	    rgb_quant_range == drm_default_rgb_quant_range(mode))
5716*4882a593Smuzhiyun 		frame->quantization_range = rgb_quant_range;
5717*4882a593Smuzhiyun 	else
5718*4882a593Smuzhiyun 		frame->quantization_range = HDMI_QUANTIZATION_RANGE_DEFAULT;
5719*4882a593Smuzhiyun 
5720*4882a593Smuzhiyun 	/*
5721*4882a593Smuzhiyun 	 * CEA-861-F:
5722*4882a593Smuzhiyun 	 * "When transmitting any RGB colorimetry, the Source should set the
5723*4882a593Smuzhiyun 	 *  YQ-field to match the RGB Quantization Range being transmitted
5724*4882a593Smuzhiyun 	 *  (e.g., when Limited Range RGB, set YQ=0 or when Full Range RGB,
5725*4882a593Smuzhiyun 	 *  set YQ=1) and the Sink shall ignore the YQ-field."
5726*4882a593Smuzhiyun 	 */
5727*4882a593Smuzhiyun 	if (rgb_quant_range == HDMI_QUANTIZATION_RANGE_LIMITED)
5728*4882a593Smuzhiyun 		frame->ycc_quantization_range =
5729*4882a593Smuzhiyun 			HDMI_YCC_QUANTIZATION_RANGE_LIMITED;
5730*4882a593Smuzhiyun 	else
5731*4882a593Smuzhiyun 		frame->ycc_quantization_range =
5732*4882a593Smuzhiyun 			HDMI_YCC_QUANTIZATION_RANGE_FULL;
5733*4882a593Smuzhiyun }
5734*4882a593Smuzhiyun 
5735*4882a593Smuzhiyun static enum hdmi_3d_structure
s3d_structure_from_display_mode(const struct drm_display_mode * mode)5736*4882a593Smuzhiyun s3d_structure_from_display_mode(const struct drm_display_mode *mode)
5737*4882a593Smuzhiyun {
5738*4882a593Smuzhiyun 	u32 layout = mode->flags & DRM_MODE_FLAG_3D_MASK;
5739*4882a593Smuzhiyun 
5740*4882a593Smuzhiyun 	switch (layout) {
5741*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_FRAME_PACKING:
5742*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_FRAME_PACKING;
5743*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_FIELD_ALTERNATIVE:
5744*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_FIELD_ALTERNATIVE;
5745*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_LINE_ALTERNATIVE:
5746*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_LINE_ALTERNATIVE;
5747*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_SIDE_BY_SIDE_FULL:
5748*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_SIDE_BY_SIDE_FULL;
5749*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_L_DEPTH:
5750*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_L_DEPTH;
5751*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_L_DEPTH_GFX_GFX_DEPTH:
5752*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_L_DEPTH_GFX_GFX_DEPTH;
5753*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_TOP_AND_BOTTOM:
5754*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_TOP_AND_BOTTOM;
5755*4882a593Smuzhiyun 	case DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF:
5756*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF;
5757*4882a593Smuzhiyun 	default:
5758*4882a593Smuzhiyun 		return HDMI_3D_STRUCTURE_INVALID;
5759*4882a593Smuzhiyun 	}
5760*4882a593Smuzhiyun }
5761*4882a593Smuzhiyun 
5762*4882a593Smuzhiyun int
drm_hdmi_vendor_infoframe_from_display_mode(struct hdmi_vendor_infoframe * frame,struct drm_display_mode * mode)5763*4882a593Smuzhiyun drm_hdmi_vendor_infoframe_from_display_mode(struct hdmi_vendor_infoframe *frame,
5764*4882a593Smuzhiyun 					    struct drm_display_mode *mode)
5765*4882a593Smuzhiyun {
5766*4882a593Smuzhiyun 	int err;
5767*4882a593Smuzhiyun 	u32 s3d_flags;
5768*4882a593Smuzhiyun 	u8 vic;
5769*4882a593Smuzhiyun 
5770*4882a593Smuzhiyun 	if (!frame || !mode)
5771*4882a593Smuzhiyun 		return -EINVAL;
5772*4882a593Smuzhiyun 
5773*4882a593Smuzhiyun 	vic = drm_match_hdmi_mode(mode);
5774*4882a593Smuzhiyun 
5775*4882a593Smuzhiyun 	s3d_flags = mode->flags & DRM_MODE_FLAG_3D_MASK;
5776*4882a593Smuzhiyun 
5777*4882a593Smuzhiyun 	if (!vic && !s3d_flags)
5778*4882a593Smuzhiyun 		return -EINVAL;
5779*4882a593Smuzhiyun 
5780*4882a593Smuzhiyun 	if (vic && s3d_flags)
5781*4882a593Smuzhiyun 		return -EINVAL;
5782*4882a593Smuzhiyun 
5783*4882a593Smuzhiyun 	err = hdmi_vendor_infoframe_init(frame);
5784*4882a593Smuzhiyun 	if (err < 0)
5785*4882a593Smuzhiyun 		return err;
5786*4882a593Smuzhiyun 
5787*4882a593Smuzhiyun 	if (vic)
5788*4882a593Smuzhiyun 		frame->vic = vic;
5789*4882a593Smuzhiyun 	else
5790*4882a593Smuzhiyun 		frame->s3d_struct = s3d_structure_from_display_mode(mode);
5791*4882a593Smuzhiyun 
5792*4882a593Smuzhiyun 	return 0;
5793*4882a593Smuzhiyun }
5794*4882a593Smuzhiyun 
hdmi_infoframe_checksum(u8 * ptr,size_t size)5795*4882a593Smuzhiyun static u8 hdmi_infoframe_checksum(u8 *ptr, size_t size)
5796*4882a593Smuzhiyun {
5797*4882a593Smuzhiyun 	u8 csum = 0;
5798*4882a593Smuzhiyun 	size_t i;
5799*4882a593Smuzhiyun 
5800*4882a593Smuzhiyun 	/* compute checksum */
5801*4882a593Smuzhiyun 	for (i = 0; i < size; i++)
5802*4882a593Smuzhiyun 		csum += ptr[i];
5803*4882a593Smuzhiyun 
5804*4882a593Smuzhiyun 	return 256 - csum;
5805*4882a593Smuzhiyun }
5806*4882a593Smuzhiyun 
hdmi_infoframe_set_checksum(void * buffer,size_t size)5807*4882a593Smuzhiyun static void hdmi_infoframe_set_checksum(void *buffer, size_t size)
5808*4882a593Smuzhiyun {
5809*4882a593Smuzhiyun 	u8 *ptr = buffer;
5810*4882a593Smuzhiyun 
5811*4882a593Smuzhiyun 	ptr[3] = hdmi_infoframe_checksum(buffer, size);
5812*4882a593Smuzhiyun }
5813*4882a593Smuzhiyun 
5814*4882a593Smuzhiyun /**
5815*4882a593Smuzhiyun  * hdmi_avi_infoframe_init() - initialize an HDMI AVI infoframe
5816*4882a593Smuzhiyun  * @frame: HDMI AVI infoframe
5817*4882a593Smuzhiyun  *
5818*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
5819*4882a593Smuzhiyun  */
hdmi_avi_infoframe_init(struct hdmi_avi_infoframe * frame)5820*4882a593Smuzhiyun int hdmi_avi_infoframe_init(struct hdmi_avi_infoframe *frame)
5821*4882a593Smuzhiyun {
5822*4882a593Smuzhiyun 	memset(frame, 0, sizeof(*frame));
5823*4882a593Smuzhiyun 
5824*4882a593Smuzhiyun 	frame->type = HDMI_INFOFRAME_TYPE_AVI;
5825*4882a593Smuzhiyun 	frame->version = 2;
5826*4882a593Smuzhiyun 	frame->length = HDMI_AVI_INFOFRAME_SIZE;
5827*4882a593Smuzhiyun 
5828*4882a593Smuzhiyun 	return 0;
5829*4882a593Smuzhiyun }
5830*4882a593Smuzhiyun EXPORT_SYMBOL(hdmi_avi_infoframe_init);
5831*4882a593Smuzhiyun 
5832*4882a593Smuzhiyun /**
5833*4882a593Smuzhiyun  * hdmi_avi_infoframe_pack() - write HDMI AVI infoframe to binary buffer
5834*4882a593Smuzhiyun  * @frame: HDMI AVI infoframe
5835*4882a593Smuzhiyun  * @buffer: destination buffer
5836*4882a593Smuzhiyun  * @size: size of buffer
5837*4882a593Smuzhiyun  *
5838*4882a593Smuzhiyun  * Packs the information contained in the @frame structure into a binary
5839*4882a593Smuzhiyun  * representation that can be written into the corresponding controller
5840*4882a593Smuzhiyun  * registers. Also computes the checksum as required by section 5.3.5 of
5841*4882a593Smuzhiyun  * the HDMI 1.4 specification.
5842*4882a593Smuzhiyun  *
5843*4882a593Smuzhiyun  * Returns the number of bytes packed into the binary buffer or a negative
5844*4882a593Smuzhiyun  * error code on failure.
5845*4882a593Smuzhiyun  */
hdmi_avi_infoframe_pack(struct hdmi_avi_infoframe * frame,void * buffer,size_t size)5846*4882a593Smuzhiyun ssize_t hdmi_avi_infoframe_pack(struct hdmi_avi_infoframe *frame, void *buffer,
5847*4882a593Smuzhiyun 				size_t size)
5848*4882a593Smuzhiyun {
5849*4882a593Smuzhiyun 	u8 *ptr = buffer;
5850*4882a593Smuzhiyun 	size_t length;
5851*4882a593Smuzhiyun 
5852*4882a593Smuzhiyun 	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
5853*4882a593Smuzhiyun 
5854*4882a593Smuzhiyun 	if (size < length)
5855*4882a593Smuzhiyun 		return -ENOSPC;
5856*4882a593Smuzhiyun 
5857*4882a593Smuzhiyun 	memset(buffer, 0, size);
5858*4882a593Smuzhiyun 
5859*4882a593Smuzhiyun 	ptr[0] = frame->type;
5860*4882a593Smuzhiyun 	ptr[1] = frame->version;
5861*4882a593Smuzhiyun 	ptr[2] = frame->length;
5862*4882a593Smuzhiyun 	ptr[3] = 0; /* checksum */
5863*4882a593Smuzhiyun 
5864*4882a593Smuzhiyun 	/* start infoframe payload */
5865*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
5866*4882a593Smuzhiyun 
5867*4882a593Smuzhiyun 	ptr[0] = ((frame->colorspace & 0x3) << 5) | (frame->scan_mode & 0x3);
5868*4882a593Smuzhiyun 
5869*4882a593Smuzhiyun 	/*
5870*4882a593Smuzhiyun 	 * Data byte 1, bit 4 has to be set if we provide the active format
5871*4882a593Smuzhiyun 	 * aspect ratio
5872*4882a593Smuzhiyun 	 */
5873*4882a593Smuzhiyun 	if (frame->active_aspect & 0xf)
5874*4882a593Smuzhiyun 		ptr[0] |= BIT(4);
5875*4882a593Smuzhiyun 
5876*4882a593Smuzhiyun 	/* Bit 3 and 2 indicate if we transmit horizontal/vertical bar data */
5877*4882a593Smuzhiyun 	if (frame->top_bar || frame->bottom_bar)
5878*4882a593Smuzhiyun 		ptr[0] |= BIT(3);
5879*4882a593Smuzhiyun 
5880*4882a593Smuzhiyun 	if (frame->left_bar || frame->right_bar)
5881*4882a593Smuzhiyun 		ptr[0] |= BIT(2);
5882*4882a593Smuzhiyun 
5883*4882a593Smuzhiyun 	ptr[1] = ((frame->colorimetry & 0x3) << 6) |
5884*4882a593Smuzhiyun 		 ((frame->picture_aspect & 0x3) << 4) |
5885*4882a593Smuzhiyun 		 (frame->active_aspect & 0xf);
5886*4882a593Smuzhiyun 
5887*4882a593Smuzhiyun 	ptr[2] = ((frame->extended_colorimetry & 0x7) << 4) |
5888*4882a593Smuzhiyun 		 ((frame->quantization_range & 0x3) << 2) |
5889*4882a593Smuzhiyun 		 (frame->nups & 0x3);
5890*4882a593Smuzhiyun 
5891*4882a593Smuzhiyun 	if (frame->itc)
5892*4882a593Smuzhiyun 		ptr[2] |= BIT(7);
5893*4882a593Smuzhiyun 
5894*4882a593Smuzhiyun 	ptr[3] = frame->video_code & 0x7f;
5895*4882a593Smuzhiyun 
5896*4882a593Smuzhiyun 	ptr[4] = ((frame->ycc_quantization_range & 0x3) << 6) |
5897*4882a593Smuzhiyun 		 ((frame->content_type & 0x3) << 4) |
5898*4882a593Smuzhiyun 		 (frame->pixel_repeat & 0xf);
5899*4882a593Smuzhiyun 
5900*4882a593Smuzhiyun 	ptr[5] = frame->top_bar & 0xff;
5901*4882a593Smuzhiyun 	ptr[6] = (frame->top_bar >> 8) & 0xff;
5902*4882a593Smuzhiyun 	ptr[7] = frame->bottom_bar & 0xff;
5903*4882a593Smuzhiyun 	ptr[8] = (frame->bottom_bar >> 8) & 0xff;
5904*4882a593Smuzhiyun 	ptr[9] = frame->left_bar & 0xff;
5905*4882a593Smuzhiyun 	ptr[10] = (frame->left_bar >> 8) & 0xff;
5906*4882a593Smuzhiyun 	ptr[11] = frame->right_bar & 0xff;
5907*4882a593Smuzhiyun 	ptr[12] = (frame->right_bar >> 8) & 0xff;
5908*4882a593Smuzhiyun 
5909*4882a593Smuzhiyun 	hdmi_infoframe_set_checksum(buffer, length);
5910*4882a593Smuzhiyun 
5911*4882a593Smuzhiyun 	return length;
5912*4882a593Smuzhiyun }
5913*4882a593Smuzhiyun EXPORT_SYMBOL(hdmi_avi_infoframe_pack);
5914*4882a593Smuzhiyun 
hdmi_avi_infoframe_check_only(const struct hdmi_avi_infoframe * frame)5915*4882a593Smuzhiyun static int hdmi_avi_infoframe_check_only(const struct hdmi_avi_infoframe *frame)
5916*4882a593Smuzhiyun {
5917*4882a593Smuzhiyun 	if (frame->type != HDMI_INFOFRAME_TYPE_AVI ||
5918*4882a593Smuzhiyun 	    frame->version != 2 ||
5919*4882a593Smuzhiyun 	    frame->length != HDMI_AVI_INFOFRAME_SIZE)
5920*4882a593Smuzhiyun 		return -EINVAL;
5921*4882a593Smuzhiyun 
5922*4882a593Smuzhiyun 	if (frame->picture_aspect > HDMI_PICTURE_ASPECT_16_9)
5923*4882a593Smuzhiyun 		return -EINVAL;
5924*4882a593Smuzhiyun 
5925*4882a593Smuzhiyun 	return 0;
5926*4882a593Smuzhiyun }
5927*4882a593Smuzhiyun 
5928*4882a593Smuzhiyun /**
5929*4882a593Smuzhiyun  * hdmi_avi_infoframe_check() - check a HDMI AVI infoframe
5930*4882a593Smuzhiyun  * @frame: HDMI AVI infoframe
5931*4882a593Smuzhiyun  *
5932*4882a593Smuzhiyun  * Validates that the infoframe is consistent and updates derived fields
5933*4882a593Smuzhiyun  * (eg. length) based on other fields.
5934*4882a593Smuzhiyun  *
5935*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
5936*4882a593Smuzhiyun  */
hdmi_avi_infoframe_check(struct hdmi_avi_infoframe * frame)5937*4882a593Smuzhiyun int hdmi_avi_infoframe_check(struct hdmi_avi_infoframe *frame)
5938*4882a593Smuzhiyun {
5939*4882a593Smuzhiyun 	return hdmi_avi_infoframe_check_only(frame);
5940*4882a593Smuzhiyun }
5941*4882a593Smuzhiyun EXPORT_SYMBOL(hdmi_avi_infoframe_check);
5942*4882a593Smuzhiyun 
5943*4882a593Smuzhiyun /**
5944*4882a593Smuzhiyun  * hdmi_avi_infoframe_pack_only() - write HDMI AVI infoframe to binary buffer
5945*4882a593Smuzhiyun  * @frame: HDMI AVI infoframe
5946*4882a593Smuzhiyun  * @buffer: destination buffer
5947*4882a593Smuzhiyun  * @size: size of buffer
5948*4882a593Smuzhiyun  *
5949*4882a593Smuzhiyun  * Packs the information contained in the @frame structure into a binary
5950*4882a593Smuzhiyun  * representation that can be written into the corresponding controller
5951*4882a593Smuzhiyun  * registers. Also computes the checksum as required by section 5.3.5 of
5952*4882a593Smuzhiyun  * the HDMI 1.4 specification.
5953*4882a593Smuzhiyun  *
5954*4882a593Smuzhiyun  * Returns the number of bytes packed into the binary buffer or a negative
5955*4882a593Smuzhiyun  * error code on failure.
5956*4882a593Smuzhiyun  */
hdmi_avi_infoframe_pack_only(const struct hdmi_avi_infoframe * frame,void * buffer,size_t size)5957*4882a593Smuzhiyun ssize_t hdmi_avi_infoframe_pack_only(const struct hdmi_avi_infoframe *frame,
5958*4882a593Smuzhiyun 				     void *buffer, size_t size)
5959*4882a593Smuzhiyun {
5960*4882a593Smuzhiyun 	u8 *ptr = buffer;
5961*4882a593Smuzhiyun 	size_t length;
5962*4882a593Smuzhiyun 	int ret;
5963*4882a593Smuzhiyun 
5964*4882a593Smuzhiyun 	ret = hdmi_avi_infoframe_check_only(frame);
5965*4882a593Smuzhiyun 	if (ret)
5966*4882a593Smuzhiyun 		return ret;
5967*4882a593Smuzhiyun 
5968*4882a593Smuzhiyun 	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
5969*4882a593Smuzhiyun 
5970*4882a593Smuzhiyun 	if (size < length)
5971*4882a593Smuzhiyun 		return -ENOSPC;
5972*4882a593Smuzhiyun 
5973*4882a593Smuzhiyun 	memset(buffer, 0, size);
5974*4882a593Smuzhiyun 
5975*4882a593Smuzhiyun 	ptr[0] = frame->type;
5976*4882a593Smuzhiyun 	ptr[1] = frame->version;
5977*4882a593Smuzhiyun 	ptr[2] = frame->length;
5978*4882a593Smuzhiyun 	ptr[3] = 0; /* checksum */
5979*4882a593Smuzhiyun 
5980*4882a593Smuzhiyun 	/* start infoframe payload */
5981*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
5982*4882a593Smuzhiyun 
5983*4882a593Smuzhiyun 	ptr[0] = ((frame->colorspace & 0x3) << 5) | (frame->scan_mode & 0x3);
5984*4882a593Smuzhiyun 
5985*4882a593Smuzhiyun 	/*
5986*4882a593Smuzhiyun 	 * Data byte 1, bit 4 has to be set if we provide the active format
5987*4882a593Smuzhiyun 	 * aspect ratio
5988*4882a593Smuzhiyun 	 */
5989*4882a593Smuzhiyun 	if (frame->active_aspect & 0xf)
5990*4882a593Smuzhiyun 		ptr[0] |= BIT(4);
5991*4882a593Smuzhiyun 
5992*4882a593Smuzhiyun 	/* Bit 3 and 2 indicate if we transmit horizontal/vertical bar data */
5993*4882a593Smuzhiyun 	if (frame->top_bar || frame->bottom_bar)
5994*4882a593Smuzhiyun 		ptr[0] |= BIT(3);
5995*4882a593Smuzhiyun 
5996*4882a593Smuzhiyun 	if (frame->left_bar || frame->right_bar)
5997*4882a593Smuzhiyun 		ptr[0] |= BIT(2);
5998*4882a593Smuzhiyun 
5999*4882a593Smuzhiyun 	ptr[1] = ((frame->colorimetry & 0x3) << 6) |
6000*4882a593Smuzhiyun 		 ((frame->picture_aspect & 0x3) << 4) |
6001*4882a593Smuzhiyun 		 (frame->active_aspect & 0xf);
6002*4882a593Smuzhiyun 
6003*4882a593Smuzhiyun 	ptr[2] = ((frame->extended_colorimetry & 0x7) << 4) |
6004*4882a593Smuzhiyun 		 ((frame->quantization_range & 0x3) << 2) |
6005*4882a593Smuzhiyun 		 (frame->nups & 0x3);
6006*4882a593Smuzhiyun 
6007*4882a593Smuzhiyun 	if (frame->itc)
6008*4882a593Smuzhiyun 		ptr[2] |= BIT(7);
6009*4882a593Smuzhiyun 
6010*4882a593Smuzhiyun 	ptr[3] = frame->video_code & 0xff;
6011*4882a593Smuzhiyun 
6012*4882a593Smuzhiyun 	ptr[4] = ((frame->ycc_quantization_range & 0x3) << 6) |
6013*4882a593Smuzhiyun 		 ((frame->content_type & 0x3) << 4) |
6014*4882a593Smuzhiyun 		 (frame->pixel_repeat & 0xf);
6015*4882a593Smuzhiyun 
6016*4882a593Smuzhiyun 	ptr[5] = frame->top_bar & 0xff;
6017*4882a593Smuzhiyun 	ptr[6] = (frame->top_bar >> 8) & 0xff;
6018*4882a593Smuzhiyun 	ptr[7] = frame->bottom_bar & 0xff;
6019*4882a593Smuzhiyun 	ptr[8] = (frame->bottom_bar >> 8) & 0xff;
6020*4882a593Smuzhiyun 	ptr[9] = frame->left_bar & 0xff;
6021*4882a593Smuzhiyun 	ptr[10] = (frame->left_bar >> 8) & 0xff;
6022*4882a593Smuzhiyun 	ptr[11] = frame->right_bar & 0xff;
6023*4882a593Smuzhiyun 	ptr[12] = (frame->right_bar >> 8) & 0xff;
6024*4882a593Smuzhiyun 
6025*4882a593Smuzhiyun 	hdmi_infoframe_set_checksum(buffer, length);
6026*4882a593Smuzhiyun 
6027*4882a593Smuzhiyun 	return length;
6028*4882a593Smuzhiyun }
6029*4882a593Smuzhiyun EXPORT_SYMBOL(hdmi_avi_infoframe_pack_only);
6030*4882a593Smuzhiyun 
6031*4882a593Smuzhiyun /**
6032*4882a593Smuzhiyun  * hdmi_spd_infoframe_init() - initialize an HDMI SPD infoframe
6033*4882a593Smuzhiyun  * @frame: HDMI SPD infoframe
6034*4882a593Smuzhiyun  * @vendor: vendor string
6035*4882a593Smuzhiyun  * @product: product string
6036*4882a593Smuzhiyun  *
6037*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6038*4882a593Smuzhiyun  */
hdmi_spd_infoframe_init(struct hdmi_spd_infoframe * frame,const char * vendor,const char * product)6039*4882a593Smuzhiyun int hdmi_spd_infoframe_init(struct hdmi_spd_infoframe *frame,
6040*4882a593Smuzhiyun 			    const char *vendor, const char *product)
6041*4882a593Smuzhiyun {
6042*4882a593Smuzhiyun 	memset(frame, 0, sizeof(*frame));
6043*4882a593Smuzhiyun 
6044*4882a593Smuzhiyun 	frame->type = HDMI_INFOFRAME_TYPE_SPD;
6045*4882a593Smuzhiyun 	frame->version = 1;
6046*4882a593Smuzhiyun 	frame->length = HDMI_SPD_INFOFRAME_SIZE;
6047*4882a593Smuzhiyun 
6048*4882a593Smuzhiyun 	strncpy(frame->vendor, vendor, sizeof(frame->vendor));
6049*4882a593Smuzhiyun 	strncpy(frame->product, product, sizeof(frame->product));
6050*4882a593Smuzhiyun 
6051*4882a593Smuzhiyun 	return 0;
6052*4882a593Smuzhiyun }
6053*4882a593Smuzhiyun EXPORT_SYMBOL(hdmi_spd_infoframe_init);
6054*4882a593Smuzhiyun 
6055*4882a593Smuzhiyun /**
6056*4882a593Smuzhiyun  * hdmi_spd_infoframe_pack() - write HDMI SPD infoframe to binary buffer
6057*4882a593Smuzhiyun  * @frame: HDMI SPD infoframe
6058*4882a593Smuzhiyun  * @buffer: destination buffer
6059*4882a593Smuzhiyun  * @size: size of buffer
6060*4882a593Smuzhiyun  *
6061*4882a593Smuzhiyun  * Packs the information contained in the @frame structure into a binary
6062*4882a593Smuzhiyun  * representation that can be written into the corresponding controller
6063*4882a593Smuzhiyun  * registers. Also computes the checksum as required by section 5.3.5 of
6064*4882a593Smuzhiyun  * the HDMI 1.4 specification.
6065*4882a593Smuzhiyun  *
6066*4882a593Smuzhiyun  * Returns the number of bytes packed into the binary buffer or a negative
6067*4882a593Smuzhiyun  * error code on failure.
6068*4882a593Smuzhiyun  */
hdmi_spd_infoframe_pack(struct hdmi_spd_infoframe * frame,void * buffer,size_t size)6069*4882a593Smuzhiyun ssize_t hdmi_spd_infoframe_pack(struct hdmi_spd_infoframe *frame, void *buffer,
6070*4882a593Smuzhiyun 				size_t size)
6071*4882a593Smuzhiyun {
6072*4882a593Smuzhiyun 	u8 *ptr = buffer;
6073*4882a593Smuzhiyun 	size_t length;
6074*4882a593Smuzhiyun 
6075*4882a593Smuzhiyun 	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
6076*4882a593Smuzhiyun 
6077*4882a593Smuzhiyun 	if (size < length)
6078*4882a593Smuzhiyun 		return -ENOSPC;
6079*4882a593Smuzhiyun 
6080*4882a593Smuzhiyun 	memset(buffer, 0, size);
6081*4882a593Smuzhiyun 
6082*4882a593Smuzhiyun 	ptr[0] = frame->type;
6083*4882a593Smuzhiyun 	ptr[1] = frame->version;
6084*4882a593Smuzhiyun 	ptr[2] = frame->length;
6085*4882a593Smuzhiyun 	ptr[3] = 0; /* checksum */
6086*4882a593Smuzhiyun 
6087*4882a593Smuzhiyun 	/* start infoframe payload */
6088*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
6089*4882a593Smuzhiyun 
6090*4882a593Smuzhiyun 	memcpy(ptr, frame->vendor, sizeof(frame->vendor));
6091*4882a593Smuzhiyun 	memcpy(ptr + 8, frame->product, sizeof(frame->product));
6092*4882a593Smuzhiyun 
6093*4882a593Smuzhiyun 	ptr[24] = frame->sdi;
6094*4882a593Smuzhiyun 
6095*4882a593Smuzhiyun 	hdmi_infoframe_set_checksum(buffer, length);
6096*4882a593Smuzhiyun 
6097*4882a593Smuzhiyun 	return length;
6098*4882a593Smuzhiyun }
6099*4882a593Smuzhiyun EXPORT_SYMBOL(hdmi_spd_infoframe_pack);
6100*4882a593Smuzhiyun 
6101*4882a593Smuzhiyun /**
6102*4882a593Smuzhiyun  * hdmi_audio_infoframe_init() - initialize an HDMI audio infoframe
6103*4882a593Smuzhiyun  * @frame: HDMI audio infoframe
6104*4882a593Smuzhiyun  *
6105*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6106*4882a593Smuzhiyun  */
hdmi_audio_infoframe_init(struct hdmi_audio_infoframe * frame)6107*4882a593Smuzhiyun int hdmi_audio_infoframe_init(struct hdmi_audio_infoframe *frame)
6108*4882a593Smuzhiyun {
6109*4882a593Smuzhiyun 	memset(frame, 0, sizeof(*frame));
6110*4882a593Smuzhiyun 
6111*4882a593Smuzhiyun 	frame->type = HDMI_INFOFRAME_TYPE_AUDIO;
6112*4882a593Smuzhiyun 	frame->version = 1;
6113*4882a593Smuzhiyun 	frame->length = HDMI_AUDIO_INFOFRAME_SIZE;
6114*4882a593Smuzhiyun 
6115*4882a593Smuzhiyun 	return 0;
6116*4882a593Smuzhiyun }
6117*4882a593Smuzhiyun 
6118*4882a593Smuzhiyun /**
6119*4882a593Smuzhiyun  * hdmi_audio_infoframe_pack() - write HDMI audio infoframe to binary buffer
6120*4882a593Smuzhiyun  * @frame: HDMI audio infoframe
6121*4882a593Smuzhiyun  * @buffer: destination buffer
6122*4882a593Smuzhiyun  * @size: size of buffer
6123*4882a593Smuzhiyun  *
6124*4882a593Smuzhiyun  * Packs the information contained in the @frame structure into a binary
6125*4882a593Smuzhiyun  * representation that can be written into the corresponding controller
6126*4882a593Smuzhiyun  * registers. Also computes the checksum as required by section 5.3.5 of
6127*4882a593Smuzhiyun  * the HDMI 1.4 specification.
6128*4882a593Smuzhiyun  *
6129*4882a593Smuzhiyun  * Returns the number of bytes packed into the binary buffer or a negative
6130*4882a593Smuzhiyun  * error code on failure.
6131*4882a593Smuzhiyun  */
hdmi_audio_infoframe_pack(struct hdmi_audio_infoframe * frame,void * buffer,size_t size)6132*4882a593Smuzhiyun ssize_t hdmi_audio_infoframe_pack(struct hdmi_audio_infoframe *frame,
6133*4882a593Smuzhiyun 				  void *buffer, size_t size)
6134*4882a593Smuzhiyun {
6135*4882a593Smuzhiyun 	unsigned char channels;
6136*4882a593Smuzhiyun 	char *ptr = buffer;
6137*4882a593Smuzhiyun 	size_t length;
6138*4882a593Smuzhiyun 
6139*4882a593Smuzhiyun 	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
6140*4882a593Smuzhiyun 
6141*4882a593Smuzhiyun 	if (size < length)
6142*4882a593Smuzhiyun 		return -ENOSPC;
6143*4882a593Smuzhiyun 
6144*4882a593Smuzhiyun 	memset(buffer, 0, size);
6145*4882a593Smuzhiyun 
6146*4882a593Smuzhiyun 	if (frame->channels >= 2)
6147*4882a593Smuzhiyun 		channels = frame->channels - 1;
6148*4882a593Smuzhiyun 	else
6149*4882a593Smuzhiyun 		channels = 0;
6150*4882a593Smuzhiyun 
6151*4882a593Smuzhiyun 	ptr[0] = frame->type;
6152*4882a593Smuzhiyun 	ptr[1] = frame->version;
6153*4882a593Smuzhiyun 	ptr[2] = frame->length;
6154*4882a593Smuzhiyun 	ptr[3] = 0; /* checksum */
6155*4882a593Smuzhiyun 
6156*4882a593Smuzhiyun 	/* start infoframe payload */
6157*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
6158*4882a593Smuzhiyun 
6159*4882a593Smuzhiyun 	ptr[0] = ((frame->coding_type & 0xf) << 4) | (channels & 0x7);
6160*4882a593Smuzhiyun 	ptr[1] = ((frame->sample_frequency & 0x7) << 2) |
6161*4882a593Smuzhiyun 		 (frame->sample_size & 0x3);
6162*4882a593Smuzhiyun 	ptr[2] = frame->coding_type_ext & 0x1f;
6163*4882a593Smuzhiyun 	ptr[3] = frame->channel_allocation;
6164*4882a593Smuzhiyun 	ptr[4] = (frame->level_shift_value & 0xf) << 3;
6165*4882a593Smuzhiyun 
6166*4882a593Smuzhiyun 	if (frame->downmix_inhibit)
6167*4882a593Smuzhiyun 		ptr[4] |= BIT(7);
6168*4882a593Smuzhiyun 
6169*4882a593Smuzhiyun 	hdmi_infoframe_set_checksum(buffer, length);
6170*4882a593Smuzhiyun 
6171*4882a593Smuzhiyun 	return length;
6172*4882a593Smuzhiyun }
6173*4882a593Smuzhiyun 
6174*4882a593Smuzhiyun /**
6175*4882a593Smuzhiyun  * hdmi_vendor_infoframe_pack() - write a HDMI vendor infoframe to binary buffer
6176*4882a593Smuzhiyun  * @frame: HDMI infoframe
6177*4882a593Smuzhiyun  * @buffer: destination buffer
6178*4882a593Smuzhiyun  * @size: size of buffer
6179*4882a593Smuzhiyun  *
6180*4882a593Smuzhiyun  * Packs the information contained in the @frame structure into a binary
6181*4882a593Smuzhiyun  * representation that can be written into the corresponding controller
6182*4882a593Smuzhiyun  * registers. Also computes the checksum as required by section 5.3.5 of
6183*4882a593Smuzhiyun  * the HDMI 1.4 specification.
6184*4882a593Smuzhiyun  *
6185*4882a593Smuzhiyun  * Returns the number of bytes packed into the binary buffer or a negative
6186*4882a593Smuzhiyun  * error code on failure.
6187*4882a593Smuzhiyun  */
hdmi_vendor_infoframe_pack(struct hdmi_vendor_infoframe * frame,void * buffer,size_t size)6188*4882a593Smuzhiyun ssize_t hdmi_vendor_infoframe_pack(struct hdmi_vendor_infoframe *frame,
6189*4882a593Smuzhiyun 				   void *buffer, size_t size)
6190*4882a593Smuzhiyun {
6191*4882a593Smuzhiyun 	char *ptr = buffer;
6192*4882a593Smuzhiyun 	size_t length;
6193*4882a593Smuzhiyun 
6194*4882a593Smuzhiyun 	/* empty info frame */
6195*4882a593Smuzhiyun 	if (frame->vic == 0 && frame->s3d_struct == HDMI_3D_STRUCTURE_INVALID)
6196*4882a593Smuzhiyun 		return -EINVAL;
6197*4882a593Smuzhiyun 
6198*4882a593Smuzhiyun 	/* only one of those can be supplied */
6199*4882a593Smuzhiyun 	if (frame->vic != 0 && frame->s3d_struct != HDMI_3D_STRUCTURE_INVALID)
6200*4882a593Smuzhiyun 		return -EINVAL;
6201*4882a593Smuzhiyun 
6202*4882a593Smuzhiyun 	/* for side by side (half) we also need to provide 3D_Ext_Data */
6203*4882a593Smuzhiyun 	if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
6204*4882a593Smuzhiyun 		frame->length = 6;
6205*4882a593Smuzhiyun 	else
6206*4882a593Smuzhiyun 		frame->length = 5;
6207*4882a593Smuzhiyun 
6208*4882a593Smuzhiyun 	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
6209*4882a593Smuzhiyun 
6210*4882a593Smuzhiyun 	if (size < length)
6211*4882a593Smuzhiyun 		return -ENOSPC;
6212*4882a593Smuzhiyun 
6213*4882a593Smuzhiyun 	memset(buffer, 0, size);
6214*4882a593Smuzhiyun 
6215*4882a593Smuzhiyun 	ptr[0] = frame->type;
6216*4882a593Smuzhiyun 	ptr[1] = frame->version;
6217*4882a593Smuzhiyun 	ptr[2] = frame->length;
6218*4882a593Smuzhiyun 	ptr[3] = 0; /* checksum */
6219*4882a593Smuzhiyun 
6220*4882a593Smuzhiyun 	/* HDMI OUI */
6221*4882a593Smuzhiyun 	ptr[4] = 0x03;
6222*4882a593Smuzhiyun 	ptr[5] = 0x0c;
6223*4882a593Smuzhiyun 	ptr[6] = 0x00;
6224*4882a593Smuzhiyun 
6225*4882a593Smuzhiyun 	if (frame->vic) {
6226*4882a593Smuzhiyun 		ptr[7] = 0x1 << 5;	/* video format */
6227*4882a593Smuzhiyun 		ptr[8] = frame->vic;
6228*4882a593Smuzhiyun 	} else {
6229*4882a593Smuzhiyun 		ptr[7] = 0x2 << 5;	/* video format */
6230*4882a593Smuzhiyun 		ptr[8] = (frame->s3d_struct & 0xf) << 4;
6231*4882a593Smuzhiyun 		if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
6232*4882a593Smuzhiyun 			ptr[9] = (frame->s3d_ext_data & 0xf) << 4;
6233*4882a593Smuzhiyun 	}
6234*4882a593Smuzhiyun 
6235*4882a593Smuzhiyun 	hdmi_infoframe_set_checksum(buffer, length);
6236*4882a593Smuzhiyun 
6237*4882a593Smuzhiyun 	return length;
6238*4882a593Smuzhiyun }
6239*4882a593Smuzhiyun 
6240*4882a593Smuzhiyun /**
6241*4882a593Smuzhiyun  * hdmi_drm_infoframe_init() - initialize an HDMI Dynaminc Range and
6242*4882a593Smuzhiyun  * mastering infoframe
6243*4882a593Smuzhiyun  * @frame: HDMI DRM infoframe
6244*4882a593Smuzhiyun  *
6245*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6246*4882a593Smuzhiyun  */
hdmi_drm_infoframe_init(struct hdmi_drm_infoframe * frame)6247*4882a593Smuzhiyun int hdmi_drm_infoframe_init(struct hdmi_drm_infoframe *frame)
6248*4882a593Smuzhiyun {
6249*4882a593Smuzhiyun 	memset(frame, 0, sizeof(*frame));
6250*4882a593Smuzhiyun 
6251*4882a593Smuzhiyun 	frame->type = HDMI_INFOFRAME_TYPE_DRM;
6252*4882a593Smuzhiyun 	frame->version = 1;
6253*4882a593Smuzhiyun 
6254*4882a593Smuzhiyun 	return 0;
6255*4882a593Smuzhiyun }
6256*4882a593Smuzhiyun 
6257*4882a593Smuzhiyun /**
6258*4882a593Smuzhiyun  * hdmi_drm_infoframe_pack() - write HDMI DRM infoframe to binary buffer
6259*4882a593Smuzhiyun  * @frame: HDMI DRM infoframe
6260*4882a593Smuzhiyun  * @buffer: destination buffer
6261*4882a593Smuzhiyun  * @size: size of buffer
6262*4882a593Smuzhiyun  *
6263*4882a593Smuzhiyun  * Packs the information contained in the @frame structure into a binary
6264*4882a593Smuzhiyun  * representation that can be written into the corresponding controller
6265*4882a593Smuzhiyun  * registers. Also computes the checksum as required by section 5.3.5 of
6266*4882a593Smuzhiyun  * the HDMI 1.4 specification.
6267*4882a593Smuzhiyun  *
6268*4882a593Smuzhiyun  * Returns the number of bytes packed into the binary buffer or a negative
6269*4882a593Smuzhiyun  * error code on failure.
6270*4882a593Smuzhiyun  */
hdmi_drm_infoframe_pack(struct hdmi_drm_infoframe * frame,void * buffer,size_t size)6271*4882a593Smuzhiyun ssize_t hdmi_drm_infoframe_pack(struct hdmi_drm_infoframe *frame, void *buffer,
6272*4882a593Smuzhiyun 				size_t size)
6273*4882a593Smuzhiyun {
6274*4882a593Smuzhiyun 	u8 *ptr = buffer;
6275*4882a593Smuzhiyun 	size_t length;
6276*4882a593Smuzhiyun 
6277*4882a593Smuzhiyun 	length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
6278*4882a593Smuzhiyun 
6279*4882a593Smuzhiyun 	if (size < length)
6280*4882a593Smuzhiyun 		return -ENOSPC;
6281*4882a593Smuzhiyun 
6282*4882a593Smuzhiyun 	memset(buffer, 0, size);
6283*4882a593Smuzhiyun 
6284*4882a593Smuzhiyun 	ptr[0] = frame->type;
6285*4882a593Smuzhiyun 	ptr[1] = frame->version;
6286*4882a593Smuzhiyun 	ptr[2] = frame->length;
6287*4882a593Smuzhiyun 	ptr[3] = 0; /* checksum */
6288*4882a593Smuzhiyun 
6289*4882a593Smuzhiyun 	/* start infoframe payload */
6290*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
6291*4882a593Smuzhiyun 
6292*4882a593Smuzhiyun 	ptr[0] = frame->eotf;
6293*4882a593Smuzhiyun 	ptr[1] = frame->metadata_type;
6294*4882a593Smuzhiyun 
6295*4882a593Smuzhiyun 	ptr[2] = frame->display_primaries_x[0] & 0xff;
6296*4882a593Smuzhiyun 	ptr[3] = frame->display_primaries_x[0] >> 8;
6297*4882a593Smuzhiyun 
6298*4882a593Smuzhiyun 	ptr[4] = frame->display_primaries_x[1] & 0xff;
6299*4882a593Smuzhiyun 	ptr[5] = frame->display_primaries_x[1] >> 8;
6300*4882a593Smuzhiyun 
6301*4882a593Smuzhiyun 	ptr[6] = frame->display_primaries_x[2] & 0xff;
6302*4882a593Smuzhiyun 	ptr[7] = frame->display_primaries_x[2] >> 8;
6303*4882a593Smuzhiyun 
6304*4882a593Smuzhiyun 	ptr[9] = frame->display_primaries_y[0] & 0xff;
6305*4882a593Smuzhiyun 	ptr[10] = frame->display_primaries_y[0] >> 8;
6306*4882a593Smuzhiyun 
6307*4882a593Smuzhiyun 	ptr[11] = frame->display_primaries_y[1] & 0xff;
6308*4882a593Smuzhiyun 	ptr[12] = frame->display_primaries_y[1] >> 8;
6309*4882a593Smuzhiyun 
6310*4882a593Smuzhiyun 	ptr[13] = frame->display_primaries_y[2] & 0xff;
6311*4882a593Smuzhiyun 	ptr[14] = frame->display_primaries_y[2] >> 8;
6312*4882a593Smuzhiyun 
6313*4882a593Smuzhiyun 	ptr[15] = frame->white_point_x & 0xff;
6314*4882a593Smuzhiyun 	ptr[16] = frame->white_point_x >> 8;
6315*4882a593Smuzhiyun 
6316*4882a593Smuzhiyun 	ptr[17] = frame->white_point_y & 0xff;
6317*4882a593Smuzhiyun 	ptr[18] = frame->white_point_y >> 8;
6318*4882a593Smuzhiyun 
6319*4882a593Smuzhiyun 	ptr[19] = frame->max_mastering_display_luminance & 0xff;
6320*4882a593Smuzhiyun 	ptr[20] = frame->max_mastering_display_luminance >> 8;
6321*4882a593Smuzhiyun 
6322*4882a593Smuzhiyun 	ptr[21] = frame->min_mastering_display_luminance & 0xff;
6323*4882a593Smuzhiyun 	ptr[22] = frame->min_mastering_display_luminance >> 8;
6324*4882a593Smuzhiyun 
6325*4882a593Smuzhiyun 	ptr[23] = frame->max_cll & 0xff;
6326*4882a593Smuzhiyun 	ptr[24] = frame->max_cll >> 8;
6327*4882a593Smuzhiyun 
6328*4882a593Smuzhiyun 	ptr[25] = frame->max_fall & 0xff;
6329*4882a593Smuzhiyun 	ptr[26] = frame->max_fall >> 8;
6330*4882a593Smuzhiyun 
6331*4882a593Smuzhiyun 	hdmi_infoframe_set_checksum(buffer, length);
6332*4882a593Smuzhiyun 
6333*4882a593Smuzhiyun 	return length;
6334*4882a593Smuzhiyun }
6335*4882a593Smuzhiyun 
6336*4882a593Smuzhiyun /*
6337*4882a593Smuzhiyun  * hdmi_vendor_any_infoframe_pack() - write a vendor infoframe to binary buffer
6338*4882a593Smuzhiyun  */
6339*4882a593Smuzhiyun static ssize_t
hdmi_vendor_any_infoframe_pack(union hdmi_vendor_any_infoframe * frame,void * buffer,size_t size)6340*4882a593Smuzhiyun hdmi_vendor_any_infoframe_pack(union hdmi_vendor_any_infoframe *frame,
6341*4882a593Smuzhiyun 			       void *buffer, size_t size)
6342*4882a593Smuzhiyun {
6343*4882a593Smuzhiyun 	/* we only know about HDMI vendor infoframes */
6344*4882a593Smuzhiyun 	if (frame->any.oui != HDMI_IEEE_OUI)
6345*4882a593Smuzhiyun 		return -EINVAL;
6346*4882a593Smuzhiyun 
6347*4882a593Smuzhiyun 	return hdmi_vendor_infoframe_pack(&frame->hdmi, buffer, size);
6348*4882a593Smuzhiyun }
6349*4882a593Smuzhiyun 
6350*4882a593Smuzhiyun /**
6351*4882a593Smuzhiyun  * hdmi_infoframe_pack() - write a HDMI infoframe to binary buffer
6352*4882a593Smuzhiyun  * @frame: HDMI infoframe
6353*4882a593Smuzhiyun  * @buffer: destination buffer
6354*4882a593Smuzhiyun  * @size: size of buffer
6355*4882a593Smuzhiyun  *
6356*4882a593Smuzhiyun  * Packs the information contained in the @frame structure into a binary
6357*4882a593Smuzhiyun  * representation that can be written into the corresponding controller
6358*4882a593Smuzhiyun  * registers. Also computes the checksum as required by section 5.3.5 of
6359*4882a593Smuzhiyun  * the HDMI 1.4 specification.
6360*4882a593Smuzhiyun  *
6361*4882a593Smuzhiyun  * Returns the number of bytes packed into the binary buffer or a negative
6362*4882a593Smuzhiyun  * error code on failure.
6363*4882a593Smuzhiyun  */
6364*4882a593Smuzhiyun ssize_t
hdmi_infoframe_pack(union hdmi_infoframe * frame,void * buffer,size_t size)6365*4882a593Smuzhiyun hdmi_infoframe_pack(union hdmi_infoframe *frame, void *buffer, size_t size)
6366*4882a593Smuzhiyun {
6367*4882a593Smuzhiyun 	ssize_t length;
6368*4882a593Smuzhiyun 
6369*4882a593Smuzhiyun 	switch (frame->any.type) {
6370*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_AVI:
6371*4882a593Smuzhiyun 		length = hdmi_avi_infoframe_pack(&frame->avi, buffer, size);
6372*4882a593Smuzhiyun 		break;
6373*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_DRM:
6374*4882a593Smuzhiyun 		length = hdmi_drm_infoframe_pack(&frame->drm, buffer, size);
6375*4882a593Smuzhiyun 		break;
6376*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_SPD:
6377*4882a593Smuzhiyun 		length = hdmi_spd_infoframe_pack(&frame->spd, buffer, size);
6378*4882a593Smuzhiyun 		break;
6379*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_AUDIO:
6380*4882a593Smuzhiyun 		length = hdmi_audio_infoframe_pack(&frame->audio, buffer, size);
6381*4882a593Smuzhiyun 		break;
6382*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_VENDOR:
6383*4882a593Smuzhiyun 		length = hdmi_vendor_any_infoframe_pack(&frame->vendor,
6384*4882a593Smuzhiyun 							buffer, size);
6385*4882a593Smuzhiyun 		break;
6386*4882a593Smuzhiyun 	default:
6387*4882a593Smuzhiyun 		printf("Bad infoframe type %d\n", frame->any.type);
6388*4882a593Smuzhiyun 		length = -EINVAL;
6389*4882a593Smuzhiyun 	}
6390*4882a593Smuzhiyun 
6391*4882a593Smuzhiyun 	return length;
6392*4882a593Smuzhiyun }
6393*4882a593Smuzhiyun 
6394*4882a593Smuzhiyun /**
6395*4882a593Smuzhiyun  * hdmi_avi_infoframe_unpack() - unpack binary buffer to a HDMI AVI infoframe
6396*4882a593Smuzhiyun  * @buffer: source buffer
6397*4882a593Smuzhiyun  * @frame: HDMI AVI infoframe
6398*4882a593Smuzhiyun  *
6399*4882a593Smuzhiyun  * Unpacks the information contained in binary @buffer into a structured
6400*4882a593Smuzhiyun  * @frame of the HDMI Auxiliary Video (AVI) information frame.
6401*4882a593Smuzhiyun  * Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
6402*4882a593Smuzhiyun  * specification.
6403*4882a593Smuzhiyun  *
6404*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6405*4882a593Smuzhiyun  */
hdmi_avi_infoframe_unpack(struct hdmi_avi_infoframe * frame,void * buffer)6406*4882a593Smuzhiyun static int hdmi_avi_infoframe_unpack(struct hdmi_avi_infoframe *frame,
6407*4882a593Smuzhiyun 				     void *buffer)
6408*4882a593Smuzhiyun {
6409*4882a593Smuzhiyun 	u8 *ptr = buffer;
6410*4882a593Smuzhiyun 	int ret;
6411*4882a593Smuzhiyun 
6412*4882a593Smuzhiyun 	if (ptr[0] != HDMI_INFOFRAME_TYPE_AVI ||
6413*4882a593Smuzhiyun 	    ptr[1] != 2 ||
6414*4882a593Smuzhiyun 	    ptr[2] != HDMI_AVI_INFOFRAME_SIZE)
6415*4882a593Smuzhiyun 		return -EINVAL;
6416*4882a593Smuzhiyun 
6417*4882a593Smuzhiyun 	if (hdmi_infoframe_checksum(buffer, HDMI_INFOFRAME_SIZE(AVI)) != 0)
6418*4882a593Smuzhiyun 		return -EINVAL;
6419*4882a593Smuzhiyun 
6420*4882a593Smuzhiyun 	ret = hdmi_avi_infoframe_init(frame);
6421*4882a593Smuzhiyun 	if (ret)
6422*4882a593Smuzhiyun 		return ret;
6423*4882a593Smuzhiyun 
6424*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
6425*4882a593Smuzhiyun 
6426*4882a593Smuzhiyun 	frame->colorspace = (ptr[0] >> 5) & 0x3;
6427*4882a593Smuzhiyun 	if (ptr[0] & 0x10)
6428*4882a593Smuzhiyun 		frame->active_aspect = ptr[1] & 0xf;
6429*4882a593Smuzhiyun 	if (ptr[0] & 0x8) {
6430*4882a593Smuzhiyun 		frame->top_bar = (ptr[5] << 8) + ptr[6];
6431*4882a593Smuzhiyun 		frame->bottom_bar = (ptr[7] << 8) + ptr[8];
6432*4882a593Smuzhiyun 	}
6433*4882a593Smuzhiyun 	if (ptr[0] & 0x4) {
6434*4882a593Smuzhiyun 		frame->left_bar = (ptr[9] << 8) + ptr[10];
6435*4882a593Smuzhiyun 		frame->right_bar = (ptr[11] << 8) + ptr[12];
6436*4882a593Smuzhiyun 	}
6437*4882a593Smuzhiyun 	frame->scan_mode = ptr[0] & 0x3;
6438*4882a593Smuzhiyun 
6439*4882a593Smuzhiyun 	frame->colorimetry = (ptr[1] >> 6) & 0x3;
6440*4882a593Smuzhiyun 	frame->picture_aspect = (ptr[1] >> 4) & 0x3;
6441*4882a593Smuzhiyun 	frame->active_aspect = ptr[1] & 0xf;
6442*4882a593Smuzhiyun 
6443*4882a593Smuzhiyun 	frame->itc = ptr[2] & 0x80 ? true : false;
6444*4882a593Smuzhiyun 	frame->extended_colorimetry = (ptr[2] >> 4) & 0x7;
6445*4882a593Smuzhiyun 	frame->quantization_range = (ptr[2] >> 2) & 0x3;
6446*4882a593Smuzhiyun 	frame->nups = ptr[2] & 0x3;
6447*4882a593Smuzhiyun 
6448*4882a593Smuzhiyun 	frame->video_code = ptr[3] & 0x7f;
6449*4882a593Smuzhiyun 	frame->ycc_quantization_range = (ptr[4] >> 6) & 0x3;
6450*4882a593Smuzhiyun 	frame->content_type = (ptr[4] >> 4) & 0x3;
6451*4882a593Smuzhiyun 
6452*4882a593Smuzhiyun 	frame->pixel_repeat = ptr[4] & 0xf;
6453*4882a593Smuzhiyun 
6454*4882a593Smuzhiyun 	return 0;
6455*4882a593Smuzhiyun }
6456*4882a593Smuzhiyun 
6457*4882a593Smuzhiyun /**
6458*4882a593Smuzhiyun  * hdmi_spd_infoframe_unpack() - unpack binary buffer to a HDMI SPD infoframe
6459*4882a593Smuzhiyun  * @buffer: source buffer
6460*4882a593Smuzhiyun  * @frame: HDMI SPD infoframe
6461*4882a593Smuzhiyun  *
6462*4882a593Smuzhiyun  * Unpacks the information contained in binary @buffer into a structured
6463*4882a593Smuzhiyun  * @frame of the HDMI Source Product Description (SPD) information frame.
6464*4882a593Smuzhiyun  * Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
6465*4882a593Smuzhiyun  * specification.
6466*4882a593Smuzhiyun  *
6467*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6468*4882a593Smuzhiyun  */
hdmi_spd_infoframe_unpack(struct hdmi_spd_infoframe * frame,void * buffer)6469*4882a593Smuzhiyun static int hdmi_spd_infoframe_unpack(struct hdmi_spd_infoframe *frame,
6470*4882a593Smuzhiyun 				     void *buffer)
6471*4882a593Smuzhiyun {
6472*4882a593Smuzhiyun 	char *ptr = buffer;
6473*4882a593Smuzhiyun 	int ret;
6474*4882a593Smuzhiyun 
6475*4882a593Smuzhiyun 	if (ptr[0] != HDMI_INFOFRAME_TYPE_SPD ||
6476*4882a593Smuzhiyun 	    ptr[1] != 1 ||
6477*4882a593Smuzhiyun 	    ptr[2] != HDMI_SPD_INFOFRAME_SIZE) {
6478*4882a593Smuzhiyun 		return -EINVAL;
6479*4882a593Smuzhiyun 	}
6480*4882a593Smuzhiyun 
6481*4882a593Smuzhiyun 	if (hdmi_infoframe_checksum(buffer, HDMI_INFOFRAME_SIZE(SPD)) != 0)
6482*4882a593Smuzhiyun 		return -EINVAL;
6483*4882a593Smuzhiyun 
6484*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
6485*4882a593Smuzhiyun 
6486*4882a593Smuzhiyun 	ret = hdmi_spd_infoframe_init(frame, ptr, ptr + 8);
6487*4882a593Smuzhiyun 	if (ret)
6488*4882a593Smuzhiyun 		return ret;
6489*4882a593Smuzhiyun 
6490*4882a593Smuzhiyun 	frame->sdi = ptr[24];
6491*4882a593Smuzhiyun 
6492*4882a593Smuzhiyun 	return 0;
6493*4882a593Smuzhiyun }
6494*4882a593Smuzhiyun 
6495*4882a593Smuzhiyun /**
6496*4882a593Smuzhiyun  * hdmi_audio_infoframe_unpack() - unpack binary buffer to a HDMI AUDIO infoframe
6497*4882a593Smuzhiyun  * @buffer: source buffer
6498*4882a593Smuzhiyun  * @frame: HDMI Audio infoframe
6499*4882a593Smuzhiyun  *
6500*4882a593Smuzhiyun  * Unpacks the information contained in binary @buffer into a structured
6501*4882a593Smuzhiyun  * @frame of the HDMI Audio information frame.
6502*4882a593Smuzhiyun  * Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
6503*4882a593Smuzhiyun  * specification.
6504*4882a593Smuzhiyun  *
6505*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6506*4882a593Smuzhiyun  */
hdmi_audio_infoframe_unpack(struct hdmi_audio_infoframe * frame,void * buffer)6507*4882a593Smuzhiyun static int hdmi_audio_infoframe_unpack(struct hdmi_audio_infoframe *frame,
6508*4882a593Smuzhiyun 				       void *buffer)
6509*4882a593Smuzhiyun {
6510*4882a593Smuzhiyun 	u8 *ptr = buffer;
6511*4882a593Smuzhiyun 	int ret;
6512*4882a593Smuzhiyun 
6513*4882a593Smuzhiyun 	if (ptr[0] != HDMI_INFOFRAME_TYPE_AUDIO ||
6514*4882a593Smuzhiyun 	    ptr[1] != 1 ||
6515*4882a593Smuzhiyun 	    ptr[2] != HDMI_AUDIO_INFOFRAME_SIZE) {
6516*4882a593Smuzhiyun 		return -EINVAL;
6517*4882a593Smuzhiyun 	}
6518*4882a593Smuzhiyun 
6519*4882a593Smuzhiyun 	if (hdmi_infoframe_checksum(buffer, HDMI_INFOFRAME_SIZE(AUDIO)) != 0)
6520*4882a593Smuzhiyun 		return -EINVAL;
6521*4882a593Smuzhiyun 
6522*4882a593Smuzhiyun 	ret = hdmi_audio_infoframe_init(frame);
6523*4882a593Smuzhiyun 	if (ret)
6524*4882a593Smuzhiyun 		return ret;
6525*4882a593Smuzhiyun 
6526*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
6527*4882a593Smuzhiyun 
6528*4882a593Smuzhiyun 	frame->channels = ptr[0] & 0x7;
6529*4882a593Smuzhiyun 	frame->coding_type = (ptr[0] >> 4) & 0xf;
6530*4882a593Smuzhiyun 	frame->sample_size = ptr[1] & 0x3;
6531*4882a593Smuzhiyun 	frame->sample_frequency = (ptr[1] >> 2) & 0x7;
6532*4882a593Smuzhiyun 	frame->coding_type_ext = ptr[2] & 0x1f;
6533*4882a593Smuzhiyun 	frame->channel_allocation = ptr[3];
6534*4882a593Smuzhiyun 	frame->level_shift_value = (ptr[4] >> 3) & 0xf;
6535*4882a593Smuzhiyun 	frame->downmix_inhibit = ptr[4] & 0x80 ? true : false;
6536*4882a593Smuzhiyun 
6537*4882a593Smuzhiyun 	return 0;
6538*4882a593Smuzhiyun }
6539*4882a593Smuzhiyun 
6540*4882a593Smuzhiyun /**
6541*4882a593Smuzhiyun  * hdmi_vendor_infoframe_unpack() - unpack binary buffer to a HDMI vendor infoframe
6542*4882a593Smuzhiyun  * @buffer: source buffer
6543*4882a593Smuzhiyun  * @frame: HDMI Vendor infoframe
6544*4882a593Smuzhiyun  *
6545*4882a593Smuzhiyun  * Unpacks the information contained in binary @buffer into a structured
6546*4882a593Smuzhiyun  * @frame of the HDMI Vendor information frame.
6547*4882a593Smuzhiyun  * Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
6548*4882a593Smuzhiyun  * specification.
6549*4882a593Smuzhiyun  *
6550*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6551*4882a593Smuzhiyun  */
6552*4882a593Smuzhiyun static int
hdmi_vendor_any_infoframe_unpack(union hdmi_vendor_any_infoframe * frame,void * buffer)6553*4882a593Smuzhiyun hdmi_vendor_any_infoframe_unpack(union hdmi_vendor_any_infoframe *frame,
6554*4882a593Smuzhiyun 				 void *buffer)
6555*4882a593Smuzhiyun {
6556*4882a593Smuzhiyun 	u8 *ptr = buffer;
6557*4882a593Smuzhiyun 	size_t length;
6558*4882a593Smuzhiyun 	int ret;
6559*4882a593Smuzhiyun 	u8 hdmi_video_format;
6560*4882a593Smuzhiyun 	struct hdmi_vendor_infoframe *hvf = &frame->hdmi;
6561*4882a593Smuzhiyun 
6562*4882a593Smuzhiyun 	if (ptr[0] != HDMI_INFOFRAME_TYPE_VENDOR ||
6563*4882a593Smuzhiyun 	    ptr[1] != 1 ||
6564*4882a593Smuzhiyun 	    (ptr[2] != 4 && ptr[2] != 5 && ptr[2] != 6))
6565*4882a593Smuzhiyun 		return -EINVAL;
6566*4882a593Smuzhiyun 
6567*4882a593Smuzhiyun 	length = ptr[2];
6568*4882a593Smuzhiyun 
6569*4882a593Smuzhiyun 	if (hdmi_infoframe_checksum(buffer,
6570*4882a593Smuzhiyun 				    HDMI_INFOFRAME_HEADER_SIZE + length) != 0)
6571*4882a593Smuzhiyun 		return -EINVAL;
6572*4882a593Smuzhiyun 
6573*4882a593Smuzhiyun 	ptr += HDMI_INFOFRAME_HEADER_SIZE;
6574*4882a593Smuzhiyun 
6575*4882a593Smuzhiyun 	/* HDMI OUI */
6576*4882a593Smuzhiyun 	if (ptr[0] != 0x03 ||
6577*4882a593Smuzhiyun 	    ptr[1] != 0x0c ||
6578*4882a593Smuzhiyun 	    ptr[2] != 0x00)
6579*4882a593Smuzhiyun 		return -EINVAL;
6580*4882a593Smuzhiyun 
6581*4882a593Smuzhiyun 	hdmi_video_format = ptr[3] >> 5;
6582*4882a593Smuzhiyun 
6583*4882a593Smuzhiyun 	if (hdmi_video_format > 0x2)
6584*4882a593Smuzhiyun 		return -EINVAL;
6585*4882a593Smuzhiyun 
6586*4882a593Smuzhiyun 	ret = hdmi_vendor_infoframe_init(hvf);
6587*4882a593Smuzhiyun 	if (ret)
6588*4882a593Smuzhiyun 		return ret;
6589*4882a593Smuzhiyun 
6590*4882a593Smuzhiyun 	hvf->length = length;
6591*4882a593Smuzhiyun 
6592*4882a593Smuzhiyun 	if (hdmi_video_format == 0x2) {
6593*4882a593Smuzhiyun 		if (length != 5 && length != 6)
6594*4882a593Smuzhiyun 			return -EINVAL;
6595*4882a593Smuzhiyun 		hvf->s3d_struct = ptr[4] >> 4;
6596*4882a593Smuzhiyun 		if (hvf->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF) {
6597*4882a593Smuzhiyun 			if (length != 6)
6598*4882a593Smuzhiyun 				return -EINVAL;
6599*4882a593Smuzhiyun 			hvf->s3d_ext_data = ptr[5] >> 4;
6600*4882a593Smuzhiyun 		}
6601*4882a593Smuzhiyun 	} else if (hdmi_video_format == 0x1) {
6602*4882a593Smuzhiyun 		if (length != 5)
6603*4882a593Smuzhiyun 			return -EINVAL;
6604*4882a593Smuzhiyun 		hvf->vic = ptr[4];
6605*4882a593Smuzhiyun 	} else {
6606*4882a593Smuzhiyun 		if (length != 4)
6607*4882a593Smuzhiyun 			return -EINVAL;
6608*4882a593Smuzhiyun 	}
6609*4882a593Smuzhiyun 
6610*4882a593Smuzhiyun 	return 0;
6611*4882a593Smuzhiyun }
6612*4882a593Smuzhiyun 
6613*4882a593Smuzhiyun /**
6614*4882a593Smuzhiyun  * hdmi_infoframe_unpack() - unpack binary buffer to a HDMI infoframe
6615*4882a593Smuzhiyun  * @buffer: source buffer
6616*4882a593Smuzhiyun  * @frame: HDMI infoframe
6617*4882a593Smuzhiyun  *
6618*4882a593Smuzhiyun  * Unpacks the information contained in binary buffer @buffer into a structured
6619*4882a593Smuzhiyun  * @frame of a HDMI infoframe.
6620*4882a593Smuzhiyun  * Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
6621*4882a593Smuzhiyun  * specification.
6622*4882a593Smuzhiyun  *
6623*4882a593Smuzhiyun  * Returns 0 on success or a negative error code on failure.
6624*4882a593Smuzhiyun  */
hdmi_infoframe_unpack(union hdmi_infoframe * frame,void * buffer)6625*4882a593Smuzhiyun int hdmi_infoframe_unpack(union hdmi_infoframe *frame, void *buffer)
6626*4882a593Smuzhiyun {
6627*4882a593Smuzhiyun 	int ret;
6628*4882a593Smuzhiyun 	u8 *ptr = buffer;
6629*4882a593Smuzhiyun 
6630*4882a593Smuzhiyun 	switch (ptr[0]) {
6631*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_AVI:
6632*4882a593Smuzhiyun 		ret = hdmi_avi_infoframe_unpack(&frame->avi, buffer);
6633*4882a593Smuzhiyun 		break;
6634*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_SPD:
6635*4882a593Smuzhiyun 		ret = hdmi_spd_infoframe_unpack(&frame->spd, buffer);
6636*4882a593Smuzhiyun 		break;
6637*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_AUDIO:
6638*4882a593Smuzhiyun 		ret = hdmi_audio_infoframe_unpack(&frame->audio, buffer);
6639*4882a593Smuzhiyun 		break;
6640*4882a593Smuzhiyun 	case HDMI_INFOFRAME_TYPE_VENDOR:
6641*4882a593Smuzhiyun 		ret = hdmi_vendor_any_infoframe_unpack(&frame->vendor, buffer);
6642*4882a593Smuzhiyun 		break;
6643*4882a593Smuzhiyun 	default:
6644*4882a593Smuzhiyun 		ret = -EINVAL;
6645*4882a593Smuzhiyun 		break;
6646*4882a593Smuzhiyun 	}
6647*4882a593Smuzhiyun 
6648*4882a593Smuzhiyun 	return ret;
6649*4882a593Smuzhiyun }
6650*4882a593Smuzhiyun 
6651*4882a593Smuzhiyun /**
6652*4882a593Smuzhiyun  * drm_mode_sort - sort mode list
6653*4882a593Smuzhiyun  * @edid_data: modes structures to sort
6654*4882a593Smuzhiyun  *
6655*4882a593Smuzhiyun  * Sort @edid_data by favorability, moving good modes to the head of the list.
6656*4882a593Smuzhiyun  */
drm_mode_sort(struct hdmi_edid_data * edid_data)6657*4882a593Smuzhiyun void drm_mode_sort(struct hdmi_edid_data *edid_data)
6658*4882a593Smuzhiyun {
6659*4882a593Smuzhiyun 	struct drm_display_mode *a, *b;
6660*4882a593Smuzhiyun 	struct drm_display_mode c;
6661*4882a593Smuzhiyun 	int diff, i, j;
6662*4882a593Smuzhiyun 
6663*4882a593Smuzhiyun 	for (i = 0; i < (edid_data->modes - 1); i++) {
6664*4882a593Smuzhiyun 		a = &edid_data->mode_buf[i];
6665*4882a593Smuzhiyun 		for (j = i + 1; j < edid_data->modes; j++) {
6666*4882a593Smuzhiyun 			b = &edid_data->mode_buf[j];
6667*4882a593Smuzhiyun 			diff = ((b->type & DRM_MODE_TYPE_PREFERRED) != 0) -
6668*4882a593Smuzhiyun 				((a->type & DRM_MODE_TYPE_PREFERRED) != 0);
6669*4882a593Smuzhiyun 			if (diff) {
6670*4882a593Smuzhiyun 				if (diff > 0) {
6671*4882a593Smuzhiyun 					c = *a;
6672*4882a593Smuzhiyun 					*a = *b;
6673*4882a593Smuzhiyun 					*b = c;
6674*4882a593Smuzhiyun 				}
6675*4882a593Smuzhiyun 				continue;
6676*4882a593Smuzhiyun 			}
6677*4882a593Smuzhiyun 
6678*4882a593Smuzhiyun 			diff = b->hdisplay * b->vdisplay
6679*4882a593Smuzhiyun 				- a->hdisplay * a->vdisplay;
6680*4882a593Smuzhiyun 			if (diff) {
6681*4882a593Smuzhiyun 				if (diff > 0) {
6682*4882a593Smuzhiyun 					c = *a;
6683*4882a593Smuzhiyun 					*a = *b;
6684*4882a593Smuzhiyun 					*b = c;
6685*4882a593Smuzhiyun 				}
6686*4882a593Smuzhiyun 				continue;
6687*4882a593Smuzhiyun 			}
6688*4882a593Smuzhiyun 
6689*4882a593Smuzhiyun 			diff = b->vrefresh - a->vrefresh;
6690*4882a593Smuzhiyun 			if (diff) {
6691*4882a593Smuzhiyun 				if (diff > 0) {
6692*4882a593Smuzhiyun 					c = *a;
6693*4882a593Smuzhiyun 					*a = *b;
6694*4882a593Smuzhiyun 					*b = c;
6695*4882a593Smuzhiyun 				}
6696*4882a593Smuzhiyun 				continue;
6697*4882a593Smuzhiyun 			}
6698*4882a593Smuzhiyun 
6699*4882a593Smuzhiyun 			diff = b->clock - a->clock;
6700*4882a593Smuzhiyun 			if (diff > 0) {
6701*4882a593Smuzhiyun 				c = *a;
6702*4882a593Smuzhiyun 				*a = *b;
6703*4882a593Smuzhiyun 				*b = c;
6704*4882a593Smuzhiyun 			}
6705*4882a593Smuzhiyun 		}
6706*4882a593Smuzhiyun 	}
6707*4882a593Smuzhiyun 	edid_data->preferred_mode = &edid_data->mode_buf[0];
6708*4882a593Smuzhiyun }
6709*4882a593Smuzhiyun 
6710*4882a593Smuzhiyun /**
6711*4882a593Smuzhiyun  * drm_mode_prune_invalid - remove invalid modes from mode list
6712*4882a593Smuzhiyun  * @edid_data: structure store mode list
6713*4882a593Smuzhiyun  * Returns:
6714*4882a593Smuzhiyun  * Number of valid modes.
6715*4882a593Smuzhiyun  */
drm_mode_prune_invalid(struct hdmi_edid_data * edid_data)6716*4882a593Smuzhiyun int drm_mode_prune_invalid(struct hdmi_edid_data *edid_data)
6717*4882a593Smuzhiyun {
6718*4882a593Smuzhiyun 	int i, j;
6719*4882a593Smuzhiyun 	int num = edid_data->modes;
6720*4882a593Smuzhiyun 	int len = sizeof(struct drm_display_mode);
6721*4882a593Smuzhiyun 	struct drm_display_mode *mode_buf = edid_data->mode_buf;
6722*4882a593Smuzhiyun 
6723*4882a593Smuzhiyun 	for (i = 0; i < num; i++) {
6724*4882a593Smuzhiyun 		if (mode_buf[i].invalid) {
6725*4882a593Smuzhiyun 			/* If mode is invalid, delete it. */
6726*4882a593Smuzhiyun 			for (j = i; j < num - 1; j++)
6727*4882a593Smuzhiyun 				memcpy(&mode_buf[j], &mode_buf[j + 1], len);
6728*4882a593Smuzhiyun 
6729*4882a593Smuzhiyun 			num--;
6730*4882a593Smuzhiyun 			i--;
6731*4882a593Smuzhiyun 		}
6732*4882a593Smuzhiyun 	}
6733*4882a593Smuzhiyun 	/* Clear redundant modes of mode_buf. */
6734*4882a593Smuzhiyun 	memset(&mode_buf[num], 0, len * (edid_data->modes - num));
6735*4882a593Smuzhiyun 
6736*4882a593Smuzhiyun 	edid_data->modes = num;
6737*4882a593Smuzhiyun 	return num;
6738*4882a593Smuzhiyun }
6739*4882a593Smuzhiyun 
6740*4882a593Smuzhiyun /**
6741*4882a593Smuzhiyun  * drm_rk_filter_whitelist - mark modes out of white list from mode list
6742*4882a593Smuzhiyun  * @edid_data: structure store mode list
6743*4882a593Smuzhiyun  */
drm_rk_filter_whitelist(struct hdmi_edid_data * edid_data)6744*4882a593Smuzhiyun void drm_rk_filter_whitelist(struct hdmi_edid_data *edid_data)
6745*4882a593Smuzhiyun {
6746*4882a593Smuzhiyun 	int i, j, white_len;
6747*4882a593Smuzhiyun 
6748*4882a593Smuzhiyun 	if (sizeof(resolution_white)) {
6749*4882a593Smuzhiyun 		white_len = sizeof(resolution_white) /
6750*4882a593Smuzhiyun 			sizeof(resolution_white[0]);
6751*4882a593Smuzhiyun 		for (i = 0; i < edid_data->modes; i++) {
6752*4882a593Smuzhiyun 			for (j = 0; j < white_len; j++) {
6753*4882a593Smuzhiyun 				if (drm_mode_match(&resolution_white[j],
6754*4882a593Smuzhiyun 						   &edid_data->mode_buf[i],
6755*4882a593Smuzhiyun 						   DRM_MODE_MATCH_TIMINGS |
6756*4882a593Smuzhiyun 						   DRM_MODE_MATCH_CLOCK |
6757*4882a593Smuzhiyun 						   DRM_MODE_MATCH_FLAGS))
6758*4882a593Smuzhiyun 					break;
6759*4882a593Smuzhiyun 			}
6760*4882a593Smuzhiyun 
6761*4882a593Smuzhiyun 			if (j == white_len)
6762*4882a593Smuzhiyun 				edid_data->mode_buf[i].invalid = true;
6763*4882a593Smuzhiyun 		}
6764*4882a593Smuzhiyun 	}
6765*4882a593Smuzhiyun }
6766*4882a593Smuzhiyun 
drm_display_mode_convert(struct drm_display_mode * mode,struct base_drm_display_mode * base_mode)6767*4882a593Smuzhiyun static void drm_display_mode_convert(struct drm_display_mode *mode,
6768*4882a593Smuzhiyun 				     struct base_drm_display_mode *base_mode)
6769*4882a593Smuzhiyun {
6770*4882a593Smuzhiyun 	mode->clock = base_mode->clock;
6771*4882a593Smuzhiyun 	mode->hdisplay = base_mode->hdisplay;
6772*4882a593Smuzhiyun 	mode->hsync_start = base_mode->hsync_start;
6773*4882a593Smuzhiyun 	mode->hsync_end = base_mode->hsync_end;
6774*4882a593Smuzhiyun 	mode->htotal = base_mode->htotal;
6775*4882a593Smuzhiyun 	mode->vdisplay = base_mode->vdisplay;
6776*4882a593Smuzhiyun 	mode->vsync_start = base_mode->vsync_start;
6777*4882a593Smuzhiyun 	mode->vsync_end = base_mode->vsync_end;
6778*4882a593Smuzhiyun 	mode->vtotal = base_mode->vtotal;
6779*4882a593Smuzhiyun 	mode->vrefresh = base_mode->vrefresh;
6780*4882a593Smuzhiyun 	mode->vscan = base_mode->vscan;
6781*4882a593Smuzhiyun 	mode->flags = base_mode->flags;
6782*4882a593Smuzhiyun 	mode->picture_aspect_ratio = base_mode->picture_aspect_ratio;
6783*4882a593Smuzhiyun }
6784*4882a593Smuzhiyun 
drm_rk_select_mode(struct hdmi_edid_data * edid_data,struct base_screen_info * screen_info)6785*4882a593Smuzhiyun void drm_rk_select_mode(struct hdmi_edid_data *edid_data,
6786*4882a593Smuzhiyun 			struct base_screen_info *screen_info)
6787*4882a593Smuzhiyun {
6788*4882a593Smuzhiyun 	int i;
6789*4882a593Smuzhiyun 	struct drm_display_mode mode;
6790*4882a593Smuzhiyun 
6791*4882a593Smuzhiyun 	if (!screen_info) {
6792*4882a593Smuzhiyun 		/* define init resolution here */
6793*4882a593Smuzhiyun 	} else {
6794*4882a593Smuzhiyun 		memset(&mode, 0, sizeof(struct drm_display_mode));
6795*4882a593Smuzhiyun 
6796*4882a593Smuzhiyun 		drm_display_mode_convert(&mode, &screen_info->mode);
6797*4882a593Smuzhiyun 		for (i = 0; i < edid_data->modes; i++) {
6798*4882a593Smuzhiyun 			if (drm_mode_match(&mode,
6799*4882a593Smuzhiyun 					   &edid_data->mode_buf[i],
6800*4882a593Smuzhiyun 					   DRM_MODE_MATCH_TIMINGS |
6801*4882a593Smuzhiyun 					   DRM_MODE_MATCH_CLOCK |
6802*4882a593Smuzhiyun 					   DRM_MODE_MATCH_FLAGS)) {
6803*4882a593Smuzhiyun 				edid_data->preferred_mode =
6804*4882a593Smuzhiyun 					&edid_data->mode_buf[i];
6805*4882a593Smuzhiyun 
6806*4882a593Smuzhiyun 				if (edid_data->mode_buf[i].picture_aspect_ratio)
6807*4882a593Smuzhiyun 					break;
6808*4882a593Smuzhiyun 			}
6809*4882a593Smuzhiyun 		}
6810*4882a593Smuzhiyun 	}
6811*4882a593Smuzhiyun }
6812*4882a593Smuzhiyun 
6813*4882a593Smuzhiyun /**
6814*4882a593Smuzhiyun  * drm_do_probe_ddc_edid() - get EDID information via I2C
6815*4882a593Smuzhiyun  * @adap: ddc adapter
6816*4882a593Smuzhiyun  * @buf: EDID data buffer to be filled
6817*4882a593Smuzhiyun  * @block: 128 byte EDID block to start fetching from
6818*4882a593Smuzhiyun  * @len: EDID data buffer length to fetch
6819*4882a593Smuzhiyun  *
6820*4882a593Smuzhiyun  * Try to fetch EDID information by calling I2C driver functions.
6821*4882a593Smuzhiyun  *
6822*4882a593Smuzhiyun  * Return: 0 on success or -1 on failure.
6823*4882a593Smuzhiyun  */
6824*4882a593Smuzhiyun static int
drm_do_probe_ddc_edid(struct ddc_adapter * adap,u8 * buf,unsigned int block,size_t len)6825*4882a593Smuzhiyun drm_do_probe_ddc_edid(struct ddc_adapter *adap, u8 *buf, unsigned int block,
6826*4882a593Smuzhiyun 		      size_t len)
6827*4882a593Smuzhiyun {
6828*4882a593Smuzhiyun 	unsigned char start = block * HDMI_EDID_BLOCK_SIZE;
6829*4882a593Smuzhiyun 	unsigned char segment = block >> 1;
6830*4882a593Smuzhiyun 	unsigned char xfers = segment ? 3 : 2;
6831*4882a593Smuzhiyun 	int ret, retries = 5;
6832*4882a593Smuzhiyun 
6833*4882a593Smuzhiyun 	do {
6834*4882a593Smuzhiyun 		struct i2c_msg msgs[] = {
6835*4882a593Smuzhiyun 			{
6836*4882a593Smuzhiyun 				.addr	= DDC_SEGMENT_ADDR,
6837*4882a593Smuzhiyun 				.flags	= 0,
6838*4882a593Smuzhiyun 				.len	= 1,
6839*4882a593Smuzhiyun 				.buf	= &segment,
6840*4882a593Smuzhiyun 			}, {
6841*4882a593Smuzhiyun 				.addr	= DDC_ADDR,
6842*4882a593Smuzhiyun 				.flags	= 0,
6843*4882a593Smuzhiyun 				.len	= 1,
6844*4882a593Smuzhiyun 				.buf	= &start,
6845*4882a593Smuzhiyun 			}, {
6846*4882a593Smuzhiyun 				.addr	= DDC_ADDR,
6847*4882a593Smuzhiyun 				.flags	= I2C_M_RD,
6848*4882a593Smuzhiyun 				.len	= len,
6849*4882a593Smuzhiyun 				.buf	= buf,
6850*4882a593Smuzhiyun 			}
6851*4882a593Smuzhiyun 		};
6852*4882a593Smuzhiyun 
6853*4882a593Smuzhiyun 		if (adap->ops) {
6854*4882a593Smuzhiyun 			ret = adap->ops->xfer(adap->i2c_bus, &msgs[3 - xfers],
6855*4882a593Smuzhiyun 					      xfers);
6856*4882a593Smuzhiyun 			if (!ret)
6857*4882a593Smuzhiyun 				ret = xfers;
6858*4882a593Smuzhiyun 		} else {
6859*4882a593Smuzhiyun 			ret = adap->ddc_xfer(adap, &msgs[3 - xfers], xfers);
6860*4882a593Smuzhiyun 		}
6861*4882a593Smuzhiyun 	} while (ret != xfers && --retries);
6862*4882a593Smuzhiyun 
6863*4882a593Smuzhiyun 	/* All msg transfer successfully. */
6864*4882a593Smuzhiyun 	return ret == xfers ? 0 : -1;
6865*4882a593Smuzhiyun }
6866*4882a593Smuzhiyun 
drm_do_get_edid(struct ddc_adapter * adap,u8 * edid)6867*4882a593Smuzhiyun int drm_do_get_edid(struct ddc_adapter *adap, u8 *edid)
6868*4882a593Smuzhiyun {
6869*4882a593Smuzhiyun 	int i, j, block_num, block = 0;
6870*4882a593Smuzhiyun 	bool edid_corrupt;
6871*4882a593Smuzhiyun #ifdef DEBUG
6872*4882a593Smuzhiyun 	u8 *buff;
6873*4882a593Smuzhiyun #endif
6874*4882a593Smuzhiyun 
6875*4882a593Smuzhiyun 	/* base block fetch */
6876*4882a593Smuzhiyun 	for (i = 0; i < 4; i++) {
6877*4882a593Smuzhiyun 		if (drm_do_probe_ddc_edid(adap, edid, 0, HDMI_EDID_BLOCK_SIZE))
6878*4882a593Smuzhiyun 			goto err;
6879*4882a593Smuzhiyun 		if (drm_edid_block_valid(edid, 0, true,
6880*4882a593Smuzhiyun 					 &edid_corrupt))
6881*4882a593Smuzhiyun 			break;
6882*4882a593Smuzhiyun 		if (i == 0 && drm_edid_is_zero(edid, HDMI_EDID_BLOCK_SIZE)) {
6883*4882a593Smuzhiyun 			printf("edid base block is 0, get edid failed\n");
6884*4882a593Smuzhiyun 			goto err;
6885*4882a593Smuzhiyun 		}
6886*4882a593Smuzhiyun 	}
6887*4882a593Smuzhiyun 
6888*4882a593Smuzhiyun 	if (i == 4)
6889*4882a593Smuzhiyun 		goto err;
6890*4882a593Smuzhiyun 
6891*4882a593Smuzhiyun 	block++;
6892*4882a593Smuzhiyun 	/* get the number of extensions */
6893*4882a593Smuzhiyun 	block_num = edid[0x7e];
6894*4882a593Smuzhiyun 
6895*4882a593Smuzhiyun 	for (j = 1; j <= block_num; j++) {
6896*4882a593Smuzhiyun 		for (i = 0; i < 4; i++) {
6897*4882a593Smuzhiyun 			if (drm_do_probe_ddc_edid(adap, &edid[0x80 * j], j,
6898*4882a593Smuzhiyun 						  HDMI_EDID_BLOCK_SIZE))
6899*4882a593Smuzhiyun 				goto err;
6900*4882a593Smuzhiyun 			if (drm_edid_block_valid(&edid[0x80 * j], j,
6901*4882a593Smuzhiyun 						 true, NULL))
6902*4882a593Smuzhiyun 				break;
6903*4882a593Smuzhiyun 		}
6904*4882a593Smuzhiyun 
6905*4882a593Smuzhiyun 		if (i == 4)
6906*4882a593Smuzhiyun 			goto err;
6907*4882a593Smuzhiyun 		block++;
6908*4882a593Smuzhiyun 	}
6909*4882a593Smuzhiyun 
6910*4882a593Smuzhiyun #ifdef DEBUG
6911*4882a593Smuzhiyun 	printf("RAW EDID:\n");
6912*4882a593Smuzhiyun 	for (i = 0; i < block_num + 1; i++) {
6913*4882a593Smuzhiyun 		buff = &edid[0x80 * i];
6914*4882a593Smuzhiyun 		for (j = 0; j < HDMI_EDID_BLOCK_SIZE; j++) {
6915*4882a593Smuzhiyun 			if (j % 16 == 0)
6916*4882a593Smuzhiyun 				printf("\n");
6917*4882a593Smuzhiyun 			printf("0x%02x, ", buff[j]);
6918*4882a593Smuzhiyun 		}
6919*4882a593Smuzhiyun 		printf("\n");
6920*4882a593Smuzhiyun 	}
6921*4882a593Smuzhiyun #endif
6922*4882a593Smuzhiyun 
6923*4882a593Smuzhiyun 	return 0;
6924*4882a593Smuzhiyun 
6925*4882a593Smuzhiyun err:
6926*4882a593Smuzhiyun 	printf("can't get edid block:%d\n", block);
6927*4882a593Smuzhiyun 	/* clear all read edid block, include invalid block */
6928*4882a593Smuzhiyun 	memset(edid, 0, HDMI_EDID_BLOCK_SIZE * (block + 1));
6929*4882a593Smuzhiyun 	return -EFAULT;
6930*4882a593Smuzhiyun }
6931*4882a593Smuzhiyun 
hdmi_ddc_read(struct ddc_adapter * adap,u16 addr,u8 offset,void * buffer,size_t size)6932*4882a593Smuzhiyun static ssize_t hdmi_ddc_read(struct ddc_adapter *adap, u16 addr, u8 offset,
6933*4882a593Smuzhiyun 			     void *buffer, size_t size)
6934*4882a593Smuzhiyun {
6935*4882a593Smuzhiyun 	struct i2c_msg msgs[2] = {
6936*4882a593Smuzhiyun 		{
6937*4882a593Smuzhiyun 			.addr = addr,
6938*4882a593Smuzhiyun 			.flags = 0,
6939*4882a593Smuzhiyun 			.len = 1,
6940*4882a593Smuzhiyun 			.buf = &offset,
6941*4882a593Smuzhiyun 		}, {
6942*4882a593Smuzhiyun 			.addr = addr,
6943*4882a593Smuzhiyun 			.flags = I2C_M_RD,
6944*4882a593Smuzhiyun 			.len = size,
6945*4882a593Smuzhiyun 			.buf = buffer,
6946*4882a593Smuzhiyun 		}
6947*4882a593Smuzhiyun 	};
6948*4882a593Smuzhiyun 
6949*4882a593Smuzhiyun 	return adap->ddc_xfer(adap, msgs, ARRAY_SIZE(msgs));
6950*4882a593Smuzhiyun }
6951*4882a593Smuzhiyun 
hdmi_ddc_write(struct ddc_adapter * adap,u16 addr,u8 offset,const void * buffer,size_t size)6952*4882a593Smuzhiyun static ssize_t hdmi_ddc_write(struct ddc_adapter *adap, u16 addr, u8 offset,
6953*4882a593Smuzhiyun 			      const void *buffer, size_t size)
6954*4882a593Smuzhiyun {
6955*4882a593Smuzhiyun 	struct i2c_msg msg = {
6956*4882a593Smuzhiyun 		.addr = addr,
6957*4882a593Smuzhiyun 		.flags = 0,
6958*4882a593Smuzhiyun 		.len = 1 + size,
6959*4882a593Smuzhiyun 		.buf = NULL,
6960*4882a593Smuzhiyun 	};
6961*4882a593Smuzhiyun 	void *data;
6962*4882a593Smuzhiyun 	int err;
6963*4882a593Smuzhiyun 
6964*4882a593Smuzhiyun 	data = malloc(1 + size);
6965*4882a593Smuzhiyun 	if (!data)
6966*4882a593Smuzhiyun 		return -ENOMEM;
6967*4882a593Smuzhiyun 
6968*4882a593Smuzhiyun 	msg.buf = data;
6969*4882a593Smuzhiyun 
6970*4882a593Smuzhiyun 	memcpy(data, &offset, sizeof(offset));
6971*4882a593Smuzhiyun 	memcpy(data + 1, buffer, size);
6972*4882a593Smuzhiyun 
6973*4882a593Smuzhiyun 	err = adap->ddc_xfer(adap, &msg, 1);
6974*4882a593Smuzhiyun 
6975*4882a593Smuzhiyun 	free(data);
6976*4882a593Smuzhiyun 
6977*4882a593Smuzhiyun 	return err;
6978*4882a593Smuzhiyun }
6979*4882a593Smuzhiyun 
6980*4882a593Smuzhiyun /**
6981*4882a593Smuzhiyun  * drm_scdc_readb - read a single byte from SCDC
6982*4882a593Smuzhiyun  * @adap: ddc adapter
6983*4882a593Smuzhiyun  * @offset: offset of register to read
6984*4882a593Smuzhiyun  * @value: return location for the register value
6985*4882a593Smuzhiyun  *
6986*4882a593Smuzhiyun  * Reads a single byte from SCDC. This is a convenience wrapper around the
6987*4882a593Smuzhiyun  * drm_scdc_read() function.
6988*4882a593Smuzhiyun  *
6989*4882a593Smuzhiyun  * Returns:
6990*4882a593Smuzhiyun  * 0 on success or a negative error code on failure.
6991*4882a593Smuzhiyun  */
drm_scdc_readb(struct ddc_adapter * adap,u8 offset,u8 * value)6992*4882a593Smuzhiyun u8 drm_scdc_readb(struct ddc_adapter *adap, u8 offset,
6993*4882a593Smuzhiyun 		  u8 *value)
6994*4882a593Smuzhiyun {
6995*4882a593Smuzhiyun 	return hdmi_ddc_read(adap, SCDC_I2C_SLAVE_ADDRESS, offset, value,
6996*4882a593Smuzhiyun 			     sizeof(*value));
6997*4882a593Smuzhiyun }
6998*4882a593Smuzhiyun 
6999*4882a593Smuzhiyun /**
7000*4882a593Smuzhiyun  * drm_scdc_writeb - write a single byte to SCDC
7001*4882a593Smuzhiyun  * @adap: ddc adapter
7002*4882a593Smuzhiyun  * @offset: offset of register to read
7003*4882a593Smuzhiyun  * @value: return location for the register value
7004*4882a593Smuzhiyun  *
7005*4882a593Smuzhiyun  * Writes a single byte to SCDC. This is a convenience wrapper around the
7006*4882a593Smuzhiyun  * drm_scdc_write() function.
7007*4882a593Smuzhiyun  *
7008*4882a593Smuzhiyun  * Returns:
7009*4882a593Smuzhiyun  * 0 on success or a negative error code on failure.
7010*4882a593Smuzhiyun  */
drm_scdc_writeb(struct ddc_adapter * adap,u8 offset,u8 value)7011*4882a593Smuzhiyun u8 drm_scdc_writeb(struct ddc_adapter *adap, u8 offset,
7012*4882a593Smuzhiyun 		   u8 value)
7013*4882a593Smuzhiyun {
7014*4882a593Smuzhiyun 	return hdmi_ddc_write(adap, SCDC_I2C_SLAVE_ADDRESS, offset, &value,
7015*4882a593Smuzhiyun 			      sizeof(value));
7016*4882a593Smuzhiyun }
7017*4882a593Smuzhiyun 
7018