drm: Decouple EDID parsing from I2C adapter
[platform/adaptation/renesas_rcar/renesas_kernel.git] / drivers / gpu / drm / drm_edid.c
1 /*
2  * Copyright (c) 2006 Luc Verhaegen (quirks list)
3  * Copyright (c) 2007-2008 Intel Corporation
4  *   Jesse Barnes <jesse.barnes@intel.com>
5  * Copyright 2010 Red Hat, Inc.
6  *
7  * DDC probing routines (drm_ddc_read & drm_do_probe_ddc_edid) originally from
8  * FB layer.
9  *   Copyright (C) 2006 Dennis Munsie <dmunsie@cecropia.com>
10  *
11  * Permission is hereby granted, free of charge, to any person obtaining a
12  * copy of this software and associated documentation files (the "Software"),
13  * to deal in the Software without restriction, including without limitation
14  * the rights to use, copy, modify, merge, publish, distribute, sub license,
15  * and/or sell copies of the Software, and to permit persons to whom the
16  * Software is furnished to do so, subject to the following conditions:
17  *
18  * The above copyright notice and this permission notice (including the
19  * next paragraph) shall be included in all copies or substantial portions
20  * of the Software.
21  *
22  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
23  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
24  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
25  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
26  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
27  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
28  * DEALINGS IN THE SOFTWARE.
29  */
30 #include <linux/kernel.h>
31 #include <linux/slab.h>
32 #include <linux/hdmi.h>
33 #include <linux/i2c.h>
34 #include <linux/module.h>
35 #include <drm/drmP.h>
36 #include <drm/drm_edid.h>
37
38 #define version_greater(edid, maj, min) \
39         (((edid)->version > (maj)) || \
40          ((edid)->version == (maj) && (edid)->revision > (min)))
41
42 #define EDID_EST_TIMINGS 16
43 #define EDID_STD_TIMINGS 8
44 #define EDID_DETAILED_TIMINGS 4
45
46 /*
47  * EDID blocks out in the wild have a variety of bugs, try to collect
48  * them here (note that userspace may work around broken monitors first,
49  * but fixes should make their way here so that the kernel "just works"
50  * on as many displays as possible).
51  */
52
53 /* First detailed mode wrong, use largest 60Hz mode */
54 #define EDID_QUIRK_PREFER_LARGE_60              (1 << 0)
55 /* Reported 135MHz pixel clock is too high, needs adjustment */
56 #define EDID_QUIRK_135_CLOCK_TOO_HIGH           (1 << 1)
57 /* Prefer the largest mode at 75 Hz */
58 #define EDID_QUIRK_PREFER_LARGE_75              (1 << 2)
59 /* Detail timing is in cm not mm */
60 #define EDID_QUIRK_DETAILED_IN_CM               (1 << 3)
61 /* Detailed timing descriptors have bogus size values, so just take the
62  * maximum size and use that.
63  */
64 #define EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE    (1 << 4)
65 /* Monitor forgot to set the first detailed is preferred bit. */
66 #define EDID_QUIRK_FIRST_DETAILED_PREFERRED     (1 << 5)
67 /* use +hsync +vsync for detailed mode */
68 #define EDID_QUIRK_DETAILED_SYNC_PP             (1 << 6)
69 /* Force reduced-blanking timings for detailed modes */
70 #define EDID_QUIRK_FORCE_REDUCED_BLANKING       (1 << 7)
71 /* Force 8bpc */
72 #define EDID_QUIRK_FORCE_8BPC                   (1 << 8)
73
74 struct detailed_mode_closure {
75         struct drm_connector *connector;
76         struct edid *edid;
77         bool preferred;
78         u32 quirks;
79         int modes;
80 };
81
82 #define LEVEL_DMT       0
83 #define LEVEL_GTF       1
84 #define LEVEL_GTF2      2
85 #define LEVEL_CVT       3
86
87 static struct edid_quirk {
88         char vendor[4];
89         int product_id;
90         u32 quirks;
91 } edid_quirk_list[] = {
92         /* Acer AL1706 */
93         { "ACR", 44358, EDID_QUIRK_PREFER_LARGE_60 },
94         /* Acer F51 */
95         { "API", 0x7602, EDID_QUIRK_PREFER_LARGE_60 },
96         /* Unknown Acer */
97         { "ACR", 2423, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
98
99         /* Belinea 10 15 55 */
100         { "MAX", 1516, EDID_QUIRK_PREFER_LARGE_60 },
101         { "MAX", 0x77e, EDID_QUIRK_PREFER_LARGE_60 },
102
103         /* Envision Peripherals, Inc. EN-7100e */
104         { "EPI", 59264, EDID_QUIRK_135_CLOCK_TOO_HIGH },
105         /* Envision EN2028 */
106         { "EPI", 8232, EDID_QUIRK_PREFER_LARGE_60 },
107
108         /* Funai Electronics PM36B */
109         { "FCM", 13600, EDID_QUIRK_PREFER_LARGE_75 |
110           EDID_QUIRK_DETAILED_IN_CM },
111
112         /* LG Philips LCD LP154W01-A5 */
113         { "LPL", 0, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
114         { "LPL", 0x2a00, EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE },
115
116         /* Philips 107p5 CRT */
117         { "PHL", 57364, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
118
119         /* Proview AY765C */
120         { "PTS", 765, EDID_QUIRK_FIRST_DETAILED_PREFERRED },
121
122         /* Samsung SyncMaster 205BW.  Note: irony */
123         { "SAM", 541, EDID_QUIRK_DETAILED_SYNC_PP },
124         /* Samsung SyncMaster 22[5-6]BW */
125         { "SAM", 596, EDID_QUIRK_PREFER_LARGE_60 },
126         { "SAM", 638, EDID_QUIRK_PREFER_LARGE_60 },
127
128         /* ViewSonic VA2026w */
129         { "VSC", 5020, EDID_QUIRK_FORCE_REDUCED_BLANKING },
130
131         /* Medion MD 30217 PG */
132         { "MED", 0x7b8, EDID_QUIRK_PREFER_LARGE_75 },
133
134         /* Panel in Samsung NP700G7A-S01PL notebook reports 6bpc */
135         { "SEC", 0xd033, EDID_QUIRK_FORCE_8BPC },
136 };
137
138 /*
139  * Autogenerated from the DMT spec.
140  * This table is copied from xfree86/modes/xf86EdidModes.c.
141  */
142 static const struct drm_display_mode drm_dmt_modes[] = {
143         /* 640x350@85Hz */
144         { DRM_MODE("640x350", DRM_MODE_TYPE_DRIVER, 31500, 640, 672,
145                    736, 832, 0, 350, 382, 385, 445, 0,
146                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
147         /* 640x400@85Hz */
148         { DRM_MODE("640x400", DRM_MODE_TYPE_DRIVER, 31500, 640, 672,
149                    736, 832, 0, 400, 401, 404, 445, 0,
150                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
151         /* 720x400@85Hz */
152         { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 35500, 720, 756,
153                    828, 936, 0, 400, 401, 404, 446, 0,
154                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
155         /* 640x480@60Hz */
156         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
157                    752, 800, 0, 480, 489, 492, 525, 0,
158                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
159         /* 640x480@72Hz */
160         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 664,
161                    704, 832, 0, 480, 489, 492, 520, 0,
162                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
163         /* 640x480@75Hz */
164         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 656,
165                    720, 840, 0, 480, 481, 484, 500, 0,
166                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
167         /* 640x480@85Hz */
168         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 36000, 640, 696,
169                    752, 832, 0, 480, 481, 484, 509, 0,
170                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
171         /* 800x600@56Hz */
172         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 36000, 800, 824,
173                    896, 1024, 0, 600, 601, 603, 625, 0,
174                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
175         /* 800x600@60Hz */
176         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
177                    968, 1056, 0, 600, 601, 605, 628, 0,
178                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
179         /* 800x600@72Hz */
180         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 50000, 800, 856,
181                    976, 1040, 0, 600, 637, 643, 666, 0,
182                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
183         /* 800x600@75Hz */
184         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 49500, 800, 816,
185                    896, 1056, 0, 600, 601, 604, 625, 0,
186                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
187         /* 800x600@85Hz */
188         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 56250, 800, 832,
189                    896, 1048, 0, 600, 601, 604, 631, 0,
190                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
191         /* 800x600@120Hz RB */
192         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 73250, 800, 848,
193                    880, 960, 0, 600, 603, 607, 636, 0,
194                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
195         /* 848x480@60Hz */
196         { DRM_MODE("848x480", DRM_MODE_TYPE_DRIVER, 33750, 848, 864,
197                    976, 1088, 0, 480, 486, 494, 517, 0,
198                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
199         /* 1024x768@43Hz, interlace */
200         { DRM_MODE("1024x768i", DRM_MODE_TYPE_DRIVER, 44900, 1024, 1032,
201                    1208, 1264, 0, 768, 768, 772, 817, 0,
202                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
203                         DRM_MODE_FLAG_INTERLACE) },
204         /* 1024x768@60Hz */
205         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
206                    1184, 1344, 0, 768, 771, 777, 806, 0,
207                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
208         /* 1024x768@70Hz */
209         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 75000, 1024, 1048,
210                    1184, 1328, 0, 768, 771, 777, 806, 0,
211                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) },
212         /* 1024x768@75Hz */
213         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 78750, 1024, 1040,
214                    1136, 1312, 0, 768, 769, 772, 800, 0,
215                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
216         /* 1024x768@85Hz */
217         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 94500, 1024, 1072,
218                    1168, 1376, 0, 768, 769, 772, 808, 0,
219                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
220         /* 1024x768@120Hz RB */
221         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 115500, 1024, 1072,
222                    1104, 1184, 0, 768, 771, 775, 813, 0,
223                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
224         /* 1152x864@75Hz */
225         { DRM_MODE("1152x864", DRM_MODE_TYPE_DRIVER, 108000, 1152, 1216,
226                    1344, 1600, 0, 864, 865, 868, 900, 0,
227                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
228         /* 1280x768@60Hz RB */
229         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 68250, 1280, 1328,
230                    1360, 1440, 0, 768, 771, 778, 790, 0,
231                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
232         /* 1280x768@60Hz */
233         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 79500, 1280, 1344,
234                    1472, 1664, 0, 768, 771, 778, 798, 0,
235                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
236         /* 1280x768@75Hz */
237         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 102250, 1280, 1360,
238                    1488, 1696, 0, 768, 771, 778, 805, 0,
239                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
240         /* 1280x768@85Hz */
241         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 117500, 1280, 1360,
242                    1496, 1712, 0, 768, 771, 778, 809, 0,
243                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
244         /* 1280x768@120Hz RB */
245         { DRM_MODE("1280x768", DRM_MODE_TYPE_DRIVER, 140250, 1280, 1328,
246                    1360, 1440, 0, 768, 771, 778, 813, 0,
247                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
248         /* 1280x800@60Hz RB */
249         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 71000, 1280, 1328,
250                    1360, 1440, 0, 800, 803, 809, 823, 0,
251                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
252         /* 1280x800@60Hz */
253         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 83500, 1280, 1352,
254                    1480, 1680, 0, 800, 803, 809, 831, 0,
255                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
256         /* 1280x800@75Hz */
257         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 106500, 1280, 1360,
258                    1488, 1696, 0, 800, 803, 809, 838, 0,
259                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
260         /* 1280x800@85Hz */
261         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 122500, 1280, 1360,
262                    1496, 1712, 0, 800, 803, 809, 843, 0,
263                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
264         /* 1280x800@120Hz RB */
265         { DRM_MODE("1280x800", DRM_MODE_TYPE_DRIVER, 146250, 1280, 1328,
266                    1360, 1440, 0, 800, 803, 809, 847, 0,
267                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
268         /* 1280x960@60Hz */
269         { DRM_MODE("1280x960", DRM_MODE_TYPE_DRIVER, 108000, 1280, 1376,
270                    1488, 1800, 0, 960, 961, 964, 1000, 0,
271                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
272         /* 1280x960@85Hz */
273         { DRM_MODE("1280x960", DRM_MODE_TYPE_DRIVER, 148500, 1280, 1344,
274                    1504, 1728, 0, 960, 961, 964, 1011, 0,
275                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
276         /* 1280x960@120Hz RB */
277         { DRM_MODE("1280x960", DRM_MODE_TYPE_DRIVER, 175500, 1280, 1328,
278                    1360, 1440, 0, 960, 963, 967, 1017, 0,
279                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
280         /* 1280x1024@60Hz */
281         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 108000, 1280, 1328,
282                    1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
283                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
284         /* 1280x1024@75Hz */
285         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 135000, 1280, 1296,
286                    1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
287                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
288         /* 1280x1024@85Hz */
289         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 157500, 1280, 1344,
290                    1504, 1728, 0, 1024, 1025, 1028, 1072, 0,
291                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
292         /* 1280x1024@120Hz RB */
293         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 187250, 1280, 1328,
294                    1360, 1440, 0, 1024, 1027, 1034, 1084, 0,
295                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
296         /* 1360x768@60Hz */
297         { DRM_MODE("1360x768", DRM_MODE_TYPE_DRIVER, 85500, 1360, 1424,
298                    1536, 1792, 0, 768, 771, 777, 795, 0,
299                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
300         /* 1360x768@120Hz RB */
301         { DRM_MODE("1360x768", DRM_MODE_TYPE_DRIVER, 148250, 1360, 1408,
302                    1440, 1520, 0, 768, 771, 776, 813, 0,
303                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
304         /* 1400x1050@60Hz RB */
305         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 101000, 1400, 1448,
306                    1480, 1560, 0, 1050, 1053, 1057, 1080, 0,
307                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
308         /* 1400x1050@60Hz */
309         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 121750, 1400, 1488,
310                    1632, 1864, 0, 1050, 1053, 1057, 1089, 0,
311                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
312         /* 1400x1050@75Hz */
313         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 156000, 1400, 1504,
314                    1648, 1896, 0, 1050, 1053, 1057, 1099, 0,
315                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
316         /* 1400x1050@85Hz */
317         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 179500, 1400, 1504,
318                    1656, 1912, 0, 1050, 1053, 1057, 1105, 0,
319                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
320         /* 1400x1050@120Hz RB */
321         { DRM_MODE("1400x1050", DRM_MODE_TYPE_DRIVER, 208000, 1400, 1448,
322                    1480, 1560, 0, 1050, 1053, 1057, 1112, 0,
323                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
324         /* 1440x900@60Hz RB */
325         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 88750, 1440, 1488,
326                    1520, 1600, 0, 900, 903, 909, 926, 0,
327                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
328         /* 1440x900@60Hz */
329         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 106500, 1440, 1520,
330                    1672, 1904, 0, 900, 903, 909, 934, 0,
331                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
332         /* 1440x900@75Hz */
333         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 136750, 1440, 1536,
334                    1688, 1936, 0, 900, 903, 909, 942, 0,
335                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
336         /* 1440x900@85Hz */
337         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 157000, 1440, 1544,
338                    1696, 1952, 0, 900, 903, 909, 948, 0,
339                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
340         /* 1440x900@120Hz RB */
341         { DRM_MODE("1440x900", DRM_MODE_TYPE_DRIVER, 182750, 1440, 1488,
342                    1520, 1600, 0, 900, 903, 909, 953, 0,
343                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
344         /* 1600x1200@60Hz */
345         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 162000, 1600, 1664,
346                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
347                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
348         /* 1600x1200@65Hz */
349         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 175500, 1600, 1664,
350                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
351                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
352         /* 1600x1200@70Hz */
353         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 189000, 1600, 1664,
354                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
355                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
356         /* 1600x1200@75Hz */
357         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 202500, 1600, 1664,
358                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
359                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
360         /* 1600x1200@85Hz */
361         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 229500, 1600, 1664,
362                    1856, 2160, 0, 1200, 1201, 1204, 1250, 0,
363                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) },
364         /* 1600x1200@120Hz RB */
365         { DRM_MODE("1600x1200", DRM_MODE_TYPE_DRIVER, 268250, 1600, 1648,
366                    1680, 1760, 0, 1200, 1203, 1207, 1271, 0,
367                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
368         /* 1680x1050@60Hz RB */
369         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 119000, 1680, 1728,
370                    1760, 1840, 0, 1050, 1053, 1059, 1080, 0,
371                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
372         /* 1680x1050@60Hz */
373         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 146250, 1680, 1784,
374                    1960, 2240, 0, 1050, 1053, 1059, 1089, 0,
375                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
376         /* 1680x1050@75Hz */
377         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 187000, 1680, 1800,
378                    1976, 2272, 0, 1050, 1053, 1059, 1099, 0,
379                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
380         /* 1680x1050@85Hz */
381         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 214750, 1680, 1808,
382                    1984, 2288, 0, 1050, 1053, 1059, 1105, 0,
383                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
384         /* 1680x1050@120Hz RB */
385         { DRM_MODE("1680x1050", DRM_MODE_TYPE_DRIVER, 245500, 1680, 1728,
386                    1760, 1840, 0, 1050, 1053, 1059, 1112, 0,
387                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
388         /* 1792x1344@60Hz */
389         { DRM_MODE("1792x1344", DRM_MODE_TYPE_DRIVER, 204750, 1792, 1920,
390                    2120, 2448, 0, 1344, 1345, 1348, 1394, 0,
391                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
392         /* 1792x1344@75Hz */
393         { DRM_MODE("1792x1344", DRM_MODE_TYPE_DRIVER, 261000, 1792, 1888,
394                    2104, 2456, 0, 1344, 1345, 1348, 1417, 0,
395                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
396         /* 1792x1344@120Hz RB */
397         { DRM_MODE("1792x1344", DRM_MODE_TYPE_DRIVER, 333250, 1792, 1840,
398                    1872, 1952, 0, 1344, 1347, 1351, 1423, 0,
399                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
400         /* 1856x1392@60Hz */
401         { DRM_MODE("1856x1392", DRM_MODE_TYPE_DRIVER, 218250, 1856, 1952,
402                    2176, 2528, 0, 1392, 1393, 1396, 1439, 0,
403                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
404         /* 1856x1392@75Hz */
405         { DRM_MODE("1856x1392", DRM_MODE_TYPE_DRIVER, 288000, 1856, 1984,
406                    2208, 2560, 0, 1392, 1395, 1399, 1500, 0,
407                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
408         /* 1856x1392@120Hz RB */
409         { DRM_MODE("1856x1392", DRM_MODE_TYPE_DRIVER, 356500, 1856, 1904,
410                    1936, 2016, 0, 1392, 1395, 1399, 1474, 0,
411                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
412         /* 1920x1200@60Hz RB */
413         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 154000, 1920, 1968,
414                    2000, 2080, 0, 1200, 1203, 1209, 1235, 0,
415                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
416         /* 1920x1200@60Hz */
417         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 193250, 1920, 2056,
418                    2256, 2592, 0, 1200, 1203, 1209, 1245, 0,
419                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
420         /* 1920x1200@75Hz */
421         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 245250, 1920, 2056,
422                    2264, 2608, 0, 1200, 1203, 1209, 1255, 0,
423                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
424         /* 1920x1200@85Hz */
425         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 281250, 1920, 2064,
426                    2272, 2624, 0, 1200, 1203, 1209, 1262, 0,
427                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
428         /* 1920x1200@120Hz RB */
429         { DRM_MODE("1920x1200", DRM_MODE_TYPE_DRIVER, 317000, 1920, 1968,
430                    2000, 2080, 0, 1200, 1203, 1209, 1271, 0,
431                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
432         /* 1920x1440@60Hz */
433         { DRM_MODE("1920x1440", DRM_MODE_TYPE_DRIVER, 234000, 1920, 2048,
434                    2256, 2600, 0, 1440, 1441, 1444, 1500, 0,
435                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
436         /* 1920x1440@75Hz */
437         { DRM_MODE("1920x1440", DRM_MODE_TYPE_DRIVER, 297000, 1920, 2064,
438                    2288, 2640, 0, 1440, 1441, 1444, 1500, 0,
439                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
440         /* 1920x1440@120Hz RB */
441         { DRM_MODE("1920x1440", DRM_MODE_TYPE_DRIVER, 380500, 1920, 1968,
442                    2000, 2080, 0, 1440, 1443, 1447, 1525, 0,
443                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
444         /* 2560x1600@60Hz RB */
445         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 268500, 2560, 2608,
446                    2640, 2720, 0, 1600, 1603, 1609, 1646, 0,
447                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
448         /* 2560x1600@60Hz */
449         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 348500, 2560, 2752,
450                    3032, 3504, 0, 1600, 1603, 1609, 1658, 0,
451                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
452         /* 2560x1600@75HZ */
453         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 443250, 2560, 2768,
454                    3048, 3536, 0, 1600, 1603, 1609, 1672, 0,
455                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
456         /* 2560x1600@85HZ */
457         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 505250, 2560, 2768,
458                    3048, 3536, 0, 1600, 1603, 1609, 1682, 0,
459                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) },
460         /* 2560x1600@120Hz RB */
461         { DRM_MODE("2560x1600", DRM_MODE_TYPE_DRIVER, 552750, 2560, 2608,
462                    2640, 2720, 0, 1600, 1603, 1609, 1694, 0,
463                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC) },
464 };
465
466 /*
467  * These more or less come from the DMT spec.  The 720x400 modes are
468  * inferred from historical 80x25 practice.  The 640x480@67 and 832x624@75
469  * modes are old-school Mac modes.  The EDID spec says the 1152x864@75 mode
470  * should be 1152x870, again for the Mac, but instead we use the x864 DMT
471  * mode.
472  *
473  * The DMT modes have been fact-checked; the rest are mild guesses.
474  */
475 static const struct drm_display_mode edid_est_modes[] = {
476         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 40000, 800, 840,
477                    968, 1056, 0, 600, 601, 605, 628, 0,
478                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@60Hz */
479         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 36000, 800, 824,
480                    896, 1024, 0, 600, 601, 603,  625, 0,
481                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@56Hz */
482         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 656,
483                    720, 840, 0, 480, 481, 484, 500, 0,
484                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@75Hz */
485         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 31500, 640, 664,
486                    704,  832, 0, 480, 489, 491, 520, 0,
487                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@72Hz */
488         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 30240, 640, 704,
489                    768,  864, 0, 480, 483, 486, 525, 0,
490                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@67Hz */
491         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25200, 640, 656,
492                    752, 800, 0, 480, 490, 492, 525, 0,
493                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 640x480@60Hz */
494         { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 35500, 720, 738,
495                    846, 900, 0, 400, 421, 423,  449, 0,
496                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 720x400@88Hz */
497         { DRM_MODE("720x400", DRM_MODE_TYPE_DRIVER, 28320, 720, 738,
498                    846,  900, 0, 400, 412, 414, 449, 0,
499                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 720x400@70Hz */
500         { DRM_MODE("1280x1024", DRM_MODE_TYPE_DRIVER, 135000, 1280, 1296,
501                    1440, 1688, 0, 1024, 1025, 1028, 1066, 0,
502                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1280x1024@75Hz */
503         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 78800, 1024, 1040,
504                    1136, 1312, 0,  768, 769, 772, 800, 0,
505                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1024x768@75Hz */
506         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 75000, 1024, 1048,
507                    1184, 1328, 0,  768, 771, 777, 806, 0,
508                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 1024x768@70Hz */
509         { DRM_MODE("1024x768", DRM_MODE_TYPE_DRIVER, 65000, 1024, 1048,
510                    1184, 1344, 0,  768, 771, 777, 806, 0,
511                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 1024x768@60Hz */
512         { DRM_MODE("1024x768i", DRM_MODE_TYPE_DRIVER,44900, 1024, 1032,
513                    1208, 1264, 0, 768, 768, 776, 817, 0,
514                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC | DRM_MODE_FLAG_INTERLACE) }, /* 1024x768@43Hz */
515         { DRM_MODE("832x624", DRM_MODE_TYPE_DRIVER, 57284, 832, 864,
516                    928, 1152, 0, 624, 625, 628, 667, 0,
517                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC) }, /* 832x624@75Hz */
518         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 49500, 800, 816,
519                    896, 1056, 0, 600, 601, 604,  625, 0,
520                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@75Hz */
521         { DRM_MODE("800x600", DRM_MODE_TYPE_DRIVER, 50000, 800, 856,
522                    976, 1040, 0, 600, 637, 643, 666, 0,
523                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 800x600@72Hz */
524         { DRM_MODE("1152x864", DRM_MODE_TYPE_DRIVER, 108000, 1152, 1216,
525                    1344, 1600, 0,  864, 865, 868, 900, 0,
526                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC) }, /* 1152x864@75Hz */
527 };
528
529 struct minimode {
530         short w;
531         short h;
532         short r;
533         short rb;
534 };
535
536 static const struct minimode est3_modes[] = {
537         /* byte 6 */
538         { 640, 350, 85, 0 },
539         { 640, 400, 85, 0 },
540         { 720, 400, 85, 0 },
541         { 640, 480, 85, 0 },
542         { 848, 480, 60, 0 },
543         { 800, 600, 85, 0 },
544         { 1024, 768, 85, 0 },
545         { 1152, 864, 75, 0 },
546         /* byte 7 */
547         { 1280, 768, 60, 1 },
548         { 1280, 768, 60, 0 },
549         { 1280, 768, 75, 0 },
550         { 1280, 768, 85, 0 },
551         { 1280, 960, 60, 0 },
552         { 1280, 960, 85, 0 },
553         { 1280, 1024, 60, 0 },
554         { 1280, 1024, 85, 0 },
555         /* byte 8 */
556         { 1360, 768, 60, 0 },
557         { 1440, 900, 60, 1 },
558         { 1440, 900, 60, 0 },
559         { 1440, 900, 75, 0 },
560         { 1440, 900, 85, 0 },
561         { 1400, 1050, 60, 1 },
562         { 1400, 1050, 60, 0 },
563         { 1400, 1050, 75, 0 },
564         /* byte 9 */
565         { 1400, 1050, 85, 0 },
566         { 1680, 1050, 60, 1 },
567         { 1680, 1050, 60, 0 },
568         { 1680, 1050, 75, 0 },
569         { 1680, 1050, 85, 0 },
570         { 1600, 1200, 60, 0 },
571         { 1600, 1200, 65, 0 },
572         { 1600, 1200, 70, 0 },
573         /* byte 10 */
574         { 1600, 1200, 75, 0 },
575         { 1600, 1200, 85, 0 },
576         { 1792, 1344, 60, 0 },
577         { 1792, 1344, 75, 0 },
578         { 1856, 1392, 60, 0 },
579         { 1856, 1392, 75, 0 },
580         { 1920, 1200, 60, 1 },
581         { 1920, 1200, 60, 0 },
582         /* byte 11 */
583         { 1920, 1200, 75, 0 },
584         { 1920, 1200, 85, 0 },
585         { 1920, 1440, 60, 0 },
586         { 1920, 1440, 75, 0 },
587 };
588
589 static const struct minimode extra_modes[] = {
590         { 1024, 576,  60, 0 },
591         { 1366, 768,  60, 0 },
592         { 1600, 900,  60, 0 },
593         { 1680, 945,  60, 0 },
594         { 1920, 1080, 60, 0 },
595         { 2048, 1152, 60, 0 },
596         { 2048, 1536, 60, 0 },
597 };
598
599 /*
600  * Probably taken from CEA-861 spec.
601  * This table is converted from xorg's hw/xfree86/modes/xf86EdidModes.c.
602  */
603 static const struct drm_display_mode edid_cea_modes[] = {
604         /* 1 - 640x480@60Hz */
605         { DRM_MODE("640x480", DRM_MODE_TYPE_DRIVER, 25175, 640, 656,
606                    752, 800, 0, 480, 490, 492, 525, 0,
607                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
608           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
609         /* 2 - 720x480@60Hz */
610         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
611                    798, 858, 0, 480, 489, 495, 525, 0,
612                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
613           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
614         /* 3 - 720x480@60Hz */
615         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 27000, 720, 736,
616                    798, 858, 0, 480, 489, 495, 525, 0,
617                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
618           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
619         /* 4 - 1280x720@60Hz */
620         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 1390,
621                    1430, 1650, 0, 720, 725, 730, 750, 0,
622                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
623           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
624         /* 5 - 1920x1080i@60Hz */
625         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
626                    2052, 2200, 0, 1080, 1084, 1094, 1125, 0,
627                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
628                         DRM_MODE_FLAG_INTERLACE),
629           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
630         /* 6 - 1440x480i@60Hz */
631         { DRM_MODE("1440x480i", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1478,
632                    1602, 1716, 0, 480, 488, 494, 525, 0,
633                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
634                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
635           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
636         /* 7 - 1440x480i@60Hz */
637         { DRM_MODE("1440x480i", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1478,
638                    1602, 1716, 0, 480, 488, 494, 525, 0,
639                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
640                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
641           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
642         /* 8 - 1440x240@60Hz */
643         { DRM_MODE("1440x240", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1478,
644                    1602, 1716, 0, 240, 244, 247, 262, 0,
645                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
646                         DRM_MODE_FLAG_DBLCLK),
647           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
648         /* 9 - 1440x240@60Hz */
649         { DRM_MODE("1440x240", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1478,
650                    1602, 1716, 0, 240, 244, 247, 262, 0,
651                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
652                         DRM_MODE_FLAG_DBLCLK),
653           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
654         /* 10 - 2880x480i@60Hz */
655         { DRM_MODE("2880x480i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
656                    3204, 3432, 0, 480, 488, 494, 525, 0,
657                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
658                         DRM_MODE_FLAG_INTERLACE),
659           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
660         /* 11 - 2880x480i@60Hz */
661         { DRM_MODE("2880x480i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
662                    3204, 3432, 0, 480, 488, 494, 525, 0,
663                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
664                         DRM_MODE_FLAG_INTERLACE),
665           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
666         /* 12 - 2880x240@60Hz */
667         { DRM_MODE("2880x240", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
668                    3204, 3432, 0, 240, 244, 247, 262, 0,
669                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
670           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
671         /* 13 - 2880x240@60Hz */
672         { DRM_MODE("2880x240", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2956,
673                    3204, 3432, 0, 240, 244, 247, 262, 0,
674                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
675           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
676         /* 14 - 1440x480@60Hz */
677         { DRM_MODE("1440x480", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1472,
678                    1596, 1716, 0, 480, 489, 495, 525, 0,
679                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
680           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
681         /* 15 - 1440x480@60Hz */
682         { DRM_MODE("1440x480", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1472,
683                    1596, 1716, 0, 480, 489, 495, 525, 0,
684                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
685           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
686         /* 16 - 1920x1080@60Hz */
687         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
688                    2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
689                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
690           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
691         /* 17 - 720x576@50Hz */
692         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
693                    796, 864, 0, 576, 581, 586, 625, 0,
694                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
695           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
696         /* 18 - 720x576@50Hz */
697         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 27000, 720, 732,
698                    796, 864, 0, 576, 581, 586, 625, 0,
699                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
700           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
701         /* 19 - 1280x720@50Hz */
702         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 1720,
703                    1760, 1980, 0, 720, 725, 730, 750, 0,
704                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
705           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
706         /* 20 - 1920x1080i@50Hz */
707         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
708                    2492, 2640, 0, 1080, 1084, 1094, 1125, 0,
709                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
710                         DRM_MODE_FLAG_INTERLACE),
711           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
712         /* 21 - 1440x576i@50Hz */
713         { DRM_MODE("1440x576i", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1464,
714                    1590, 1728, 0, 576, 580, 586, 625, 0,
715                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
716                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
717           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
718         /* 22 - 1440x576i@50Hz */
719         { DRM_MODE("1440x576i", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1464,
720                    1590, 1728, 0, 576, 580, 586, 625, 0,
721                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
722                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
723           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
724         /* 23 - 1440x288@50Hz */
725         { DRM_MODE("1440x288", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1464,
726                    1590, 1728, 0, 288, 290, 293, 312, 0,
727                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
728                         DRM_MODE_FLAG_DBLCLK),
729           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
730         /* 24 - 1440x288@50Hz */
731         { DRM_MODE("1440x288", DRM_MODE_TYPE_DRIVER, 27000, 1440, 1464,
732                    1590, 1728, 0, 288, 290, 293, 312, 0,
733                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
734                         DRM_MODE_FLAG_DBLCLK),
735           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
736         /* 25 - 2880x576i@50Hz */
737         { DRM_MODE("2880x576i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
738                    3180, 3456, 0, 576, 580, 586, 625, 0,
739                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
740                         DRM_MODE_FLAG_INTERLACE),
741           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
742         /* 26 - 2880x576i@50Hz */
743         { DRM_MODE("2880x576i", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
744                    3180, 3456, 0, 576, 580, 586, 625, 0,
745                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
746                         DRM_MODE_FLAG_INTERLACE),
747           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
748         /* 27 - 2880x288@50Hz */
749         { DRM_MODE("2880x288", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
750                    3180, 3456, 0, 288, 290, 293, 312, 0,
751                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
752           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
753         /* 28 - 2880x288@50Hz */
754         { DRM_MODE("2880x288", DRM_MODE_TYPE_DRIVER, 54000, 2880, 2928,
755                    3180, 3456, 0, 288, 290, 293, 312, 0,
756                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
757           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
758         /* 29 - 1440x576@50Hz */
759         { DRM_MODE("1440x576", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
760                    1592, 1728, 0, 576, 581, 586, 625, 0,
761                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
762           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
763         /* 30 - 1440x576@50Hz */
764         { DRM_MODE("1440x576", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
765                    1592, 1728, 0, 576, 581, 586, 625, 0,
766                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
767           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
768         /* 31 - 1920x1080@50Hz */
769         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
770                    2492, 2640, 0, 1080, 1084, 1089, 1125, 0,
771                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
772           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
773         /* 32 - 1920x1080@24Hz */
774         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2558,
775                    2602, 2750, 0, 1080, 1084, 1089, 1125, 0,
776                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
777           .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
778         /* 33 - 1920x1080@25Hz */
779         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2448,
780                    2492, 2640, 0, 1080, 1084, 1089, 1125, 0,
781                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
782           .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
783         /* 34 - 1920x1080@30Hz */
784         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 74250, 1920, 2008,
785                    2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
786                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
787           .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
788         /* 35 - 2880x480@60Hz */
789         { DRM_MODE("2880x480", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2944,
790                    3192, 3432, 0, 480, 489, 495, 525, 0,
791                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
792           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
793         /* 36 - 2880x480@60Hz */
794         { DRM_MODE("2880x480", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2944,
795                    3192, 3432, 0, 480, 489, 495, 525, 0,
796                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
797           .vrefresh = 60, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
798         /* 37 - 2880x576@50Hz */
799         { DRM_MODE("2880x576", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2928,
800                    3184, 3456, 0, 576, 581, 586, 625, 0,
801                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
802           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
803         /* 38 - 2880x576@50Hz */
804         { DRM_MODE("2880x576", DRM_MODE_TYPE_DRIVER, 108000, 2880, 2928,
805                    3184, 3456, 0, 576, 581, 586, 625, 0,
806                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
807           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
808         /* 39 - 1920x1080i@50Hz */
809         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 72000, 1920, 1952,
810                    2120, 2304, 0, 1080, 1126, 1136, 1250, 0,
811                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_NVSYNC |
812                         DRM_MODE_FLAG_INTERLACE),
813           .vrefresh = 50, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
814         /* 40 - 1920x1080i@100Hz */
815         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2448,
816                    2492, 2640, 0, 1080, 1084, 1094, 1125, 0,
817                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
818                         DRM_MODE_FLAG_INTERLACE),
819           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
820         /* 41 - 1280x720@100Hz */
821         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 148500, 1280, 1720,
822                    1760, 1980, 0, 720, 725, 730, 750, 0,
823                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
824           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
825         /* 42 - 720x576@100Hz */
826         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
827                    796, 864, 0, 576, 581, 586, 625, 0,
828                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
829           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
830         /* 43 - 720x576@100Hz */
831         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 54000, 720, 732,
832                    796, 864, 0, 576, 581, 586, 625, 0,
833                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
834           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
835         /* 44 - 1440x576i@100Hz */
836         { DRM_MODE("1440x576", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
837                    1590, 1728, 0, 576, 580, 586, 625, 0,
838                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
839                         DRM_MODE_FLAG_DBLCLK),
840           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
841         /* 45 - 1440x576i@100Hz */
842         { DRM_MODE("1440x576", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1464,
843                    1590, 1728, 0, 576, 580, 586, 625, 0,
844                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
845                         DRM_MODE_FLAG_DBLCLK),
846           .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
847         /* 46 - 1920x1080i@120Hz */
848         { DRM_MODE("1920x1080i", DRM_MODE_TYPE_DRIVER, 148500, 1920, 2008,
849                    2052, 2200, 0, 1080, 1084, 1094, 1125, 0,
850                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC |
851                         DRM_MODE_FLAG_INTERLACE),
852           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
853         /* 47 - 1280x720@120Hz */
854         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 148500, 1280, 1390,
855                    1430, 1650, 0, 720, 725, 730, 750, 0,
856                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
857           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
858         /* 48 - 720x480@120Hz */
859         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 54000, 720, 736,
860                    798, 858, 0, 480, 489, 495, 525, 0,
861                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
862           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
863         /* 49 - 720x480@120Hz */
864         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 54000, 720, 736,
865                    798, 858, 0, 480, 489, 495, 525, 0,
866                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
867           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
868         /* 50 - 1440x480i@120Hz */
869         { DRM_MODE("1440x480i", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1478,
870                    1602, 1716, 0, 480, 488, 494, 525, 0,
871                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
872                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
873           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
874         /* 51 - 1440x480i@120Hz */
875         { DRM_MODE("1440x480i", DRM_MODE_TYPE_DRIVER, 54000, 1440, 1478,
876                    1602, 1716, 0, 480, 488, 494, 525, 0,
877                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
878                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
879           .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
880         /* 52 - 720x576@200Hz */
881         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 108000, 720, 732,
882                    796, 864, 0, 576, 581, 586, 625, 0,
883                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
884           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
885         /* 53 - 720x576@200Hz */
886         { DRM_MODE("720x576", DRM_MODE_TYPE_DRIVER, 108000, 720, 732,
887                    796, 864, 0, 576, 581, 586, 625, 0,
888                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
889           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
890         /* 54 - 1440x576i@200Hz */
891         { DRM_MODE("1440x576i", DRM_MODE_TYPE_DRIVER, 108000, 1440, 1464,
892                    1590, 1728, 0, 576, 580, 586, 625, 0,
893                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
894                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
895           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
896         /* 55 - 1440x576i@200Hz */
897         { DRM_MODE("1440x576i", DRM_MODE_TYPE_DRIVER, 108000, 1440, 1464,
898                    1590, 1728, 0, 576, 580, 586, 625, 0,
899                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
900                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
901           .vrefresh = 200, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
902         /* 56 - 720x480@240Hz */
903         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 108000, 720, 736,
904                    798, 858, 0, 480, 489, 495, 525, 0,
905                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
906           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
907         /* 57 - 720x480@240Hz */
908         { DRM_MODE("720x480", DRM_MODE_TYPE_DRIVER, 108000, 720, 736,
909                    798, 858, 0, 480, 489, 495, 525, 0,
910                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC),
911           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
912         /* 58 - 1440x480i@240 */
913         { DRM_MODE("1440x480i", DRM_MODE_TYPE_DRIVER, 108000, 1440, 1478,
914                    1602, 1716, 0, 480, 488, 494, 525, 0,
915                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
916                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
917           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_4_3, },
918         /* 59 - 1440x480i@240 */
919         { DRM_MODE("1440x480i", DRM_MODE_TYPE_DRIVER, 108000, 1440, 1478,
920                    1602, 1716, 0, 480, 488, 494, 525, 0,
921                    DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC |
922                         DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_DBLCLK),
923           .vrefresh = 240, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
924         /* 60 - 1280x720@24Hz */
925         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 59400, 1280, 3040,
926                    3080, 3300, 0, 720, 725, 730, 750, 0,
927                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
928           .vrefresh = 24, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
929         /* 61 - 1280x720@25Hz */
930         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 3700,
931                    3740, 3960, 0, 720, 725, 730, 750, 0,
932                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
933           .vrefresh = 25, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
934         /* 62 - 1280x720@30Hz */
935         { DRM_MODE("1280x720", DRM_MODE_TYPE_DRIVER, 74250, 1280, 3040,
936                    3080, 3300, 0, 720, 725, 730, 750, 0,
937                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
938           .vrefresh = 30, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
939         /* 63 - 1920x1080@120Hz */
940         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 297000, 1920, 2008,
941                    2052, 2200, 0, 1080, 1084, 1089, 1125, 0,
942                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
943          .vrefresh = 120, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
944         /* 64 - 1920x1080@100Hz */
945         { DRM_MODE("1920x1080", DRM_MODE_TYPE_DRIVER, 297000, 1920, 2448,
946                    2492, 2640, 0, 1080, 1084, 1094, 1125, 0,
947                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
948          .vrefresh = 100, .picture_aspect_ratio = HDMI_PICTURE_ASPECT_16_9, },
949 };
950
951 /*
952  * HDMI 1.4 4k modes.
953  */
954 static const struct drm_display_mode edid_4k_modes[] = {
955         /* 1 - 3840x2160@30Hz */
956         { DRM_MODE("3840x2160", DRM_MODE_TYPE_DRIVER, 297000,
957                    3840, 4016, 4104, 4400, 0,
958                    2160, 2168, 2178, 2250, 0,
959                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
960           .vrefresh = 30, },
961         /* 2 - 3840x2160@25Hz */
962         { DRM_MODE("3840x2160", DRM_MODE_TYPE_DRIVER, 297000,
963                    3840, 4896, 4984, 5280, 0,
964                    2160, 2168, 2178, 2250, 0,
965                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
966           .vrefresh = 25, },
967         /* 3 - 3840x2160@24Hz */
968         { DRM_MODE("3840x2160", DRM_MODE_TYPE_DRIVER, 297000,
969                    3840, 5116, 5204, 5500, 0,
970                    2160, 2168, 2178, 2250, 0,
971                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
972           .vrefresh = 24, },
973         /* 4 - 4096x2160@24Hz (SMPTE) */
974         { DRM_MODE("4096x2160", DRM_MODE_TYPE_DRIVER, 297000,
975                    4096, 5116, 5204, 5500, 0,
976                    2160, 2168, 2178, 2250, 0,
977                    DRM_MODE_FLAG_PHSYNC | DRM_MODE_FLAG_PVSYNC),
978           .vrefresh = 24, },
979 };
980
981 /*** DDC fetch and block validation ***/
982
983 static const u8 edid_header[] = {
984         0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00
985 };
986
987  /*
988  * Sanity check the header of the base EDID block.  Return 8 if the header
989  * is perfect, down to 0 if it's totally wrong.
990  */
991 int drm_edid_header_is_valid(const u8 *raw_edid)
992 {
993         int i, score = 0;
994
995         for (i = 0; i < sizeof(edid_header); i++)
996                 if (raw_edid[i] == edid_header[i])
997                         score++;
998
999         return score;
1000 }
1001 EXPORT_SYMBOL(drm_edid_header_is_valid);
1002
1003 static int edid_fixup __read_mostly = 6;
1004 module_param_named(edid_fixup, edid_fixup, int, 0400);
1005 MODULE_PARM_DESC(edid_fixup,
1006                  "Minimum number of valid EDID header bytes (0-8, default 6)");
1007
1008 /*
1009  * Sanity check the EDID block (base or extension).  Return 0 if the block
1010  * doesn't check out, or 1 if it's valid.
1011  */
1012 bool drm_edid_block_valid(u8 *raw_edid, int block, bool print_bad_edid)
1013 {
1014         int i;
1015         u8 csum = 0;
1016         struct edid *edid = (struct edid *)raw_edid;
1017
1018         if (WARN_ON(!raw_edid))
1019                 return false;
1020
1021         if (edid_fixup > 8 || edid_fixup < 0)
1022                 edid_fixup = 6;
1023
1024         if (block == 0) {
1025                 int score = drm_edid_header_is_valid(raw_edid);
1026                 if (score == 8) ;
1027                 else if (score >= edid_fixup) {
1028                         DRM_DEBUG("Fixing EDID header, your hardware may be failing\n");
1029                         memcpy(raw_edid, edid_header, sizeof(edid_header));
1030                 } else {
1031                         goto bad;
1032                 }
1033         }
1034
1035         for (i = 0; i < EDID_LENGTH; i++)
1036                 csum += raw_edid[i];
1037         if (csum) {
1038                 if (print_bad_edid) {
1039                         DRM_ERROR("EDID checksum is invalid, remainder is %d\n", csum);
1040                 }
1041
1042                 /* allow CEA to slide through, switches mangle this */
1043                 if (raw_edid[0] != 0x02)
1044                         goto bad;
1045         }
1046
1047         /* per-block-type checks */
1048         switch (raw_edid[0]) {
1049         case 0: /* base */
1050                 if (edid->version != 1) {
1051                         DRM_ERROR("EDID has major version %d, instead of 1\n", edid->version);
1052                         goto bad;
1053                 }
1054
1055                 if (edid->revision > 4)
1056                         DRM_DEBUG("EDID minor > 4, assuming backward compatibility\n");
1057                 break;
1058
1059         default:
1060                 break;
1061         }
1062
1063         return true;
1064
1065 bad:
1066         if (print_bad_edid) {
1067                 printk(KERN_ERR "Raw EDID:\n");
1068                 print_hex_dump(KERN_ERR, " \t", DUMP_PREFIX_NONE, 16, 1,
1069                                raw_edid, EDID_LENGTH, false);
1070         }
1071         return false;
1072 }
1073 EXPORT_SYMBOL(drm_edid_block_valid);
1074
1075 /**
1076  * drm_edid_is_valid - sanity check EDID data
1077  * @edid: EDID data
1078  *
1079  * Sanity-check an entire EDID record (including extensions)
1080  */
1081 bool drm_edid_is_valid(struct edid *edid)
1082 {
1083         int i;
1084         u8 *raw = (u8 *)edid;
1085
1086         if (!edid)
1087                 return false;
1088
1089         for (i = 0; i <= edid->extensions; i++)
1090                 if (!drm_edid_block_valid(raw + i * EDID_LENGTH, i, true))
1091                         return false;
1092
1093         return true;
1094 }
1095 EXPORT_SYMBOL(drm_edid_is_valid);
1096
1097 #define DDC_SEGMENT_ADDR 0x30
1098 /**
1099  * Get EDID information via I2C.
1100  *
1101  * \param adapter : i2c device adaptor
1102  * \param buf     : EDID data buffer to be filled
1103  * \param len     : EDID data buffer length
1104  * \return 0 on success or -1 on failure.
1105  *
1106  * Try to fetch EDID information by calling i2c driver function.
1107  */
1108 static int
1109 drm_do_probe_ddc_edid(void *data, u8 *buf, unsigned int block, size_t len)
1110 {
1111         struct i2c_adapter *adapter = data;
1112         unsigned char start = block * EDID_LENGTH;
1113         unsigned char segment = block >> 1;
1114         unsigned char xfers = segment ? 3 : 2;
1115         int ret, retries = 5;
1116
1117         /* The core i2c driver will automatically retry the transfer if the
1118          * adapter reports EAGAIN. However, we find that bit-banging transfers
1119          * are susceptible to errors under a heavily loaded machine and
1120          * generate spurious NAKs and timeouts. Retrying the transfer
1121          * of the individual block a few times seems to overcome this.
1122          */
1123         do {
1124                 struct i2c_msg msgs[] = {
1125                         {
1126                                 .addr   = DDC_SEGMENT_ADDR,
1127                                 .flags  = 0,
1128                                 .len    = 1,
1129                                 .buf    = &segment,
1130                         }, {
1131                                 .addr   = DDC_ADDR,
1132                                 .flags  = 0,
1133                                 .len    = 1,
1134                                 .buf    = &start,
1135                         }, {
1136                                 .addr   = DDC_ADDR,
1137                                 .flags  = I2C_M_RD,
1138                                 .len    = len,
1139                                 .buf    = buf,
1140                         }
1141                 };
1142
1143         /*
1144          * Avoid sending the segment addr to not upset non-compliant ddc
1145          * monitors.
1146          */
1147                 ret = i2c_transfer(adapter, &msgs[3 - xfers], xfers);
1148
1149                 if (ret == -ENXIO) {
1150                         DRM_DEBUG_KMS("drm: skipping non-existent adapter %s\n",
1151                                         adapter->name);
1152                         break;
1153                 }
1154         } while (ret != xfers && --retries);
1155
1156         return ret == xfers ? 0 : -1;
1157 }
1158
1159 static bool drm_edid_is_zero(u8 *in_edid, int length)
1160 {
1161         if (memchr_inv(in_edid, 0, length))
1162                 return false;
1163
1164         return true;
1165 }
1166
1167 /**
1168  * drm_do_get_edid - get EDID data using a custom EDID block read function
1169  * @connector: connector we're probing
1170  * @get_edid_block: EDID block read function
1171  * @data: private data passed to the block read function
1172  *
1173  * When the I2C adapter connected to the DDC bus is hidden behind a device that
1174  * exposes a different interface to read EDID blocks this function can be used
1175  * to get EDID data using a custom block read function.
1176  *
1177  * As in the general case the DDC bus is accessible by the kernel at the I2C
1178  * level, drivers must make all reasonable efforts to expose it as an I2C
1179  * adapter and use drm_get_edid() instead of abusing this function.
1180  *
1181  * Return: Pointer to valid EDID or NULL if we couldn't find any.
1182  */
1183 struct edid *drm_do_get_edid(struct drm_connector *connector,
1184         int (*get_edid_block)(void *data, u8 *buf, unsigned int block,
1185                               size_t len),
1186         void *data)
1187 {
1188         int i, j = 0, valid_extensions = 0;
1189         u8 *block, *new;
1190         bool print_bad_edid = !connector->bad_edid_counter || (drm_debug & DRM_UT_KMS);
1191
1192         if ((block = kmalloc(EDID_LENGTH, GFP_KERNEL)) == NULL)
1193                 return NULL;
1194
1195         /* base block fetch */
1196         for (i = 0; i < 4; i++) {
1197                 if (get_edid_block(data, block, 0, EDID_LENGTH))
1198                         goto out;
1199                 if (drm_edid_block_valid(block, 0, print_bad_edid))
1200                         break;
1201                 if (i == 0 && drm_edid_is_zero(block, EDID_LENGTH)) {
1202                         connector->null_edid_counter++;
1203                         goto carp;
1204                 }
1205         }
1206         if (i == 4)
1207                 goto carp;
1208
1209         /* if there's no extensions, we're done */
1210         if (block[0x7e] == 0)
1211                 return (struct edid *)block;
1212
1213         new = krealloc(block, (block[0x7e] + 1) * EDID_LENGTH, GFP_KERNEL);
1214         if (!new)
1215                 goto out;
1216         block = new;
1217
1218         for (j = 1; j <= block[0x7e]; j++) {
1219                 for (i = 0; i < 4; i++) {
1220                         if (get_edid_block(data,
1221                                   block + (valid_extensions + 1) * EDID_LENGTH,
1222                                   j, EDID_LENGTH))
1223                                 goto out;
1224                         if (drm_edid_block_valid(block + (valid_extensions + 1) * EDID_LENGTH, j, print_bad_edid)) {
1225                                 valid_extensions++;
1226                                 break;
1227                         }
1228                 }
1229
1230                 if (i == 4 && print_bad_edid) {
1231                         dev_warn(connector->dev->dev,
1232                          "%s: Ignoring invalid EDID block %d.\n",
1233                          drm_get_connector_name(connector), j);
1234
1235                         connector->bad_edid_counter++;
1236                 }
1237         }
1238
1239         if (valid_extensions != block[0x7e]) {
1240                 block[EDID_LENGTH-1] += block[0x7e] - valid_extensions;
1241                 block[0x7e] = valid_extensions;
1242                 new = krealloc(block, (valid_extensions + 1) * EDID_LENGTH, GFP_KERNEL);
1243                 if (!new)
1244                         goto out;
1245                 block = new;
1246         }
1247
1248         return (struct edid *)block;
1249
1250 carp:
1251         if (print_bad_edid) {
1252                 dev_warn(connector->dev->dev, "%s: EDID block %d invalid.\n",
1253                          drm_get_connector_name(connector), j);
1254         }
1255         connector->bad_edid_counter++;
1256
1257 out:
1258         kfree(block);
1259         return NULL;
1260 }
1261 EXPORT_SYMBOL_GPL(drm_do_get_edid);
1262
1263 /**
1264  * Probe DDC presence.
1265  *
1266  * \param adapter : i2c device adaptor
1267  * \return 1 on success
1268  */
1269 bool
1270 drm_probe_ddc(struct i2c_adapter *adapter)
1271 {
1272         unsigned char out;
1273
1274         return (drm_do_probe_ddc_edid(adapter, &out, 0, 1) == 0);
1275 }
1276 EXPORT_SYMBOL(drm_probe_ddc);
1277
1278 /**
1279  * drm_get_edid - get EDID data, if available
1280  * @connector: connector we're probing
1281  * @adapter: i2c adapter to use for DDC
1282  *
1283  * Poke the given i2c channel to grab EDID data if possible.  If found,
1284  * attach it to the connector.
1285  *
1286  * Return edid data or NULL if we couldn't find any.
1287  */
1288 struct edid *drm_get_edid(struct drm_connector *connector,
1289                           struct i2c_adapter *adapter)
1290 {
1291         if (!drm_probe_ddc(adapter))
1292                 return NULL;
1293
1294         return drm_do_get_edid(connector, drm_do_probe_ddc_edid, adapter);
1295 }
1296 EXPORT_SYMBOL(drm_get_edid);
1297
1298 /**
1299  * drm_edid_duplicate - duplicate an EDID and the extensions
1300  * @edid: EDID to duplicate
1301  *
1302  * Return duplicate edid or NULL on allocation failure.
1303  */
1304 struct edid *drm_edid_duplicate(const struct edid *edid)
1305 {
1306         return kmemdup(edid, (edid->extensions + 1) * EDID_LENGTH, GFP_KERNEL);
1307 }
1308 EXPORT_SYMBOL(drm_edid_duplicate);
1309
1310 /*** EDID parsing ***/
1311
1312 /**
1313  * edid_vendor - match a string against EDID's obfuscated vendor field
1314  * @edid: EDID to match
1315  * @vendor: vendor string
1316  *
1317  * Returns true if @vendor is in @edid, false otherwise
1318  */
1319 static bool edid_vendor(struct edid *edid, char *vendor)
1320 {
1321         char edid_vendor[3];
1322
1323         edid_vendor[0] = ((edid->mfg_id[0] & 0x7c) >> 2) + '@';
1324         edid_vendor[1] = (((edid->mfg_id[0] & 0x3) << 3) |
1325                           ((edid->mfg_id[1] & 0xe0) >> 5)) + '@';
1326         edid_vendor[2] = (edid->mfg_id[1] & 0x1f) + '@';
1327
1328         return !strncmp(edid_vendor, vendor, 3);
1329 }
1330
1331 /**
1332  * edid_get_quirks - return quirk flags for a given EDID
1333  * @edid: EDID to process
1334  *
1335  * This tells subsequent routines what fixes they need to apply.
1336  */
1337 static u32 edid_get_quirks(struct edid *edid)
1338 {
1339         struct edid_quirk *quirk;
1340         int i;
1341
1342         for (i = 0; i < ARRAY_SIZE(edid_quirk_list); i++) {
1343                 quirk = &edid_quirk_list[i];
1344
1345                 if (edid_vendor(edid, quirk->vendor) &&
1346                     (EDID_PRODUCT_ID(edid) == quirk->product_id))
1347                         return quirk->quirks;
1348         }
1349
1350         return 0;
1351 }
1352
1353 #define MODE_SIZE(m) ((m)->hdisplay * (m)->vdisplay)
1354 #define MODE_REFRESH_DIFF(c,t) (abs((c) - (t)))
1355
1356 /**
1357  * edid_fixup_preferred - set preferred modes based on quirk list
1358  * @connector: has mode list to fix up
1359  * @quirks: quirks list
1360  *
1361  * Walk the mode list for @connector, clearing the preferred status
1362  * on existing modes and setting it anew for the right mode ala @quirks.
1363  */
1364 static void edid_fixup_preferred(struct drm_connector *connector,
1365                                  u32 quirks)
1366 {
1367         struct drm_display_mode *t, *cur_mode, *preferred_mode;
1368         int target_refresh = 0;
1369         int cur_vrefresh, preferred_vrefresh;
1370
1371         if (list_empty(&connector->probed_modes))
1372                 return;
1373
1374         if (quirks & EDID_QUIRK_PREFER_LARGE_60)
1375                 target_refresh = 60;
1376         if (quirks & EDID_QUIRK_PREFER_LARGE_75)
1377                 target_refresh = 75;
1378
1379         preferred_mode = list_first_entry(&connector->probed_modes,
1380                                           struct drm_display_mode, head);
1381
1382         list_for_each_entry_safe(cur_mode, t, &connector->probed_modes, head) {
1383                 cur_mode->type &= ~DRM_MODE_TYPE_PREFERRED;
1384
1385                 if (cur_mode == preferred_mode)
1386                         continue;
1387
1388                 /* Largest mode is preferred */
1389                 if (MODE_SIZE(cur_mode) > MODE_SIZE(preferred_mode))
1390                         preferred_mode = cur_mode;
1391
1392                 cur_vrefresh = cur_mode->vrefresh ?
1393                         cur_mode->vrefresh : drm_mode_vrefresh(cur_mode);
1394                 preferred_vrefresh = preferred_mode->vrefresh ?
1395                         preferred_mode->vrefresh : drm_mode_vrefresh(preferred_mode);
1396                 /* At a given size, try to get closest to target refresh */
1397                 if ((MODE_SIZE(cur_mode) == MODE_SIZE(preferred_mode)) &&
1398                     MODE_REFRESH_DIFF(cur_vrefresh, target_refresh) <
1399                     MODE_REFRESH_DIFF(preferred_vrefresh, target_refresh)) {
1400                         preferred_mode = cur_mode;
1401                 }
1402         }
1403
1404         preferred_mode->type |= DRM_MODE_TYPE_PREFERRED;
1405 }
1406
1407 static bool
1408 mode_is_rb(const struct drm_display_mode *mode)
1409 {
1410         return (mode->htotal - mode->hdisplay == 160) &&
1411                (mode->hsync_end - mode->hdisplay == 80) &&
1412                (mode->hsync_end - mode->hsync_start == 32) &&
1413                (mode->vsync_start - mode->vdisplay == 3);
1414 }
1415
1416 /*
1417  * drm_mode_find_dmt - Create a copy of a mode if present in DMT
1418  * @dev: Device to duplicate against
1419  * @hsize: Mode width
1420  * @vsize: Mode height
1421  * @fresh: Mode refresh rate
1422  * @rb: Mode reduced-blanking-ness
1423  *
1424  * Walk the DMT mode list looking for a match for the given parameters.
1425  * Return a newly allocated copy of the mode, or NULL if not found.
1426  */
1427 struct drm_display_mode *drm_mode_find_dmt(struct drm_device *dev,
1428                                            int hsize, int vsize, int fresh,
1429                                            bool rb)
1430 {
1431         int i;
1432
1433         for (i = 0; i < ARRAY_SIZE(drm_dmt_modes); i++) {
1434                 const struct drm_display_mode *ptr = &drm_dmt_modes[i];
1435                 if (hsize != ptr->hdisplay)
1436                         continue;
1437                 if (vsize != ptr->vdisplay)
1438                         continue;
1439                 if (fresh != drm_mode_vrefresh(ptr))
1440                         continue;
1441                 if (rb != mode_is_rb(ptr))
1442                         continue;
1443
1444                 return drm_mode_duplicate(dev, ptr);
1445         }
1446
1447         return NULL;
1448 }
1449 EXPORT_SYMBOL(drm_mode_find_dmt);
1450
1451 typedef void detailed_cb(struct detailed_timing *timing, void *closure);
1452
1453 static void
1454 cea_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
1455 {
1456         int i, n = 0;
1457         u8 d = ext[0x02];
1458         u8 *det_base = ext + d;
1459
1460         n = (127 - d) / 18;
1461         for (i = 0; i < n; i++)
1462                 cb((struct detailed_timing *)(det_base + 18 * i), closure);
1463 }
1464
1465 static void
1466 vtb_for_each_detailed_block(u8 *ext, detailed_cb *cb, void *closure)
1467 {
1468         unsigned int i, n = min((int)ext[0x02], 6);
1469         u8 *det_base = ext + 5;
1470
1471         if (ext[0x01] != 1)
1472                 return; /* unknown version */
1473
1474         for (i = 0; i < n; i++)
1475                 cb((struct detailed_timing *)(det_base + 18 * i), closure);
1476 }
1477
1478 static void
1479 drm_for_each_detailed_block(u8 *raw_edid, detailed_cb *cb, void *closure)
1480 {
1481         int i;
1482         struct edid *edid = (struct edid *)raw_edid;
1483
1484         if (edid == NULL)
1485                 return;
1486
1487         for (i = 0; i < EDID_DETAILED_TIMINGS; i++)
1488                 cb(&(edid->detailed_timings[i]), closure);
1489
1490         for (i = 1; i <= raw_edid[0x7e]; i++) {
1491                 u8 *ext = raw_edid + (i * EDID_LENGTH);
1492                 switch (*ext) {
1493                 case CEA_EXT:
1494                         cea_for_each_detailed_block(ext, cb, closure);
1495                         break;
1496                 case VTB_EXT:
1497                         vtb_for_each_detailed_block(ext, cb, closure);
1498                         break;
1499                 default:
1500                         break;
1501                 }
1502         }
1503 }
1504
1505 static void
1506 is_rb(struct detailed_timing *t, void *data)
1507 {
1508         u8 *r = (u8 *)t;
1509         if (r[3] == EDID_DETAIL_MONITOR_RANGE)
1510                 if (r[15] & 0x10)
1511                         *(bool *)data = true;
1512 }
1513
1514 /* EDID 1.4 defines this explicitly.  For EDID 1.3, we guess, badly. */
1515 static bool
1516 drm_monitor_supports_rb(struct edid *edid)
1517 {
1518         if (edid->revision >= 4) {
1519                 bool ret = false;
1520                 drm_for_each_detailed_block((u8 *)edid, is_rb, &ret);
1521                 return ret;
1522         }
1523
1524         return ((edid->input & DRM_EDID_INPUT_DIGITAL) != 0);
1525 }
1526
1527 static void
1528 find_gtf2(struct detailed_timing *t, void *data)
1529 {
1530         u8 *r = (u8 *)t;
1531         if (r[3] == EDID_DETAIL_MONITOR_RANGE && r[10] == 0x02)
1532                 *(u8 **)data = r;
1533 }
1534
1535 /* Secondary GTF curve kicks in above some break frequency */
1536 static int
1537 drm_gtf2_hbreak(struct edid *edid)
1538 {
1539         u8 *r = NULL;
1540         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
1541         return r ? (r[12] * 2) : 0;
1542 }
1543
1544 static int
1545 drm_gtf2_2c(struct edid *edid)
1546 {
1547         u8 *r = NULL;
1548         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
1549         return r ? r[13] : 0;
1550 }
1551
1552 static int
1553 drm_gtf2_m(struct edid *edid)
1554 {
1555         u8 *r = NULL;
1556         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
1557         return r ? (r[15] << 8) + r[14] : 0;
1558 }
1559
1560 static int
1561 drm_gtf2_k(struct edid *edid)
1562 {
1563         u8 *r = NULL;
1564         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
1565         return r ? r[16] : 0;
1566 }
1567
1568 static int
1569 drm_gtf2_2j(struct edid *edid)
1570 {
1571         u8 *r = NULL;
1572         drm_for_each_detailed_block((u8 *)edid, find_gtf2, &r);
1573         return r ? r[17] : 0;
1574 }
1575
1576 /**
1577  * standard_timing_level - get std. timing level(CVT/GTF/DMT)
1578  * @edid: EDID block to scan
1579  */
1580 static int standard_timing_level(struct edid *edid)
1581 {
1582         if (edid->revision >= 2) {
1583                 if (edid->revision >= 4 && (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF))
1584                         return LEVEL_CVT;
1585                 if (drm_gtf2_hbreak(edid))
1586                         return LEVEL_GTF2;
1587                 return LEVEL_GTF;
1588         }
1589         return LEVEL_DMT;
1590 }
1591
1592 /*
1593  * 0 is reserved.  The spec says 0x01 fill for unused timings.  Some old
1594  * monitors fill with ascii space (0x20) instead.
1595  */
1596 static int
1597 bad_std_timing(u8 a, u8 b)
1598 {
1599         return (a == 0x00 && b == 0x00) ||
1600                (a == 0x01 && b == 0x01) ||
1601                (a == 0x20 && b == 0x20);
1602 }
1603
1604 /**
1605  * drm_mode_std - convert standard mode info (width, height, refresh) into mode
1606  * @t: standard timing params
1607  * @timing_level: standard timing level
1608  *
1609  * Take the standard timing params (in this case width, aspect, and refresh)
1610  * and convert them into a real mode using CVT/GTF/DMT.
1611  */
1612 static struct drm_display_mode *
1613 drm_mode_std(struct drm_connector *connector, struct edid *edid,
1614              struct std_timing *t, int revision)
1615 {
1616         struct drm_device *dev = connector->dev;
1617         struct drm_display_mode *m, *mode = NULL;
1618         int hsize, vsize;
1619         int vrefresh_rate;
1620         unsigned aspect_ratio = (t->vfreq_aspect & EDID_TIMING_ASPECT_MASK)
1621                 >> EDID_TIMING_ASPECT_SHIFT;
1622         unsigned vfreq = (t->vfreq_aspect & EDID_TIMING_VFREQ_MASK)
1623                 >> EDID_TIMING_VFREQ_SHIFT;
1624         int timing_level = standard_timing_level(edid);
1625
1626         if (bad_std_timing(t->hsize, t->vfreq_aspect))
1627                 return NULL;
1628
1629         /* According to the EDID spec, the hdisplay = hsize * 8 + 248 */
1630         hsize = t->hsize * 8 + 248;
1631         /* vrefresh_rate = vfreq + 60 */
1632         vrefresh_rate = vfreq + 60;
1633         /* the vdisplay is calculated based on the aspect ratio */
1634         if (aspect_ratio == 0) {
1635                 if (revision < 3)
1636                         vsize = hsize;
1637                 else
1638                         vsize = (hsize * 10) / 16;
1639         } else if (aspect_ratio == 1)
1640                 vsize = (hsize * 3) / 4;
1641         else if (aspect_ratio == 2)
1642                 vsize = (hsize * 4) / 5;
1643         else
1644                 vsize = (hsize * 9) / 16;
1645
1646         /* HDTV hack, part 1 */
1647         if (vrefresh_rate == 60 &&
1648             ((hsize == 1360 && vsize == 765) ||
1649              (hsize == 1368 && vsize == 769))) {
1650                 hsize = 1366;
1651                 vsize = 768;
1652         }
1653
1654         /*
1655          * If this connector already has a mode for this size and refresh
1656          * rate (because it came from detailed or CVT info), use that
1657          * instead.  This way we don't have to guess at interlace or
1658          * reduced blanking.
1659          */
1660         list_for_each_entry(m, &connector->probed_modes, head)
1661                 if (m->hdisplay == hsize && m->vdisplay == vsize &&
1662                     drm_mode_vrefresh(m) == vrefresh_rate)
1663                         return NULL;
1664
1665         /* HDTV hack, part 2 */
1666         if (hsize == 1366 && vsize == 768 && vrefresh_rate == 60) {
1667                 mode = drm_cvt_mode(dev, 1366, 768, vrefresh_rate, 0, 0,
1668                                     false);
1669                 mode->hdisplay = 1366;
1670                 mode->hsync_start = mode->hsync_start - 1;
1671                 mode->hsync_end = mode->hsync_end - 1;
1672                 return mode;
1673         }
1674
1675         /* check whether it can be found in default mode table */
1676         if (drm_monitor_supports_rb(edid)) {
1677                 mode = drm_mode_find_dmt(dev, hsize, vsize, vrefresh_rate,
1678                                          true);
1679                 if (mode)
1680                         return mode;
1681         }
1682         mode = drm_mode_find_dmt(dev, hsize, vsize, vrefresh_rate, false);
1683         if (mode)
1684                 return mode;
1685
1686         /* okay, generate it */
1687         switch (timing_level) {
1688         case LEVEL_DMT:
1689                 break;
1690         case LEVEL_GTF:
1691                 mode = drm_gtf_mode(dev, hsize, vsize, vrefresh_rate, 0, 0);
1692                 break;
1693         case LEVEL_GTF2:
1694                 /*
1695                  * This is potentially wrong if there's ever a monitor with
1696                  * more than one ranges section, each claiming a different
1697                  * secondary GTF curve.  Please don't do that.
1698                  */
1699                 mode = drm_gtf_mode(dev, hsize, vsize, vrefresh_rate, 0, 0);
1700                 if (!mode)
1701                         return NULL;
1702                 if (drm_mode_hsync(mode) > drm_gtf2_hbreak(edid)) {
1703                         drm_mode_destroy(dev, mode);
1704                         mode = drm_gtf_mode_complex(dev, hsize, vsize,
1705                                                     vrefresh_rate, 0, 0,
1706                                                     drm_gtf2_m(edid),
1707                                                     drm_gtf2_2c(edid),
1708                                                     drm_gtf2_k(edid),
1709                                                     drm_gtf2_2j(edid));
1710                 }
1711                 break;
1712         case LEVEL_CVT:
1713                 mode = drm_cvt_mode(dev, hsize, vsize, vrefresh_rate, 0, 0,
1714                                     false);
1715                 break;
1716         }
1717         return mode;
1718 }
1719
1720 /*
1721  * EDID is delightfully ambiguous about how interlaced modes are to be
1722  * encoded.  Our internal representation is of frame height, but some
1723  * HDTV detailed timings are encoded as field height.
1724  *
1725  * The format list here is from CEA, in frame size.  Technically we
1726  * should be checking refresh rate too.  Whatever.
1727  */
1728 static void
1729 drm_mode_do_interlace_quirk(struct drm_display_mode *mode,
1730                             struct detailed_pixel_timing *pt)
1731 {
1732         int i;
1733         static const struct {
1734                 int w, h;
1735         } cea_interlaced[] = {
1736                 { 1920, 1080 },
1737                 {  720,  480 },
1738                 { 1440,  480 },
1739                 { 2880,  480 },
1740                 {  720,  576 },
1741                 { 1440,  576 },
1742                 { 2880,  576 },
1743         };
1744
1745         if (!(pt->misc & DRM_EDID_PT_INTERLACED))
1746                 return;
1747
1748         for (i = 0; i < ARRAY_SIZE(cea_interlaced); i++) {
1749                 if ((mode->hdisplay == cea_interlaced[i].w) &&
1750                     (mode->vdisplay == cea_interlaced[i].h / 2)) {
1751                         mode->vdisplay *= 2;
1752                         mode->vsync_start *= 2;
1753                         mode->vsync_end *= 2;
1754                         mode->vtotal *= 2;
1755                         mode->vtotal |= 1;
1756                 }
1757         }
1758
1759         mode->flags |= DRM_MODE_FLAG_INTERLACE;
1760 }
1761
1762 /**
1763  * drm_mode_detailed - create a new mode from an EDID detailed timing section
1764  * @dev: DRM device (needed to create new mode)
1765  * @edid: EDID block
1766  * @timing: EDID detailed timing info
1767  * @quirks: quirks to apply
1768  *
1769  * An EDID detailed timing block contains enough info for us to create and
1770  * return a new struct drm_display_mode.
1771  */
1772 static struct drm_display_mode *drm_mode_detailed(struct drm_device *dev,
1773                                                   struct edid *edid,
1774                                                   struct detailed_timing *timing,
1775                                                   u32 quirks)
1776 {
1777         struct drm_display_mode *mode;
1778         struct detailed_pixel_timing *pt = &timing->data.pixel_data;
1779         unsigned hactive = (pt->hactive_hblank_hi & 0xf0) << 4 | pt->hactive_lo;
1780         unsigned vactive = (pt->vactive_vblank_hi & 0xf0) << 4 | pt->vactive_lo;
1781         unsigned hblank = (pt->hactive_hblank_hi & 0xf) << 8 | pt->hblank_lo;
1782         unsigned vblank = (pt->vactive_vblank_hi & 0xf) << 8 | pt->vblank_lo;
1783         unsigned hsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc0) << 2 | pt->hsync_offset_lo;
1784         unsigned hsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x30) << 4 | pt->hsync_pulse_width_lo;
1785         unsigned vsync_offset = (pt->hsync_vsync_offset_pulse_width_hi & 0xc) << 2 | pt->vsync_offset_pulse_width_lo >> 4;
1786         unsigned vsync_pulse_width = (pt->hsync_vsync_offset_pulse_width_hi & 0x3) << 4 | (pt->vsync_offset_pulse_width_lo & 0xf);
1787
1788         /* ignore tiny modes */
1789         if (hactive < 64 || vactive < 64)
1790                 return NULL;
1791
1792         if (pt->misc & DRM_EDID_PT_STEREO) {
1793                 DRM_DEBUG_KMS("stereo mode not supported\n");
1794                 return NULL;
1795         }
1796         if (!(pt->misc & DRM_EDID_PT_SEPARATE_SYNC)) {
1797                 DRM_DEBUG_KMS("composite sync not supported\n");
1798         }
1799
1800         /* it is incorrect if hsync/vsync width is zero */
1801         if (!hsync_pulse_width || !vsync_pulse_width) {
1802                 DRM_DEBUG_KMS("Incorrect Detailed timing. "
1803                                 "Wrong Hsync/Vsync pulse width\n");
1804                 return NULL;
1805         }
1806
1807         if (quirks & EDID_QUIRK_FORCE_REDUCED_BLANKING) {
1808                 mode = drm_cvt_mode(dev, hactive, vactive, 60, true, false, false);
1809                 if (!mode)
1810                         return NULL;
1811
1812                 goto set_size;
1813         }
1814
1815         mode = drm_mode_create(dev);
1816         if (!mode)
1817                 return NULL;
1818
1819         if (quirks & EDID_QUIRK_135_CLOCK_TOO_HIGH)
1820                 timing->pixel_clock = cpu_to_le16(1088);
1821
1822         mode->clock = le16_to_cpu(timing->pixel_clock) * 10;
1823
1824         mode->hdisplay = hactive;
1825         mode->hsync_start = mode->hdisplay + hsync_offset;
1826         mode->hsync_end = mode->hsync_start + hsync_pulse_width;
1827         mode->htotal = mode->hdisplay + hblank;
1828
1829         mode->vdisplay = vactive;
1830         mode->vsync_start = mode->vdisplay + vsync_offset;
1831         mode->vsync_end = mode->vsync_start + vsync_pulse_width;
1832         mode->vtotal = mode->vdisplay + vblank;
1833
1834         /* Some EDIDs have bogus h/vtotal values */
1835         if (mode->hsync_end > mode->htotal)
1836                 mode->htotal = mode->hsync_end + 1;
1837         if (mode->vsync_end > mode->vtotal)
1838                 mode->vtotal = mode->vsync_end + 1;
1839
1840         drm_mode_do_interlace_quirk(mode, pt);
1841
1842         if (quirks & EDID_QUIRK_DETAILED_SYNC_PP) {
1843                 pt->misc |= DRM_EDID_PT_HSYNC_POSITIVE | DRM_EDID_PT_VSYNC_POSITIVE;
1844         }
1845
1846         mode->flags |= (pt->misc & DRM_EDID_PT_HSYNC_POSITIVE) ?
1847                 DRM_MODE_FLAG_PHSYNC : DRM_MODE_FLAG_NHSYNC;
1848         mode->flags |= (pt->misc & DRM_EDID_PT_VSYNC_POSITIVE) ?
1849                 DRM_MODE_FLAG_PVSYNC : DRM_MODE_FLAG_NVSYNC;
1850
1851 set_size:
1852         mode->width_mm = pt->width_mm_lo | (pt->width_height_mm_hi & 0xf0) << 4;
1853         mode->height_mm = pt->height_mm_lo | (pt->width_height_mm_hi & 0xf) << 8;
1854
1855         if (quirks & EDID_QUIRK_DETAILED_IN_CM) {
1856                 mode->width_mm *= 10;
1857                 mode->height_mm *= 10;
1858         }
1859
1860         if (quirks & EDID_QUIRK_DETAILED_USE_MAXIMUM_SIZE) {
1861                 mode->width_mm = edid->width_cm * 10;
1862                 mode->height_mm = edid->height_cm * 10;
1863         }
1864
1865         mode->type = DRM_MODE_TYPE_DRIVER;
1866         mode->vrefresh = drm_mode_vrefresh(mode);
1867         drm_mode_set_name(mode);
1868
1869         return mode;
1870 }
1871
1872 static bool
1873 mode_in_hsync_range(const struct drm_display_mode *mode,
1874                     struct edid *edid, u8 *t)
1875 {
1876         int hsync, hmin, hmax;
1877
1878         hmin = t[7];
1879         if (edid->revision >= 4)
1880             hmin += ((t[4] & 0x04) ? 255 : 0);
1881         hmax = t[8];
1882         if (edid->revision >= 4)
1883             hmax += ((t[4] & 0x08) ? 255 : 0);
1884         hsync = drm_mode_hsync(mode);
1885
1886         return (hsync <= hmax && hsync >= hmin);
1887 }
1888
1889 static bool
1890 mode_in_vsync_range(const struct drm_display_mode *mode,
1891                     struct edid *edid, u8 *t)
1892 {
1893         int vsync, vmin, vmax;
1894
1895         vmin = t[5];
1896         if (edid->revision >= 4)
1897             vmin += ((t[4] & 0x01) ? 255 : 0);
1898         vmax = t[6];
1899         if (edid->revision >= 4)
1900             vmax += ((t[4] & 0x02) ? 255 : 0);
1901         vsync = drm_mode_vrefresh(mode);
1902
1903         return (vsync <= vmax && vsync >= vmin);
1904 }
1905
1906 static u32
1907 range_pixel_clock(struct edid *edid, u8 *t)
1908 {
1909         /* unspecified */
1910         if (t[9] == 0 || t[9] == 255)
1911                 return 0;
1912
1913         /* 1.4 with CVT support gives us real precision, yay */
1914         if (edid->revision >= 4 && t[10] == 0x04)
1915                 return (t[9] * 10000) - ((t[12] >> 2) * 250);
1916
1917         /* 1.3 is pathetic, so fuzz up a bit */
1918         return t[9] * 10000 + 5001;
1919 }
1920
1921 static bool
1922 mode_in_range(const struct drm_display_mode *mode, struct edid *edid,
1923               struct detailed_timing *timing)
1924 {
1925         u32 max_clock;
1926         u8 *t = (u8 *)timing;
1927
1928         if (!mode_in_hsync_range(mode, edid, t))
1929                 return false;
1930
1931         if (!mode_in_vsync_range(mode, edid, t))
1932                 return false;
1933
1934         if ((max_clock = range_pixel_clock(edid, t)))
1935                 if (mode->clock > max_clock)
1936                         return false;
1937
1938         /* 1.4 max horizontal check */
1939         if (edid->revision >= 4 && t[10] == 0x04)
1940                 if (t[13] && mode->hdisplay > 8 * (t[13] + (256 * (t[12]&0x3))))
1941                         return false;
1942
1943         if (mode_is_rb(mode) && !drm_monitor_supports_rb(edid))
1944                 return false;
1945
1946         return true;
1947 }
1948
1949 static bool valid_inferred_mode(const struct drm_connector *connector,
1950                                 const struct drm_display_mode *mode)
1951 {
1952         struct drm_display_mode *m;
1953         bool ok = false;
1954
1955         list_for_each_entry(m, &connector->probed_modes, head) {
1956                 if (mode->hdisplay == m->hdisplay &&
1957                     mode->vdisplay == m->vdisplay &&
1958                     drm_mode_vrefresh(mode) == drm_mode_vrefresh(m))
1959                         return false; /* duplicated */
1960                 if (mode->hdisplay <= m->hdisplay &&
1961                     mode->vdisplay <= m->vdisplay)
1962                         ok = true;
1963         }
1964         return ok;
1965 }
1966
1967 static int
1968 drm_dmt_modes_for_range(struct drm_connector *connector, struct edid *edid,
1969                         struct detailed_timing *timing)
1970 {
1971         int i, modes = 0;
1972         struct drm_display_mode *newmode;
1973         struct drm_device *dev = connector->dev;
1974
1975         for (i = 0; i < ARRAY_SIZE(drm_dmt_modes); i++) {
1976                 if (mode_in_range(drm_dmt_modes + i, edid, timing) &&
1977                     valid_inferred_mode(connector, drm_dmt_modes + i)) {
1978                         newmode = drm_mode_duplicate(dev, &drm_dmt_modes[i]);
1979                         if (newmode) {
1980                                 drm_mode_probed_add(connector, newmode);
1981                                 modes++;
1982                         }
1983                 }
1984         }
1985
1986         return modes;
1987 }
1988
1989 /* fix up 1366x768 mode from 1368x768;
1990  * GFT/CVT can't express 1366 width which isn't dividable by 8
1991  */
1992 static void fixup_mode_1366x768(struct drm_display_mode *mode)
1993 {
1994         if (mode->hdisplay == 1368 && mode->vdisplay == 768) {
1995                 mode->hdisplay = 1366;
1996                 mode->hsync_start--;
1997                 mode->hsync_end--;
1998                 drm_mode_set_name(mode);
1999         }
2000 }
2001
2002 static int
2003 drm_gtf_modes_for_range(struct drm_connector *connector, struct edid *edid,
2004                         struct detailed_timing *timing)
2005 {
2006         int i, modes = 0;
2007         struct drm_display_mode *newmode;
2008         struct drm_device *dev = connector->dev;
2009
2010         for (i = 0; i < ARRAY_SIZE(extra_modes); i++) {
2011                 const struct minimode *m = &extra_modes[i];
2012                 newmode = drm_gtf_mode(dev, m->w, m->h, m->r, 0, 0);
2013                 if (!newmode)
2014                         return modes;
2015
2016                 fixup_mode_1366x768(newmode);
2017                 if (!mode_in_range(newmode, edid, timing) ||
2018                     !valid_inferred_mode(connector, newmode)) {
2019                         drm_mode_destroy(dev, newmode);
2020                         continue;
2021                 }
2022
2023                 drm_mode_probed_add(connector, newmode);
2024                 modes++;
2025         }
2026
2027         return modes;
2028 }
2029
2030 static int
2031 drm_cvt_modes_for_range(struct drm_connector *connector, struct edid *edid,
2032                         struct detailed_timing *timing)
2033 {
2034         int i, modes = 0;
2035         struct drm_display_mode *newmode;
2036         struct drm_device *dev = connector->dev;
2037         bool rb = drm_monitor_supports_rb(edid);
2038
2039         for (i = 0; i < ARRAY_SIZE(extra_modes); i++) {
2040                 const struct minimode *m = &extra_modes[i];
2041                 newmode = drm_cvt_mode(dev, m->w, m->h, m->r, rb, 0, 0);
2042                 if (!newmode)
2043                         return modes;
2044
2045                 fixup_mode_1366x768(newmode);
2046                 if (!mode_in_range(newmode, edid, timing) ||
2047                     !valid_inferred_mode(connector, newmode)) {
2048                         drm_mode_destroy(dev, newmode);
2049                         continue;
2050                 }
2051
2052                 drm_mode_probed_add(connector, newmode);
2053                 modes++;
2054         }
2055
2056         return modes;
2057 }
2058
2059 static void
2060 do_inferred_modes(struct detailed_timing *timing, void *c)
2061 {
2062         struct detailed_mode_closure *closure = c;
2063         struct detailed_non_pixel *data = &timing->data.other_data;
2064         struct detailed_data_monitor_range *range = &data->data.range;
2065
2066         if (data->type != EDID_DETAIL_MONITOR_RANGE)
2067                 return;
2068
2069         closure->modes += drm_dmt_modes_for_range(closure->connector,
2070                                                   closure->edid,
2071                                                   timing);
2072         
2073         if (!version_greater(closure->edid, 1, 1))
2074                 return; /* GTF not defined yet */
2075
2076         switch (range->flags) {
2077         case 0x02: /* secondary gtf, XXX could do more */
2078         case 0x00: /* default gtf */
2079                 closure->modes += drm_gtf_modes_for_range(closure->connector,
2080                                                           closure->edid,
2081                                                           timing);
2082                 break;
2083         case 0x04: /* cvt, only in 1.4+ */
2084                 if (!version_greater(closure->edid, 1, 3))
2085                         break;
2086
2087                 closure->modes += drm_cvt_modes_for_range(closure->connector,
2088                                                           closure->edid,
2089                                                           timing);
2090                 break;
2091         case 0x01: /* just the ranges, no formula */
2092         default:
2093                 break;
2094         }
2095 }
2096
2097 static int
2098 add_inferred_modes(struct drm_connector *connector, struct edid *edid)
2099 {
2100         struct detailed_mode_closure closure = {
2101                 connector, edid, 0, 0, 0
2102         };
2103
2104         if (version_greater(edid, 1, 0))
2105                 drm_for_each_detailed_block((u8 *)edid, do_inferred_modes,
2106                                             &closure);
2107
2108         return closure.modes;
2109 }
2110
2111 static int
2112 drm_est3_modes(struct drm_connector *connector, struct detailed_timing *timing)
2113 {
2114         int i, j, m, modes = 0;
2115         struct drm_display_mode *mode;
2116         u8 *est = ((u8 *)timing) + 5;
2117
2118         for (i = 0; i < 6; i++) {
2119                 for (j = 7; j >= 0; j--) {
2120                         m = (i * 8) + (7 - j);
2121                         if (m >= ARRAY_SIZE(est3_modes))
2122                                 break;
2123                         if (est[i] & (1 << j)) {
2124                                 mode = drm_mode_find_dmt(connector->dev,
2125                                                          est3_modes[m].w,
2126                                                          est3_modes[m].h,
2127                                                          est3_modes[m].r,
2128                                                          est3_modes[m].rb);
2129                                 if (mode) {
2130                                         drm_mode_probed_add(connector, mode);
2131                                         modes++;
2132                                 }
2133                         }
2134                 }
2135         }
2136
2137         return modes;
2138 }
2139
2140 static void
2141 do_established_modes(struct detailed_timing *timing, void *c)
2142 {
2143         struct detailed_mode_closure *closure = c;
2144         struct detailed_non_pixel *data = &timing->data.other_data;
2145
2146         if (data->type == EDID_DETAIL_EST_TIMINGS)
2147                 closure->modes += drm_est3_modes(closure->connector, timing);
2148 }
2149
2150 /**
2151  * add_established_modes - get est. modes from EDID and add them
2152  * @edid: EDID block to scan
2153  *
2154  * Each EDID block contains a bitmap of the supported "established modes" list
2155  * (defined above).  Tease them out and add them to the global modes list.
2156  */
2157 static int
2158 add_established_modes(struct drm_connector *connector, struct edid *edid)
2159 {
2160         struct drm_device *dev = connector->dev;
2161         unsigned long est_bits = edid->established_timings.t1 |
2162                 (edid->established_timings.t2 << 8) |
2163                 ((edid->established_timings.mfg_rsvd & 0x80) << 9);
2164         int i, modes = 0;
2165         struct detailed_mode_closure closure = {
2166                 connector, edid, 0, 0, 0
2167         };
2168
2169         for (i = 0; i <= EDID_EST_TIMINGS; i++) {
2170                 if (est_bits & (1<<i)) {
2171                         struct drm_display_mode *newmode;
2172                         newmode = drm_mode_duplicate(dev, &edid_est_modes[i]);
2173                         if (newmode) {
2174                                 drm_mode_probed_add(connector, newmode);
2175                                 modes++;
2176                         }
2177                 }
2178         }
2179
2180         if (version_greater(edid, 1, 0))
2181                     drm_for_each_detailed_block((u8 *)edid,
2182                                                 do_established_modes, &closure);
2183
2184         return modes + closure.modes;
2185 }
2186
2187 static void
2188 do_standard_modes(struct detailed_timing *timing, void *c)
2189 {
2190         struct detailed_mode_closure *closure = c;
2191         struct detailed_non_pixel *data = &timing->data.other_data;
2192         struct drm_connector *connector = closure->connector;
2193         struct edid *edid = closure->edid;
2194
2195         if (data->type == EDID_DETAIL_STD_MODES) {
2196                 int i;
2197                 for (i = 0; i < 6; i++) {
2198                         struct std_timing *std;
2199                         struct drm_display_mode *newmode;
2200
2201                         std = &data->data.timings[i];
2202                         newmode = drm_mode_std(connector, edid, std,
2203                                                edid->revision);
2204                         if (newmode) {
2205                                 drm_mode_probed_add(connector, newmode);
2206                                 closure->modes++;
2207                         }
2208                 }
2209         }
2210 }
2211
2212 /**
2213  * add_standard_modes - get std. modes from EDID and add them
2214  * @edid: EDID block to scan
2215  *
2216  * Standard modes can be calculated using the appropriate standard (DMT,
2217  * GTF or CVT. Grab them from @edid and add them to the list.
2218  */
2219 static int
2220 add_standard_modes(struct drm_connector *connector, struct edid *edid)
2221 {
2222         int i, modes = 0;
2223         struct detailed_mode_closure closure = {
2224                 connector, edid, 0, 0, 0
2225         };
2226
2227         for (i = 0; i < EDID_STD_TIMINGS; i++) {
2228                 struct drm_display_mode *newmode;
2229
2230                 newmode = drm_mode_std(connector, edid,
2231                                        &edid->standard_timings[i],
2232                                        edid->revision);
2233                 if (newmode) {
2234                         drm_mode_probed_add(connector, newmode);
2235                         modes++;
2236                 }
2237         }
2238
2239         if (version_greater(edid, 1, 0))
2240                 drm_for_each_detailed_block((u8 *)edid, do_standard_modes,
2241                                             &closure);
2242
2243         /* XXX should also look for standard codes in VTB blocks */
2244
2245         return modes + closure.modes;
2246 }
2247
2248 static int drm_cvt_modes(struct drm_connector *connector,
2249                          struct detailed_timing *timing)
2250 {
2251         int i, j, modes = 0;
2252         struct drm_display_mode *newmode;
2253         struct drm_device *dev = connector->dev;
2254         struct cvt_timing *cvt;
2255         const int rates[] = { 60, 85, 75, 60, 50 };
2256         const u8 empty[3] = { 0, 0, 0 };
2257
2258         for (i = 0; i < 4; i++) {
2259                 int uninitialized_var(width), height;
2260                 cvt = &(timing->data.other_data.data.cvt[i]);
2261
2262                 if (!memcmp(cvt->code, empty, 3))
2263                         continue;
2264
2265                 height = (cvt->code[0] + ((cvt->code[1] & 0xf0) << 4) + 1) * 2;
2266                 switch (cvt->code[1] & 0x0c) {
2267                 case 0x00:
2268                         width = height * 4 / 3;
2269                         break;
2270                 case 0x04:
2271                         width = height * 16 / 9;
2272                         break;
2273                 case 0x08:
2274                         width = height * 16 / 10;
2275                         break;
2276                 case 0x0c:
2277                         width = height * 15 / 9;
2278                         break;
2279                 }
2280
2281                 for (j = 1; j < 5; j++) {
2282                         if (cvt->code[2] & (1 << j)) {
2283                                 newmode = drm_cvt_mode(dev, width, height,
2284                                                        rates[j], j == 0,
2285                                                        false, false);
2286                                 if (newmode) {
2287                                         drm_mode_probed_add(connector, newmode);
2288                                         modes++;
2289                                 }
2290                         }
2291                 }
2292         }
2293
2294         return modes;
2295 }
2296
2297 static void
2298 do_cvt_mode(struct detailed_timing *timing, void *c)
2299 {
2300         struct detailed_mode_closure *closure = c;
2301         struct detailed_non_pixel *data = &timing->data.other_data;
2302
2303         if (data->type == EDID_DETAIL_CVT_3BYTE)
2304                 closure->modes += drm_cvt_modes(closure->connector, timing);
2305 }
2306
2307 static int
2308 add_cvt_modes(struct drm_connector *connector, struct edid *edid)
2309 {       
2310         struct detailed_mode_closure closure = {
2311                 connector, edid, 0, 0, 0
2312         };
2313
2314         if (version_greater(edid, 1, 2))
2315                 drm_for_each_detailed_block((u8 *)edid, do_cvt_mode, &closure);
2316
2317         /* XXX should also look for CVT codes in VTB blocks */
2318
2319         return closure.modes;
2320 }
2321
2322 static void
2323 do_detailed_mode(struct detailed_timing *timing, void *c)
2324 {
2325         struct detailed_mode_closure *closure = c;
2326         struct drm_display_mode *newmode;
2327
2328         if (timing->pixel_clock) {
2329                 newmode = drm_mode_detailed(closure->connector->dev,
2330                                             closure->edid, timing,
2331                                             closure->quirks);
2332                 if (!newmode)
2333                         return;
2334
2335                 if (closure->preferred)
2336                         newmode->type |= DRM_MODE_TYPE_PREFERRED;
2337
2338                 drm_mode_probed_add(closure->connector, newmode);
2339                 closure->modes++;
2340                 closure->preferred = 0;
2341         }
2342 }
2343
2344 /*
2345  * add_detailed_modes - Add modes from detailed timings
2346  * @connector: attached connector
2347  * @edid: EDID block to scan
2348  * @quirks: quirks to apply
2349  */
2350 static int
2351 add_detailed_modes(struct drm_connector *connector, struct edid *edid,
2352                    u32 quirks)
2353 {
2354         struct detailed_mode_closure closure = {
2355                 connector,
2356                 edid,
2357                 1,
2358                 quirks,
2359                 0
2360         };
2361
2362         if (closure.preferred && !version_greater(edid, 1, 3))
2363                 closure.preferred =
2364                     (edid->features & DRM_EDID_FEATURE_PREFERRED_TIMING);
2365
2366         drm_for_each_detailed_block((u8 *)edid, do_detailed_mode, &closure);
2367
2368         return closure.modes;
2369 }
2370
2371 #define AUDIO_BLOCK     0x01
2372 #define VIDEO_BLOCK     0x02
2373 #define VENDOR_BLOCK    0x03
2374 #define SPEAKER_BLOCK   0x04
2375 #define VIDEO_CAPABILITY_BLOCK  0x07
2376 #define EDID_BASIC_AUDIO        (1 << 6)
2377 #define EDID_CEA_YCRCB444       (1 << 5)
2378 #define EDID_CEA_YCRCB422       (1 << 4)
2379 #define EDID_CEA_VCDB_QS        (1 << 6)
2380
2381 /*
2382  * Search EDID for CEA extension block.
2383  */
2384 static u8 *drm_find_cea_extension(struct edid *edid)
2385 {
2386         u8 *edid_ext = NULL;
2387         int i;
2388
2389         /* No EDID or EDID extensions */
2390         if (edid == NULL || edid->extensions == 0)
2391                 return NULL;
2392
2393         /* Find CEA extension */
2394         for (i = 0; i < edid->extensions; i++) {
2395                 edid_ext = (u8 *)edid + EDID_LENGTH * (i + 1);
2396                 if (edid_ext[0] == CEA_EXT)
2397                         break;
2398         }
2399
2400         if (i == edid->extensions)
2401                 return NULL;
2402
2403         return edid_ext;
2404 }
2405
2406 /*
2407  * Calculate the alternate clock for the CEA mode
2408  * (60Hz vs. 59.94Hz etc.)
2409  */
2410 static unsigned int
2411 cea_mode_alternate_clock(const struct drm_display_mode *cea_mode)
2412 {
2413         unsigned int clock = cea_mode->clock;
2414
2415         if (cea_mode->vrefresh % 6 != 0)
2416                 return clock;
2417
2418         /*
2419          * edid_cea_modes contains the 59.94Hz
2420          * variant for 240 and 480 line modes,
2421          * and the 60Hz variant otherwise.
2422          */
2423         if (cea_mode->vdisplay == 240 || cea_mode->vdisplay == 480)
2424                 clock = clock * 1001 / 1000;
2425         else
2426                 clock = DIV_ROUND_UP(clock * 1000, 1001);
2427
2428         return clock;
2429 }
2430
2431 /**
2432  * drm_match_cea_mode - look for a CEA mode matching given mode
2433  * @to_match: display mode
2434  *
2435  * Returns the CEA Video ID (VIC) of the mode or 0 if it isn't a CEA-861
2436  * mode.
2437  */
2438 u8 drm_match_cea_mode(const struct drm_display_mode *to_match)
2439 {
2440         u8 mode;
2441
2442         if (!to_match->clock)
2443                 return 0;
2444
2445         for (mode = 0; mode < ARRAY_SIZE(edid_cea_modes); mode++) {
2446                 const struct drm_display_mode *cea_mode = &edid_cea_modes[mode];
2447                 unsigned int clock1, clock2;
2448
2449                 /* Check both 60Hz and 59.94Hz */
2450                 clock1 = cea_mode->clock;
2451                 clock2 = cea_mode_alternate_clock(cea_mode);
2452
2453                 if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
2454                      KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
2455                     drm_mode_equal_no_clocks_no_stereo(to_match, cea_mode))
2456                         return mode + 1;
2457         }
2458         return 0;
2459 }
2460 EXPORT_SYMBOL(drm_match_cea_mode);
2461
2462 /*
2463  * Calculate the alternate clock for HDMI modes (those from the HDMI vendor
2464  * specific block).
2465  *
2466  * It's almost like cea_mode_alternate_clock(), we just need to add an
2467  * exception for the VIC 4 mode (4096x2160@24Hz): no alternate clock for this
2468  * one.
2469  */
2470 static unsigned int
2471 hdmi_mode_alternate_clock(const struct drm_display_mode *hdmi_mode)
2472 {
2473         if (hdmi_mode->vdisplay == 4096 && hdmi_mode->hdisplay == 2160)
2474                 return hdmi_mode->clock;
2475
2476         return cea_mode_alternate_clock(hdmi_mode);
2477 }
2478
2479 /*
2480  * drm_match_hdmi_mode - look for a HDMI mode matching given mode
2481  * @to_match: display mode
2482  *
2483  * An HDMI mode is one defined in the HDMI vendor specific block.
2484  *
2485  * Returns the HDMI Video ID (VIC) of the mode or 0 if it isn't one.
2486  */
2487 static u8 drm_match_hdmi_mode(const struct drm_display_mode *to_match)
2488 {
2489         u8 mode;
2490
2491         if (!to_match->clock)
2492                 return 0;
2493
2494         for (mode = 0; mode < ARRAY_SIZE(edid_4k_modes); mode++) {
2495                 const struct drm_display_mode *hdmi_mode = &edid_4k_modes[mode];
2496                 unsigned int clock1, clock2;
2497
2498                 /* Make sure to also match alternate clocks */
2499                 clock1 = hdmi_mode->clock;
2500                 clock2 = hdmi_mode_alternate_clock(hdmi_mode);
2501
2502                 if ((KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock1) ||
2503                      KHZ2PICOS(to_match->clock) == KHZ2PICOS(clock2)) &&
2504                     drm_mode_equal_no_clocks_no_stereo(to_match, hdmi_mode))
2505                         return mode + 1;
2506         }
2507         return 0;
2508 }
2509
2510 static int
2511 add_alternate_cea_modes(struct drm_connector *connector, struct edid *edid)
2512 {
2513         struct drm_device *dev = connector->dev;
2514         struct drm_display_mode *mode, *tmp;
2515         LIST_HEAD(list);
2516         int modes = 0;
2517
2518         /* Don't add CEA modes if the CEA extension block is missing */
2519         if (!drm_find_cea_extension(edid))
2520                 return 0;
2521
2522         /*
2523          * Go through all probed modes and create a new mode
2524          * with the alternate clock for certain CEA modes.
2525          */
2526         list_for_each_entry(mode, &connector->probed_modes, head) {
2527                 const struct drm_display_mode *cea_mode = NULL;
2528                 struct drm_display_mode *newmode;
2529                 u8 mode_idx = drm_match_cea_mode(mode) - 1;
2530                 unsigned int clock1, clock2;
2531
2532                 if (mode_idx < ARRAY_SIZE(edid_cea_modes)) {
2533                         cea_mode = &edid_cea_modes[mode_idx];
2534                         clock2 = cea_mode_alternate_clock(cea_mode);
2535                 } else {
2536                         mode_idx = drm_match_hdmi_mode(mode) - 1;
2537                         if (mode_idx < ARRAY_SIZE(edid_4k_modes)) {
2538                                 cea_mode = &edid_4k_modes[mode_idx];
2539                                 clock2 = hdmi_mode_alternate_clock(cea_mode);
2540                         }
2541                 }
2542
2543                 if (!cea_mode)
2544                         continue;
2545
2546                 clock1 = cea_mode->clock;
2547
2548                 if (clock1 == clock2)
2549                         continue;
2550
2551                 if (mode->clock != clock1 && mode->clock != clock2)
2552                         continue;
2553
2554                 newmode = drm_mode_duplicate(dev, cea_mode);
2555                 if (!newmode)
2556                         continue;
2557
2558                 /* Carry over the stereo flags */
2559                 newmode->flags |= mode->flags & DRM_MODE_FLAG_3D_MASK;
2560
2561                 /*
2562                  * The current mode could be either variant. Make
2563                  * sure to pick the "other" clock for the new mode.
2564                  */
2565                 if (mode->clock != clock1)
2566                         newmode->clock = clock1;
2567                 else
2568                         newmode->clock = clock2;
2569
2570                 list_add_tail(&newmode->head, &list);
2571         }
2572
2573         list_for_each_entry_safe(mode, tmp, &list, head) {
2574                 list_del(&mode->head);
2575                 drm_mode_probed_add(connector, mode);
2576                 modes++;
2577         }
2578
2579         return modes;
2580 }
2581
2582 static struct drm_display_mode *
2583 drm_display_mode_from_vic_index(struct drm_connector *connector,
2584                                 const u8 *video_db, u8 video_len,
2585                                 u8 video_index)
2586 {
2587         struct drm_device *dev = connector->dev;
2588         struct drm_display_mode *newmode;
2589         u8 cea_mode;
2590
2591         if (video_db == NULL || video_index >= video_len)
2592                 return NULL;
2593
2594         /* CEA modes are numbered 1..127 */
2595         cea_mode = (video_db[video_index] & 127) - 1;
2596         if (cea_mode >= ARRAY_SIZE(edid_cea_modes))
2597                 return NULL;
2598
2599         newmode = drm_mode_duplicate(dev, &edid_cea_modes[cea_mode]);
2600         newmode->vrefresh = 0;
2601
2602         return newmode;
2603 }
2604
2605 static int
2606 do_cea_modes(struct drm_connector *connector, const u8 *db, u8 len)
2607 {
2608         int i, modes = 0;
2609
2610         for (i = 0; i < len; i++) {
2611                 struct drm_display_mode *mode;
2612                 mode = drm_display_mode_from_vic_index(connector, db, len, i);
2613                 if (mode) {
2614                         drm_mode_probed_add(connector, mode);
2615                         modes++;
2616                 }
2617         }
2618
2619         return modes;
2620 }
2621
2622 struct stereo_mandatory_mode {
2623         int width, height, vrefresh;
2624         unsigned int flags;
2625 };
2626
2627 static const struct stereo_mandatory_mode stereo_mandatory_modes[] = {
2628         { 1920, 1080, 24, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
2629         { 1920, 1080, 24, DRM_MODE_FLAG_3D_FRAME_PACKING },
2630         { 1920, 1080, 50,
2631           DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF },
2632         { 1920, 1080, 60,
2633           DRM_MODE_FLAG_INTERLACE | DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF },
2634         { 1280, 720,  50, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
2635         { 1280, 720,  50, DRM_MODE_FLAG_3D_FRAME_PACKING },
2636         { 1280, 720,  60, DRM_MODE_FLAG_3D_TOP_AND_BOTTOM },
2637         { 1280, 720,  60, DRM_MODE_FLAG_3D_FRAME_PACKING }
2638 };
2639
2640 static bool
2641 stereo_match_mandatory(const struct drm_display_mode *mode,
2642                        const struct stereo_mandatory_mode *stereo_mode)
2643 {
2644         unsigned int interlaced = mode->flags & DRM_MODE_FLAG_INTERLACE;
2645
2646         return mode->hdisplay == stereo_mode->width &&
2647                mode->vdisplay == stereo_mode->height &&
2648                interlaced == (stereo_mode->flags & DRM_MODE_FLAG_INTERLACE) &&
2649                drm_mode_vrefresh(mode) == stereo_mode->vrefresh;
2650 }
2651
2652 static int add_hdmi_mandatory_stereo_modes(struct drm_connector *connector)
2653 {
2654         struct drm_device *dev = connector->dev;
2655         const struct drm_display_mode *mode;
2656         struct list_head stereo_modes;
2657         int modes = 0, i;
2658
2659         INIT_LIST_HEAD(&stereo_modes);
2660
2661         list_for_each_entry(mode, &connector->probed_modes, head) {
2662                 for (i = 0; i < ARRAY_SIZE(stereo_mandatory_modes); i++) {
2663                         const struct stereo_mandatory_mode *mandatory;
2664                         struct drm_display_mode *new_mode;
2665
2666                         if (!stereo_match_mandatory(mode,
2667                                                     &stereo_mandatory_modes[i]))
2668                                 continue;
2669
2670                         mandatory = &stereo_mandatory_modes[i];
2671                         new_mode = drm_mode_duplicate(dev, mode);
2672                         if (!new_mode)
2673                                 continue;
2674
2675                         new_mode->flags |= mandatory->flags;
2676                         list_add_tail(&new_mode->head, &stereo_modes);
2677                         modes++;
2678                 }
2679         }
2680
2681         list_splice_tail(&stereo_modes, &connector->probed_modes);
2682
2683         return modes;
2684 }
2685
2686 static int add_hdmi_mode(struct drm_connector *connector, u8 vic)
2687 {
2688         struct drm_device *dev = connector->dev;
2689         struct drm_display_mode *newmode;
2690
2691         vic--; /* VICs start at 1 */
2692         if (vic >= ARRAY_SIZE(edid_4k_modes)) {
2693                 DRM_ERROR("Unknown HDMI VIC: %d\n", vic);
2694                 return 0;
2695         }
2696
2697         newmode = drm_mode_duplicate(dev, &edid_4k_modes[vic]);
2698         if (!newmode)
2699                 return 0;
2700
2701         drm_mode_probed_add(connector, newmode);
2702
2703         return 1;
2704 }
2705
2706 static int add_3d_struct_modes(struct drm_connector *connector, u16 structure,
2707                                const u8 *video_db, u8 video_len, u8 video_index)
2708 {
2709         struct drm_display_mode *newmode;
2710         int modes = 0;
2711
2712         if (structure & (1 << 0)) {
2713                 newmode = drm_display_mode_from_vic_index(connector, video_db,
2714                                                           video_len,
2715                                                           video_index);
2716                 if (newmode) {
2717                         newmode->flags |= DRM_MODE_FLAG_3D_FRAME_PACKING;
2718                         drm_mode_probed_add(connector, newmode);
2719                         modes++;
2720                 }
2721         }
2722         if (structure & (1 << 6)) {
2723                 newmode = drm_display_mode_from_vic_index(connector, video_db,
2724                                                           video_len,
2725                                                           video_index);
2726                 if (newmode) {
2727                         newmode->flags |= DRM_MODE_FLAG_3D_TOP_AND_BOTTOM;
2728                         drm_mode_probed_add(connector, newmode);
2729                         modes++;
2730                 }
2731         }
2732         if (structure & (1 << 8)) {
2733                 newmode = drm_display_mode_from_vic_index(connector, video_db,
2734                                                           video_len,
2735                                                           video_index);
2736                 if (newmode) {
2737                         newmode->flags |= DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF;
2738                         drm_mode_probed_add(connector, newmode);
2739                         modes++;
2740                 }
2741         }
2742
2743         return modes;
2744 }
2745
2746 /*
2747  * do_hdmi_vsdb_modes - Parse the HDMI Vendor Specific data block
2748  * @connector: connector corresponding to the HDMI sink
2749  * @db: start of the CEA vendor specific block
2750  * @len: length of the CEA block payload, ie. one can access up to db[len]
2751  *
2752  * Parses the HDMI VSDB looking for modes to add to @connector. This function
2753  * also adds the stereo 3d modes when applicable.
2754  */
2755 static int
2756 do_hdmi_vsdb_modes(struct drm_connector *connector, const u8 *db, u8 len,
2757                    const u8 *video_db, u8 video_len)
2758 {
2759         int modes = 0, offset = 0, i, multi_present = 0, multi_len;
2760         u8 vic_len, hdmi_3d_len = 0;
2761         u16 mask;
2762         u16 structure_all;
2763
2764         if (len < 8)
2765                 goto out;
2766
2767         /* no HDMI_Video_Present */
2768         if (!(db[8] & (1 << 5)))
2769                 goto out;
2770
2771         /* Latency_Fields_Present */
2772         if (db[8] & (1 << 7))
2773                 offset += 2;
2774
2775         /* I_Latency_Fields_Present */
2776         if (db[8] & (1 << 6))
2777                 offset += 2;
2778
2779         /* the declared length is not long enough for the 2 first bytes
2780          * of additional video format capabilities */
2781         if (len < (8 + offset + 2))
2782                 goto out;
2783
2784         /* 3D_Present */
2785         offset++;
2786         if (db[8 + offset] & (1 << 7)) {
2787                 modes += add_hdmi_mandatory_stereo_modes(connector);
2788
2789                 /* 3D_Multi_present */
2790                 multi_present = (db[8 + offset] & 0x60) >> 5;
2791         }
2792
2793         offset++;
2794         vic_len = db[8 + offset] >> 5;
2795         hdmi_3d_len = db[8 + offset] & 0x1f;
2796
2797         for (i = 0; i < vic_len && len >= (9 + offset + i); i++) {
2798                 u8 vic;
2799
2800                 vic = db[9 + offset + i];
2801                 modes += add_hdmi_mode(connector, vic);
2802         }
2803         offset += 1 + vic_len;
2804
2805         if (multi_present == 1)
2806                 multi_len = 2;
2807         else if (multi_present == 2)
2808                 multi_len = 4;
2809         else
2810                 multi_len = 0;
2811
2812         if (len < (8 + offset + hdmi_3d_len - 1))
2813                 goto out;
2814
2815         if (hdmi_3d_len < multi_len)
2816                 goto out;
2817
2818         if (multi_present == 1 || multi_present == 2) {
2819                 /* 3D_Structure_ALL */
2820                 structure_all = (db[8 + offset] << 8) | db[9 + offset];
2821
2822                 /* check if 3D_MASK is present */
2823                 if (multi_present == 2)
2824                         mask = (db[10 + offset] << 8) | db[11 + offset];
2825                 else
2826                         mask = 0xffff;
2827
2828                 for (i = 0; i < 16; i++) {
2829                         if (mask & (1 << i))
2830                                 modes += add_3d_struct_modes(connector,
2831                                                 structure_all,
2832                                                 video_db,
2833                                                 video_len, i);
2834                 }
2835         }
2836
2837         offset += multi_len;
2838
2839         for (i = 0; i < (hdmi_3d_len - multi_len); i++) {
2840                 int vic_index;
2841                 struct drm_display_mode *newmode = NULL;
2842                 unsigned int newflag = 0;
2843                 bool detail_present;
2844
2845                 detail_present = ((db[8 + offset + i] & 0x0f) > 7);
2846
2847                 if (detail_present && (i + 1 == hdmi_3d_len - multi_len))
2848                         break;
2849
2850                 /* 2D_VIC_order_X */
2851                 vic_index = db[8 + offset + i] >> 4;
2852
2853                 /* 3D_Structure_X */
2854                 switch (db[8 + offset + i] & 0x0f) {
2855                 case 0:
2856                         newflag = DRM_MODE_FLAG_3D_FRAME_PACKING;
2857                         break;
2858                 case 6:
2859                         newflag = DRM_MODE_FLAG_3D_TOP_AND_BOTTOM;
2860                         break;
2861                 case 8:
2862                         /* 3D_Detail_X */
2863                         if ((db[9 + offset + i] >> 4) == 1)
2864                                 newflag = DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF;
2865                         break;
2866                 }
2867
2868                 if (newflag != 0) {
2869                         newmode = drm_display_mode_from_vic_index(connector,
2870                                                                   video_db,
2871                                                                   video_len,
2872                                                                   vic_index);
2873
2874                         if (newmode) {
2875                                 newmode->flags |= newflag;
2876                                 drm_mode_probed_add(connector, newmode);
2877                                 modes++;
2878                         }
2879                 }
2880
2881                 if (detail_present)
2882                         i++;
2883         }
2884
2885 out:
2886         return modes;
2887 }
2888
2889 static int
2890 cea_db_payload_len(const u8 *db)
2891 {
2892         return db[0] & 0x1f;
2893 }
2894
2895 static int
2896 cea_db_tag(const u8 *db)
2897 {
2898         return db[0] >> 5;
2899 }
2900
2901 static int
2902 cea_revision(const u8 *cea)
2903 {
2904         return cea[1];
2905 }
2906
2907 static int
2908 cea_db_offsets(const u8 *cea, int *start, int *end)
2909 {
2910         /* Data block offset in CEA extension block */
2911         *start = 4;
2912         *end = cea[2];
2913         if (*end == 0)
2914                 *end = 127;
2915         if (*end < 4 || *end > 127)
2916                 return -ERANGE;
2917         return 0;
2918 }
2919
2920 static bool cea_db_is_hdmi_vsdb(const u8 *db)
2921 {
2922         int hdmi_id;
2923
2924         if (cea_db_tag(db) != VENDOR_BLOCK)
2925                 return false;
2926
2927         if (cea_db_payload_len(db) < 5)
2928                 return false;
2929
2930         hdmi_id = db[1] | (db[2] << 8) | (db[3] << 16);
2931
2932         return hdmi_id == HDMI_IEEE_OUI;
2933 }
2934
2935 #define for_each_cea_db(cea, i, start, end) \
2936         for ((i) = (start); (i) < (end) && (i) + cea_db_payload_len(&(cea)[(i)]) < (end); (i) += cea_db_payload_len(&(cea)[(i)]) + 1)
2937
2938 static int
2939 add_cea_modes(struct drm_connector *connector, struct edid *edid)
2940 {
2941         const u8 *cea = drm_find_cea_extension(edid);
2942         const u8 *db, *hdmi = NULL, *video = NULL;
2943         u8 dbl, hdmi_len, video_len = 0;
2944         int modes = 0;
2945
2946         if (cea && cea_revision(cea) >= 3) {
2947                 int i, start, end;
2948
2949                 if (cea_db_offsets(cea, &start, &end))
2950                         return 0;
2951
2952                 for_each_cea_db(cea, i, start, end) {
2953                         db = &cea[i];
2954                         dbl = cea_db_payload_len(db);
2955
2956                         if (cea_db_tag(db) == VIDEO_BLOCK) {
2957                                 video = db + 1;
2958                                 video_len = dbl;
2959                                 modes += do_cea_modes(connector, video, dbl);
2960                         }
2961                         else if (cea_db_is_hdmi_vsdb(db)) {
2962                                 hdmi = db;
2963                                 hdmi_len = dbl;
2964                         }
2965                 }
2966         }
2967
2968         /*
2969          * We parse the HDMI VSDB after having added the cea modes as we will
2970          * be patching their flags when the sink supports stereo 3D.
2971          */
2972         if (hdmi)
2973                 modes += do_hdmi_vsdb_modes(connector, hdmi, hdmi_len, video,
2974                                             video_len);
2975
2976         return modes;
2977 }
2978
2979 static void
2980 parse_hdmi_vsdb(struct drm_connector *connector, const u8 *db)
2981 {
2982         u8 len = cea_db_payload_len(db);
2983
2984         if (len >= 6) {
2985                 connector->eld[5] |= (db[6] >> 7) << 1;  /* Supports_AI */
2986                 connector->dvi_dual = db[6] & 1;
2987         }
2988         if (len >= 7)
2989                 connector->max_tmds_clock = db[7] * 5;
2990         if (len >= 8) {
2991                 connector->latency_present[0] = db[8] >> 7;
2992                 connector->latency_present[1] = (db[8] >> 6) & 1;
2993         }
2994         if (len >= 9)
2995                 connector->video_latency[0] = db[9];
2996         if (len >= 10)
2997                 connector->audio_latency[0] = db[10];
2998         if (len >= 11)
2999                 connector->video_latency[1] = db[11];
3000         if (len >= 12)
3001                 connector->audio_latency[1] = db[12];
3002
3003         DRM_DEBUG_KMS("HDMI: DVI dual %d, "
3004                     "max TMDS clock %d, "
3005                     "latency present %d %d, "
3006                     "video latency %d %d, "
3007                     "audio latency %d %d\n",
3008                     connector->dvi_dual,
3009                     connector->max_tmds_clock,
3010               (int) connector->latency_present[0],
3011               (int) connector->latency_present[1],
3012                     connector->video_latency[0],
3013                     connector->video_latency[1],
3014                     connector->audio_latency[0],
3015                     connector->audio_latency[1]);
3016 }
3017
3018 static void
3019 monitor_name(struct detailed_timing *t, void *data)
3020 {
3021         if (t->data.other_data.type == EDID_DETAIL_MONITOR_NAME)
3022                 *(u8 **)data = t->data.other_data.data.str.str;
3023 }
3024
3025 /**
3026  * drm_edid_to_eld - build ELD from EDID
3027  * @connector: connector corresponding to the HDMI/DP sink
3028  * @edid: EDID to parse
3029  *
3030  * Fill the ELD (EDID-Like Data) buffer for passing to the audio driver.
3031  * Some ELD fields are left to the graphics driver caller:
3032  * - Conn_Type
3033  * - HDCP
3034  * - Port_ID
3035  */
3036 void drm_edid_to_eld(struct drm_connector *connector, struct edid *edid)
3037 {
3038         uint8_t *eld = connector->eld;
3039         u8 *cea;
3040         u8 *name;
3041         u8 *db;
3042         int sad_count = 0;
3043         int mnl;
3044         int dbl;
3045
3046         memset(eld, 0, sizeof(connector->eld));
3047
3048         cea = drm_find_cea_extension(edid);
3049         if (!cea) {
3050                 DRM_DEBUG_KMS("ELD: no CEA Extension found\n");
3051                 return;
3052         }
3053
3054         name = NULL;
3055         drm_for_each_detailed_block((u8 *)edid, monitor_name, &name);
3056         for (mnl = 0; name && mnl < 13; mnl++) {
3057                 if (name[mnl] == 0x0a)
3058                         break;
3059                 eld[20 + mnl] = name[mnl];
3060         }
3061         eld[4] = (cea[1] << 5) | mnl;
3062         DRM_DEBUG_KMS("ELD monitor %s\n", eld + 20);
3063
3064         eld[0] = 2 << 3;                /* ELD version: 2 */
3065
3066         eld[16] = edid->mfg_id[0];
3067         eld[17] = edid->mfg_id[1];
3068         eld[18] = edid->prod_code[0];
3069         eld[19] = edid->prod_code[1];
3070
3071         if (cea_revision(cea) >= 3) {
3072                 int i, start, end;
3073
3074                 if (cea_db_offsets(cea, &start, &end)) {
3075                         start = 0;
3076                         end = 0;
3077                 }
3078
3079                 for_each_cea_db(cea, i, start, end) {
3080                         db = &cea[i];
3081                         dbl = cea_db_payload_len(db);
3082
3083                         switch (cea_db_tag(db)) {
3084                         case AUDIO_BLOCK:
3085                                 /* Audio Data Block, contains SADs */
3086                                 sad_count = dbl / 3;
3087                                 if (dbl >= 1)
3088                                         memcpy(eld + 20 + mnl, &db[1], dbl);
3089                                 break;
3090                         case SPEAKER_BLOCK:
3091                                 /* Speaker Allocation Data Block */
3092                                 if (dbl >= 1)
3093                                         eld[7] = db[1];
3094                                 break;
3095                         case VENDOR_BLOCK:
3096                                 /* HDMI Vendor-Specific Data Block */
3097                                 if (cea_db_is_hdmi_vsdb(db))
3098                                         parse_hdmi_vsdb(connector, db);
3099                                 break;
3100                         default:
3101                                 break;
3102                         }
3103                 }
3104         }
3105         eld[5] |= sad_count << 4;
3106         eld[2] = (20 + mnl + sad_count * 3 + 3) / 4;
3107
3108         DRM_DEBUG_KMS("ELD size %d, SAD count %d\n", (int)eld[2], sad_count);
3109 }
3110 EXPORT_SYMBOL(drm_edid_to_eld);
3111
3112 /**
3113  * drm_edid_to_sad - extracts SADs from EDID
3114  * @edid: EDID to parse
3115  * @sads: pointer that will be set to the extracted SADs
3116  *
3117  * Looks for CEA EDID block and extracts SADs (Short Audio Descriptors) from it.
3118  * Note: returned pointer needs to be kfreed
3119  *
3120  * Return number of found SADs or negative number on error.
3121  */
3122 int drm_edid_to_sad(struct edid *edid, struct cea_sad **sads)
3123 {
3124         int count = 0;
3125         int i, start, end, dbl;
3126         u8 *cea;
3127
3128         cea = drm_find_cea_extension(edid);
3129         if (!cea) {
3130                 DRM_DEBUG_KMS("SAD: no CEA Extension found\n");
3131                 return -ENOENT;
3132         }
3133
3134         if (cea_revision(cea) < 3) {
3135                 DRM_DEBUG_KMS("SAD: wrong CEA revision\n");
3136                 return -ENOTSUPP;
3137         }
3138
3139         if (cea_db_offsets(cea, &start, &end)) {
3140                 DRM_DEBUG_KMS("SAD: invalid data block offsets\n");
3141                 return -EPROTO;
3142         }
3143
3144         for_each_cea_db(cea, i, start, end) {
3145                 u8 *db = &cea[i];
3146
3147                 if (cea_db_tag(db) == AUDIO_BLOCK) {
3148                         int j;
3149                         dbl = cea_db_payload_len(db);
3150
3151                         count = dbl / 3; /* SAD is 3B */
3152                         *sads = kcalloc(count, sizeof(**sads), GFP_KERNEL);
3153                         if (!*sads)
3154                                 return -ENOMEM;
3155                         for (j = 0; j < count; j++) {
3156                                 u8 *sad = &db[1 + j * 3];
3157
3158                                 (*sads)[j].format = (sad[0] & 0x78) >> 3;
3159                                 (*sads)[j].channels = sad[0] & 0x7;
3160                                 (*sads)[j].freq = sad[1] & 0x7F;
3161                                 (*sads)[j].byte2 = sad[2];
3162                         }
3163                         break;
3164                 }
3165         }
3166
3167         return count;
3168 }
3169 EXPORT_SYMBOL(drm_edid_to_sad);
3170
3171 /**
3172  * drm_edid_to_speaker_allocation - extracts Speaker Allocation Data Blocks from EDID
3173  * @edid: EDID to parse
3174  * @sadb: pointer to the speaker block
3175  *
3176  * Looks for CEA EDID block and extracts the Speaker Allocation Data Block from it.
3177  * Note: returned pointer needs to be kfreed
3178  *
3179  * Return number of found Speaker Allocation Blocks or negative number on error.
3180  */
3181 int drm_edid_to_speaker_allocation(struct edid *edid, u8 **sadb)
3182 {
3183         int count = 0;
3184         int i, start, end, dbl;
3185         const u8 *cea;
3186
3187         cea = drm_find_cea_extension(edid);
3188         if (!cea) {
3189                 DRM_DEBUG_KMS("SAD: no CEA Extension found\n");
3190                 return -ENOENT;
3191         }
3192
3193         if (cea_revision(cea) < 3) {
3194                 DRM_DEBUG_KMS("SAD: wrong CEA revision\n");
3195                 return -ENOTSUPP;
3196         }
3197
3198         if (cea_db_offsets(cea, &start, &end)) {
3199                 DRM_DEBUG_KMS("SAD: invalid data block offsets\n");
3200                 return -EPROTO;
3201         }
3202
3203         for_each_cea_db(cea, i, start, end) {
3204                 const u8 *db = &cea[i];
3205
3206                 if (cea_db_tag(db) == SPEAKER_BLOCK) {
3207                         dbl = cea_db_payload_len(db);
3208
3209                         /* Speaker Allocation Data Block */
3210                         if (dbl == 3) {
3211                                 *sadb = kmalloc(dbl, GFP_KERNEL);
3212                                 if (!*sadb)
3213                                         return -ENOMEM;
3214                                 memcpy(*sadb, &db[1], dbl);
3215                                 count = dbl;
3216                                 break;
3217                         }
3218                 }
3219         }
3220
3221         return count;
3222 }
3223 EXPORT_SYMBOL(drm_edid_to_speaker_allocation);
3224
3225 /**
3226  * drm_av_sync_delay - HDMI/DP sink audio-video sync delay in millisecond
3227  * @connector: connector associated with the HDMI/DP sink
3228  * @mode: the display mode
3229  */
3230 int drm_av_sync_delay(struct drm_connector *connector,
3231                       struct drm_display_mode *mode)
3232 {
3233         int i = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
3234         int a, v;
3235
3236         if (!connector->latency_present[0])
3237                 return 0;
3238         if (!connector->latency_present[1])
3239                 i = 0;
3240
3241         a = connector->audio_latency[i];
3242         v = connector->video_latency[i];
3243
3244         /*
3245          * HDMI/DP sink doesn't support audio or video?
3246          */
3247         if (a == 255 || v == 255)
3248                 return 0;
3249
3250         /*
3251          * Convert raw EDID values to millisecond.
3252          * Treat unknown latency as 0ms.
3253          */
3254         if (a)
3255                 a = min(2 * (a - 1), 500);
3256         if (v)
3257                 v = min(2 * (v - 1), 500);
3258
3259         return max(v - a, 0);
3260 }
3261 EXPORT_SYMBOL(drm_av_sync_delay);
3262
3263 /**
3264  * drm_select_eld - select one ELD from multiple HDMI/DP sinks
3265  * @encoder: the encoder just changed display mode
3266  * @mode: the adjusted display mode
3267  *
3268  * It's possible for one encoder to be associated with multiple HDMI/DP sinks.
3269  * The policy is now hard coded to simply use the first HDMI/DP sink's ELD.
3270  */
3271 struct drm_connector *drm_select_eld(struct drm_encoder *encoder,
3272                                      struct drm_display_mode *mode)
3273 {
3274         struct drm_connector *connector;
3275         struct drm_device *dev = encoder->dev;
3276
3277         list_for_each_entry(connector, &dev->mode_config.connector_list, head)
3278                 if (connector->encoder == encoder && connector->eld[0])
3279                         return connector;
3280
3281         return NULL;
3282 }
3283 EXPORT_SYMBOL(drm_select_eld);
3284
3285 /**
3286  * drm_detect_hdmi_monitor - detect whether monitor is hdmi.
3287  * @edid: monitor EDID information
3288  *
3289  * Parse the CEA extension according to CEA-861-B.
3290  * Return true if HDMI, false if not or unknown.
3291  */
3292 bool drm_detect_hdmi_monitor(struct edid *edid)
3293 {
3294         u8 *edid_ext;
3295         int i;
3296         int start_offset, end_offset;
3297
3298         edid_ext = drm_find_cea_extension(edid);
3299         if (!edid_ext)
3300                 return false;
3301
3302         if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
3303                 return false;
3304
3305         /*
3306          * Because HDMI identifier is in Vendor Specific Block,
3307          * search it from all data blocks of CEA extension.
3308          */
3309         for_each_cea_db(edid_ext, i, start_offset, end_offset) {
3310                 if (cea_db_is_hdmi_vsdb(&edid_ext[i]))
3311                         return true;
3312         }
3313
3314         return false;
3315 }
3316 EXPORT_SYMBOL(drm_detect_hdmi_monitor);
3317
3318 /**
3319  * drm_detect_monitor_audio - check monitor audio capability
3320  *
3321  * Monitor should have CEA extension block.
3322  * If monitor has 'basic audio', but no CEA audio blocks, it's 'basic
3323  * audio' only. If there is any audio extension block and supported
3324  * audio format, assume at least 'basic audio' support, even if 'basic
3325  * audio' is not defined in EDID.
3326  *
3327  */
3328 bool drm_detect_monitor_audio(struct edid *edid)
3329 {
3330         u8 *edid_ext;
3331         int i, j;
3332         bool has_audio = false;
3333         int start_offset, end_offset;
3334
3335         edid_ext = drm_find_cea_extension(edid);
3336         if (!edid_ext)
3337                 goto end;
3338
3339         has_audio = ((edid_ext[3] & EDID_BASIC_AUDIO) != 0);
3340
3341         if (has_audio) {
3342                 DRM_DEBUG_KMS("Monitor has basic audio support\n");
3343                 goto end;
3344         }
3345
3346         if (cea_db_offsets(edid_ext, &start_offset, &end_offset))
3347                 goto end;
3348
3349         for_each_cea_db(edid_ext, i, start_offset, end_offset) {
3350                 if (cea_db_tag(&edid_ext[i]) == AUDIO_BLOCK) {
3351                         has_audio = true;
3352                         for (j = 1; j < cea_db_payload_len(&edid_ext[i]) + 1; j += 3)
3353                                 DRM_DEBUG_KMS("CEA audio format %d\n",
3354                                               (edid_ext[i + j] >> 3) & 0xf);
3355                         goto end;
3356                 }
3357         }
3358 end:
3359         return has_audio;
3360 }
3361 EXPORT_SYMBOL(drm_detect_monitor_audio);
3362
3363 /**
3364  * drm_rgb_quant_range_selectable - is RGB quantization range selectable?
3365  *
3366  * Check whether the monitor reports the RGB quantization range selection
3367  * as supported. The AVI infoframe can then be used to inform the monitor
3368  * which quantization range (full or limited) is used.
3369  */
3370 bool drm_rgb_quant_range_selectable(struct edid *edid)
3371 {
3372         u8 *edid_ext;
3373         int i, start, end;
3374
3375         edid_ext = drm_find_cea_extension(edid);
3376         if (!edid_ext)
3377                 return false;
3378
3379         if (cea_db_offsets(edid_ext, &start, &end))
3380                 return false;
3381
3382         for_each_cea_db(edid_ext, i, start, end) {
3383                 if (cea_db_tag(&edid_ext[i]) == VIDEO_CAPABILITY_BLOCK &&
3384                     cea_db_payload_len(&edid_ext[i]) == 2) {
3385                         DRM_DEBUG_KMS("CEA VCDB 0x%02x\n", edid_ext[i + 2]);
3386                         return edid_ext[i + 2] & EDID_CEA_VCDB_QS;
3387                 }
3388         }
3389
3390         return false;
3391 }
3392 EXPORT_SYMBOL(drm_rgb_quant_range_selectable);
3393
3394 /**
3395  * drm_add_display_info - pull display info out if present
3396  * @edid: EDID data
3397  * @info: display info (attached to connector)
3398  *
3399  * Grab any available display info and stuff it into the drm_display_info
3400  * structure that's part of the connector.  Useful for tracking bpp and
3401  * color spaces.
3402  */
3403 static void drm_add_display_info(struct edid *edid,
3404                                  struct drm_display_info *info)
3405 {
3406         u8 *edid_ext;
3407
3408         info->width_mm = edid->width_cm * 10;
3409         info->height_mm = edid->height_cm * 10;
3410
3411         /* driver figures it out in this case */
3412         info->bpc = 0;
3413         info->color_formats = 0;
3414
3415         if (edid->revision < 3)
3416                 return;
3417
3418         if (!(edid->input & DRM_EDID_INPUT_DIGITAL))
3419                 return;
3420
3421         /* Get data from CEA blocks if present */
3422         edid_ext = drm_find_cea_extension(edid);
3423         if (edid_ext) {
3424                 info->cea_rev = edid_ext[1];
3425
3426                 /* The existence of a CEA block should imply RGB support */
3427                 info->color_formats = DRM_COLOR_FORMAT_RGB444;
3428                 if (edid_ext[3] & EDID_CEA_YCRCB444)
3429                         info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
3430                 if (edid_ext[3] & EDID_CEA_YCRCB422)
3431                         info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
3432         }
3433
3434         /* Only defined for 1.4 with digital displays */
3435         if (edid->revision < 4)
3436                 return;
3437
3438         switch (edid->input & DRM_EDID_DIGITAL_DEPTH_MASK) {
3439         case DRM_EDID_DIGITAL_DEPTH_6:
3440                 info->bpc = 6;
3441                 break;
3442         case DRM_EDID_DIGITAL_DEPTH_8:
3443                 info->bpc = 8;
3444                 break;
3445         case DRM_EDID_DIGITAL_DEPTH_10:
3446                 info->bpc = 10;
3447                 break;
3448         case DRM_EDID_DIGITAL_DEPTH_12:
3449                 info->bpc = 12;
3450                 break;
3451         case DRM_EDID_DIGITAL_DEPTH_14:
3452                 info->bpc = 14;
3453                 break;
3454         case DRM_EDID_DIGITAL_DEPTH_16:
3455                 info->bpc = 16;
3456                 break;
3457         case DRM_EDID_DIGITAL_DEPTH_UNDEF:
3458         default:
3459                 info->bpc = 0;
3460                 break;
3461         }
3462
3463         info->color_formats |= DRM_COLOR_FORMAT_RGB444;
3464         if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB444)
3465                 info->color_formats |= DRM_COLOR_FORMAT_YCRCB444;
3466         if (edid->features & DRM_EDID_FEATURE_RGB_YCRCB422)
3467                 info->color_formats |= DRM_COLOR_FORMAT_YCRCB422;
3468 }
3469
3470 /**
3471  * drm_add_edid_modes - add modes from EDID data, if available
3472  * @connector: connector we're probing
3473  * @edid: edid data
3474  *
3475  * Add the specified modes to the connector's mode list.
3476  *
3477  * Return number of modes added or 0 if we couldn't find any.
3478  */
3479 int drm_add_edid_modes(struct drm_connector *connector, struct edid *edid)
3480 {
3481         int num_modes = 0;
3482         u32 quirks;
3483
3484         if (edid == NULL) {
3485                 return 0;
3486         }
3487         if (!drm_edid_is_valid(edid)) {
3488                 dev_warn(connector->dev->dev, "%s: EDID invalid.\n",
3489                          drm_get_connector_name(connector));
3490                 return 0;
3491         }
3492
3493         quirks = edid_get_quirks(edid);
3494
3495         /*
3496          * EDID spec says modes should be preferred in this order:
3497          * - preferred detailed mode
3498          * - other detailed modes from base block
3499          * - detailed modes from extension blocks
3500          * - CVT 3-byte code modes
3501          * - standard timing codes
3502          * - established timing codes
3503          * - modes inferred from GTF or CVT range information
3504          *
3505          * We get this pretty much right.
3506          *
3507          * XXX order for additional mode types in extension blocks?
3508          */
3509         num_modes += add_detailed_modes(connector, edid, quirks);
3510         num_modes += add_cvt_modes(connector, edid);
3511         num_modes += add_standard_modes(connector, edid);
3512         num_modes += add_established_modes(connector, edid);
3513         if (edid->features & DRM_EDID_FEATURE_DEFAULT_GTF)
3514                 num_modes += add_inferred_modes(connector, edid);
3515         num_modes += add_cea_modes(connector, edid);
3516         num_modes += add_alternate_cea_modes(connector, edid);
3517
3518         if (quirks & (EDID_QUIRK_PREFER_LARGE_60 | EDID_QUIRK_PREFER_LARGE_75))
3519                 edid_fixup_preferred(connector, quirks);
3520
3521         drm_add_display_info(edid, &connector->display_info);
3522
3523         if (quirks & EDID_QUIRK_FORCE_8BPC)
3524                 connector->display_info.bpc = 8;
3525
3526         return num_modes;
3527 }
3528 EXPORT_SYMBOL(drm_add_edid_modes);
3529
3530 /**
3531  * drm_add_modes_noedid - add modes for the connectors without EDID
3532  * @connector: connector we're probing
3533  * @hdisplay: the horizontal display limit
3534  * @vdisplay: the vertical display limit
3535  *
3536  * Add the specified modes to the connector's mode list. Only when the
3537  * hdisplay/vdisplay is not beyond the given limit, it will be added.
3538  *
3539  * Return number of modes added or 0 if we couldn't find any.
3540  */
3541 int drm_add_modes_noedid(struct drm_connector *connector,
3542                         int hdisplay, int vdisplay)
3543 {
3544         int i, count, num_modes = 0;
3545         struct drm_display_mode *mode;
3546         struct drm_device *dev = connector->dev;
3547
3548         count = sizeof(drm_dmt_modes) / sizeof(struct drm_display_mode);
3549         if (hdisplay < 0)
3550                 hdisplay = 0;
3551         if (vdisplay < 0)
3552                 vdisplay = 0;
3553
3554         for (i = 0; i < count; i++) {
3555                 const struct drm_display_mode *ptr = &drm_dmt_modes[i];
3556                 if (hdisplay && vdisplay) {
3557                         /*
3558                          * Only when two are valid, they will be used to check
3559                          * whether the mode should be added to the mode list of
3560                          * the connector.
3561                          */
3562                         if (ptr->hdisplay > hdisplay ||
3563                                         ptr->vdisplay > vdisplay)
3564                                 continue;
3565                 }
3566                 if (drm_mode_vrefresh(ptr) > 61)
3567                         continue;
3568                 mode = drm_mode_duplicate(dev, ptr);
3569                 if (mode) {
3570                         drm_mode_probed_add(connector, mode);
3571                         num_modes++;
3572                 }
3573         }
3574         return num_modes;
3575 }
3576 EXPORT_SYMBOL(drm_add_modes_noedid);
3577
3578 void drm_set_preferred_mode(struct drm_connector *connector,
3579                            int hpref, int vpref)
3580 {
3581         struct drm_display_mode *mode;
3582
3583         list_for_each_entry(mode, &connector->probed_modes, head) {
3584                 if (drm_mode_width(mode)  == hpref &&
3585                     drm_mode_height(mode) == vpref)
3586                         mode->type |= DRM_MODE_TYPE_PREFERRED;
3587         }
3588 }
3589 EXPORT_SYMBOL(drm_set_preferred_mode);
3590
3591 /**
3592  * drm_hdmi_avi_infoframe_from_display_mode() - fill an HDMI AVI infoframe with
3593  *                                              data from a DRM display mode
3594  * @frame: HDMI AVI infoframe
3595  * @mode: DRM display mode
3596  *
3597  * Returns 0 on success or a negative error code on failure.
3598  */
3599 int
3600 drm_hdmi_avi_infoframe_from_display_mode(struct hdmi_avi_infoframe *frame,
3601                                          const struct drm_display_mode *mode)
3602 {
3603         int err;
3604
3605         if (!frame || !mode)
3606                 return -EINVAL;
3607
3608         err = hdmi_avi_infoframe_init(frame);
3609         if (err < 0)
3610                 return err;
3611
3612         if (mode->flags & DRM_MODE_FLAG_DBLCLK)
3613                 frame->pixel_repeat = 1;
3614
3615         frame->video_code = drm_match_cea_mode(mode);
3616
3617         frame->picture_aspect = HDMI_PICTURE_ASPECT_NONE;
3618         frame->active_aspect = HDMI_ACTIVE_ASPECT_PICTURE;
3619
3620         return 0;
3621 }
3622 EXPORT_SYMBOL(drm_hdmi_avi_infoframe_from_display_mode);
3623
3624 static enum hdmi_3d_structure
3625 s3d_structure_from_display_mode(const struct drm_display_mode *mode)
3626 {
3627         u32 layout = mode->flags & DRM_MODE_FLAG_3D_MASK;
3628
3629         switch (layout) {
3630         case DRM_MODE_FLAG_3D_FRAME_PACKING:
3631                 return HDMI_3D_STRUCTURE_FRAME_PACKING;
3632         case DRM_MODE_FLAG_3D_FIELD_ALTERNATIVE:
3633                 return HDMI_3D_STRUCTURE_FIELD_ALTERNATIVE;
3634         case DRM_MODE_FLAG_3D_LINE_ALTERNATIVE:
3635                 return HDMI_3D_STRUCTURE_LINE_ALTERNATIVE;
3636         case DRM_MODE_FLAG_3D_SIDE_BY_SIDE_FULL:
3637                 return HDMI_3D_STRUCTURE_SIDE_BY_SIDE_FULL;
3638         case DRM_MODE_FLAG_3D_L_DEPTH:
3639                 return HDMI_3D_STRUCTURE_L_DEPTH;
3640         case DRM_MODE_FLAG_3D_L_DEPTH_GFX_GFX_DEPTH:
3641                 return HDMI_3D_STRUCTURE_L_DEPTH_GFX_GFX_DEPTH;
3642         case DRM_MODE_FLAG_3D_TOP_AND_BOTTOM:
3643                 return HDMI_3D_STRUCTURE_TOP_AND_BOTTOM;
3644         case DRM_MODE_FLAG_3D_SIDE_BY_SIDE_HALF:
3645                 return HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF;
3646         default:
3647                 return HDMI_3D_STRUCTURE_INVALID;
3648         }
3649 }
3650
3651 /**
3652  * drm_hdmi_vendor_infoframe_from_display_mode() - fill an HDMI infoframe with
3653  * data from a DRM display mode
3654  * @frame: HDMI vendor infoframe
3655  * @mode: DRM display mode
3656  *
3657  * Note that there's is a need to send HDMI vendor infoframes only when using a
3658  * 4k or stereoscopic 3D mode. So when giving any other mode as input this
3659  * function will return -EINVAL, error that can be safely ignored.
3660  *
3661  * Returns 0 on success or a negative error code on failure.
3662  */
3663 int
3664 drm_hdmi_vendor_infoframe_from_display_mode(struct hdmi_vendor_infoframe *frame,
3665                                             const struct drm_display_mode *mode)
3666 {
3667         int err;
3668         u32 s3d_flags;
3669         u8 vic;
3670
3671         if (!frame || !mode)
3672                 return -EINVAL;
3673
3674         vic = drm_match_hdmi_mode(mode);
3675         s3d_flags = mode->flags & DRM_MODE_FLAG_3D_MASK;
3676
3677         if (!vic && !s3d_flags)
3678                 return -EINVAL;
3679
3680         if (vic && s3d_flags)
3681                 return -EINVAL;
3682
3683         err = hdmi_vendor_infoframe_init(frame);
3684         if (err < 0)
3685                 return err;
3686
3687         if (vic)
3688                 frame->vic = vic;
3689         else
3690                 frame->s3d_struct = s3d_structure_from_display_mode(mode);
3691
3692         return 0;
3693 }
3694 EXPORT_SYMBOL(drm_hdmi_vendor_infoframe_from_display_mode);