1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (c) 2012 The Chromium OS Authors.
4  *
5  * (C) Copyright 2010
6  * Petr Stetiar <ynezz@true.cz>
7  *
8  * Contains stolen code from ddcprobe project which is:
9  * Copyright (C) Nalin Dahyabhai <bigfun@pobox.com>
10  */
11 
12 #include <edid.h>
13 #include <errno.h>
14 #include <fdtdec.h>
15 #include <log.h>
16 #include <linux/ctype.h>
17 #include <linux/string.h>
18 
19 #if CONFIG_IS_ENABLED(I2C_EDID_STANDARD)
20 #define TIMING(c, ha, hfp, hbp, hsl, va, vfp, vbp, vsl, f)	\
21 	.pixelclock = { (c), (c), (c) },			\
22 	.hactive = { (ha), (ha), (ha) },			\
23 	.hfront_porch = { (hfp), (hfp), (hfp) },		\
24 	.hback_porch = { (hbp), (hbp), (hbp) },			\
25 	.hsync_len = { (hsl), (hsl), (hsl) },			\
26 	.vactive = { (va), (va), (va) },			\
27 	.vfront_porch = { (vfp), (vfp), (vfp) },		\
28 	.vback_porch = { (vbp), (vbp), (vbp) },			\
29 	.vsync_len = { (vsl), (vsl), (vsl) },			\
30 	.flags = (f)
31 
32 static const struct display_timing dmt_timings[] = {
33 	{ TIMING(31500000, 640, 32, 64, 96, 350, 32, 3, 60,
34 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
35 	{ TIMING(31500000, 640, 32, 64, 96, 400, 1, 3, 41,
36 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
37 	{ TIMING(35500000, 720, 36, 72, 108, 400, 1, 3, 42,
38 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
39 	{ TIMING(25175000, 640, 16, 96, 48, 480, 10, 2, 33,
40 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_LOW) },
41 	{ TIMING(31500000, 640, 24, 40, 128, 480, 9, 3, 28,
42 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_LOW) },
43 	{ TIMING(31500000, 640, 16, 64, 120, 480, 1, 3, 16,
44 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_LOW) },
45 	{ TIMING(36000000, 640, 56, 56, 80, 480, 1, 3, 25,
46 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_LOW) },
47 	{ TIMING(36000000, 800, 24, 72, 128, 600, 1, 2, 22,
48 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
49 	{ TIMING(40000000, 800, 40, 128, 88, 600, 1, 4, 23,
50 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
51 	{ TIMING(50000000, 800, 56, 120, 64, 600, 37, 6, 23,
52 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
53 	{ TIMING(49500000, 800, 16, 80, 160, 600, 1, 3, 21,
54 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
55 	{ TIMING(56250000, 800, 32, 64, 152, 600, 1, 3, 27,
56 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
57 	{ TIMING(73250000, 800, 48, 32, 80, 600, 3, 4, 29,
58 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
59 	{ TIMING(33750000, 848, 16, 112, 112, 480, 6, 8, 23,
60 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
61 	{ TIMING(44900000, 1024, 8, 176, 56, 768, 0, 8, 41,
62 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
63 	{ TIMING(65000000, 1024, 24, 136, 160, 768, 3, 6, 29,
64 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_LOW) },
65 	{ TIMING(75000000, 1024, 24, 136, 144, 768, 3, 6, 29,
66 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_LOW) },
67 	{ TIMING(78750000, 1024, 16, 96, 176, 768, 1, 3, 28,
68 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
69 	{ TIMING(94500000, 1024, 48, 96, 208, 768, 1, 3, 36,
70 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
71 	{ TIMING(115500000, 1024, 48, 32, 80, 768, 3, 4, 38,
72 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
73 	{ TIMING(108000000, 1152, 64, 128, 256, 864, 1, 3, 32,
74 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
75 	{ TIMING(74250000, 1280, 110, 40, 220, 720, 5, 5, 20,
76 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
77 	{ TIMING(68250000, 1280, 48, 32, 80, 768, 3, 7, 12,
78 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
79 	{ TIMING(79500000, 1280, 64, 128, 192, 768, 3, 7, 20,
80 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
81 	{ TIMING(102250000, 1280, 80, 128, 208, 768, 3, 7, 27,
82 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
83 	{ TIMING(117500000, 1280, 80, 136, 216, 768, 3, 7, 31,
84 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
85 	{ TIMING(140250000, 1280, 48, 32, 80, 768, 3, 7, 35,
86 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
87 	{ TIMING(71000000, 1280, 48, 32, 80, 800, 3, 6, 14,
88 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
89 	{ TIMING(83500000, 1280, 72, 128, 200, 800, 3, 6, 22,
90 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
91 	{ TIMING(106500000, 1280, 80, 128, 208, 800, 3, 6, 29,
92 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
93 	{ TIMING(122500000, 1280, 80, 136, 216, 800, 3, 6, 34,
94 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
95 	{ TIMING(146250000, 1280, 48, 32, 80, 800, 3, 6, 38,
96 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
97 	{ TIMING(108000000, 1280, 96, 112, 312, 960, 1, 3, 36,
98 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
99 	{ TIMING(148500000, 1280, 64, 160, 224, 960, 1, 3, 47,
100 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
101 	{ TIMING(175500000, 1280, 48, 32, 80, 960, 3, 4, 50,
102 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
103 	{ TIMING(108000000, 1280, 48, 112, 248, 1024, 1, 3, 38,
104 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
105 	{ TIMING(135000000, 1280, 16, 144, 248, 1024, 1, 3, 38,
106 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
107 	{ TIMING(157500000, 1280, 64, 160, 224, 1024, 1, 3, 44,
108 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
109 	{ TIMING(187250000, 1280, 48, 32, 80, 1024, 3, 7, 50,
110 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
111 	{ TIMING(85500000, 1360, 64, 112, 256, 768, 3, 6, 18,
112 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
113 	{ TIMING(148250000, 1360, 48, 32, 80, 768, 3, 5, 37,
114 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
115 	{ TIMING(85500000, 1366, 70, 143, 213, 768, 3, 3, 24,
116 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
117 	{ TIMING(72000000, 1366, 14, 56, 64, 768, 1, 3, 28,
118 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
119 	{ TIMING(101000000, 1400, 48, 32, 80, 1050, 3, 4, 23,
120 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
121 	{ TIMING(121750000, 1400, 88, 144, 232, 1050, 3, 4, 32,
122 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
123 	{ TIMING(156000000, 1400, 104, 144, 248, 1050, 3, 4, 42,
124 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
125 	{ TIMING(179500000, 1400, 104, 152, 256, 1050, 3, 4, 48,
126 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
127 	{ TIMING(208000000, 1400, 48, 32, 80, 1050, 3, 4, 55,
128 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
129 	{ TIMING(88750000, 1440, 48, 32, 80, 900, 3, 6, 17,
130 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
131 	{ TIMING(106500000, 1440, 80, 152, 232, 900, 3, 6, 25,
132 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
133 	{ TIMING(136750000, 1440, 96, 152, 248, 900, 3, 6, 33,
134 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
135 	{ TIMING(157000000, 1440, 104, 152, 256, 900, 3, 6, 39,
136 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
137 	{ TIMING(182750000, 1440, 48, 32, 80, 900, 3, 6, 44,
138 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
139 	{ TIMING(108000000, 1600, 24, 80, 96, 900, 1, 3, 96,
140 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
141 	{ TIMING(162000000, 1600, 64, 192, 304, 1200, 1, 3, 46,
142 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
143 	{ TIMING(175500000, 1600, 64, 192, 304, 1200, 1, 3, 46,
144 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
145 	{ TIMING(189000000, 1600, 64, 192, 304, 1200, 1, 3, 46,
146 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
147 	{ TIMING(202500000, 1600, 64, 192, 304, 1200, 1, 3, 46,
148 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
149 	{ TIMING(229500000, 1600, 64, 192, 304, 1200, 1, 3, 46,
150 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
151 	{ TIMING(268250000, 1600, 48, 32, 80, 1200, 3, 4, 64,
152 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
153 	{ TIMING(119000000, 1680, 48, 32, 80, 1050, 3, 6, 21,
154 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
155 	{ TIMING(146250000, 1680, 104, 176, 280, 1050, 3, 6, 30,
156 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
157 	{ TIMING(187000000, 1680, 120, 176, 296, 1050, 3, 6, 40,
158 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
159 	{ TIMING(214750000, 1680, 128, 176, 304, 1050, 3, 6, 46,
160 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
161 	{ TIMING(245500000, 1680, 48, 32, 80, 1050, 3, 6, 53,
162 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
163 	{ TIMING(204750000, 1792, 128, 200, 328, 1344, 1, 3, 46,
164 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
165 	{ TIMING(261000000, 1792, 96, 216, 352, 1344, 1, 3, 69,
166 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
167 	{ TIMING(333250000, 1792, 48, 32, 80, 1344, 3, 4, 72,
168 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
169 	{ TIMING(218250000, 1856, 96, 224, 352, 1392, 1, 3, 43,
170 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
171 	{ TIMING(288000000, 1856, 128, 224, 352, 1392, 1, 3, 104,
172 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
173 	{ TIMING(356500000, 1856, 48, 32, 80, 1392, 3, 4, 75,
174 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
175 	{ TIMING(148500000, 1920, 88, 44, 148, 1080, 4, 5, 36,
176 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_LOW) },
177 	{ TIMING(154000000, 1920, 48, 32, 80, 1200, 3, 6, 26,
178 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
179 	{ TIMING(193250000, 1920, 136, 200, 336, 1200, 3, 6, 36,
180 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
181 	{ TIMING(245250000, 1920, 136, 208, 344, 1200, 3, 6, 46,
182 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
183 	{ TIMING(281250000, 1920, 144, 208, 352, 1200, 3, 6, 53,
184 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
185 	{ TIMING(317000000, 1920, 48, 32, 80, 1200, 3, 6, 62,
186 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
187 	{ TIMING(234000000, 1920, 128, 208, 344, 1440, 1, 3, 56,
188 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
189 	{ TIMING(297000000, 1920, 144, 224, 352, 1440, 1, 3, 56,
190 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
191 	{ TIMING(380500000, 1920, 48, 32, 80, 1440, 3, 4, 78,
192 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
193 	{ TIMING(162000000, 2048, 26, 80, 96, 1152, 1, 3, 44,
194 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_HIGH) },
195 	{ TIMING(268500000, 2560, 48, 32, 80, 1600, 3, 6, 37,
196 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
197 	{ TIMING(348500000, 2560, 192, 280, 472, 1600, 3, 6, 49,
198 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
199 	{ TIMING(443250000, 2560, 208, 280, 488, 1600, 3, 6, 63,
200 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
201 	{ TIMING(505250000, 2560, 208, 280, 488, 1600, 3, 6, 73,
202 		 DISPLAY_FLAGS_HSYNC_LOW | DISPLAY_FLAGS_VSYNC_HIGH) },
203 	{ TIMING(552750000, 2560, 48, 32, 80, 1600, 3, 6, 85,
204 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
205 	{ TIMING(556744000, 4096, 8, 32, 40, 2160, 48, 8, 6,
206 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
207 	{ TIMING(556188000, 4096, 8, 32, 40, 2160, 48, 8, 6,
208 		 DISPLAY_FLAGS_HSYNC_HIGH | DISPLAY_FLAGS_VSYNC_LOW) },
209 };
210 #endif
211 
edid_check_info(struct edid1_info * edid_info)212 int edid_check_info(struct edid1_info *edid_info)
213 {
214 	if ((edid_info == NULL) || (edid_info->version == 0))
215 		return -1;
216 
217 	if (memcmp(edid_info->header, "\x0\xff\xff\xff\xff\xff\xff\x0", 8))
218 		return -1;
219 
220 	if (edid_info->version == 0xff && edid_info->revision == 0xff)
221 		return -1;
222 
223 	return 0;
224 }
225 
edid_check_checksum(u8 * edid_block)226 int edid_check_checksum(u8 *edid_block)
227 {
228 	u8 checksum = 0;
229 	int i;
230 
231 	for (i = 0; i < 128; i++)
232 		checksum += edid_block[i];
233 
234 	return (checksum == 0) ? 0 : -EINVAL;
235 }
236 
edid_get_ranges(struct edid1_info * edid,unsigned int * hmin,unsigned int * hmax,unsigned int * vmin,unsigned int * vmax)237 int edid_get_ranges(struct edid1_info *edid, unsigned int *hmin,
238 		    unsigned int *hmax, unsigned int *vmin,
239 		    unsigned int *vmax)
240 {
241 	int i;
242 	struct edid_monitor_descriptor *monitor;
243 
244 	*hmin = *hmax = *vmin = *vmax = 0;
245 	if (edid_check_info(edid))
246 		return -1;
247 
248 	for (i = 0; i < ARRAY_SIZE(edid->monitor_details.descriptor); i++) {
249 		monitor = &edid->monitor_details.descriptor[i];
250 		if (monitor->type == EDID_MONITOR_DESCRIPTOR_RANGE) {
251 			*hmin = monitor->data.range_data.horizontal_min;
252 			*hmax = monitor->data.range_data.horizontal_max;
253 			*vmin = monitor->data.range_data.vertical_min;
254 			*vmax = monitor->data.range_data.vertical_max;
255 			return 0;
256 		}
257 	}
258 	return -1;
259 }
260 
261 /* Set all parts of a timing entry to the same value */
set_entry(struct timing_entry * entry,u32 value)262 static void set_entry(struct timing_entry *entry, u32 value)
263 {
264 	entry->min = value;
265 	entry->typ = value;
266 	entry->max = value;
267 }
268 
269 /**
270  * decode_timing() - Decoding an 18-byte detailed timing record
271  *
272  * @buf:	Pointer to EDID detailed timing record
273  * @timing:	Place to put timing
274  */
decode_timing(u8 * buf,struct display_timing * timing)275 static void decode_timing(u8 *buf, struct display_timing *timing)
276 {
277 	uint x_mm, y_mm;
278 	unsigned int ha, hbl, hso, hspw, hborder;
279 	unsigned int va, vbl, vso, vspw, vborder;
280 	struct edid_detailed_timing *t = (struct edid_detailed_timing *)buf;
281 
282 	/* Edid contains pixel clock in terms of 10KHz */
283 	set_entry(&timing->pixelclock, (buf[0] + (buf[1] << 8)) * 10000);
284 	x_mm = (buf[12] + ((buf[14] & 0xf0) << 4));
285 	y_mm = (buf[13] + ((buf[14] & 0x0f) << 8));
286 	ha = (buf[2] + ((buf[4] & 0xf0) << 4));
287 	hbl = (buf[3] + ((buf[4] & 0x0f) << 8));
288 	hso = (buf[8] + ((buf[11] & 0xc0) << 2));
289 	hspw = (buf[9] + ((buf[11] & 0x30) << 4));
290 	hborder = buf[15];
291 	va = (buf[5] + ((buf[7] & 0xf0) << 4));
292 	vbl = (buf[6] + ((buf[7] & 0x0f) << 8));
293 	vso = ((buf[10] >> 4) + ((buf[11] & 0x0c) << 2));
294 	vspw = ((buf[10] & 0x0f) + ((buf[11] & 0x03) << 4));
295 	vborder = buf[16];
296 
297 	set_entry(&timing->hactive, ha);
298 	set_entry(&timing->hfront_porch, hso);
299 	set_entry(&timing->hback_porch, hbl - hso - hspw);
300 	set_entry(&timing->hsync_len, hspw);
301 
302 	set_entry(&timing->vactive, va);
303 	set_entry(&timing->vfront_porch, vso);
304 	set_entry(&timing->vback_porch, vbl - vso - vspw);
305 	set_entry(&timing->vsync_len, vspw);
306 
307 	timing->flags = 0;
308 	if (EDID_DETAILED_TIMING_FLAG_HSYNC_POLARITY(*t))
309 		timing->flags |= DISPLAY_FLAGS_HSYNC_HIGH;
310 	else
311 		timing->flags |= DISPLAY_FLAGS_HSYNC_LOW;
312 	if (EDID_DETAILED_TIMING_FLAG_VSYNC_POLARITY(*t))
313 		timing->flags |= DISPLAY_FLAGS_VSYNC_HIGH;
314 	else
315 		timing->flags |= DISPLAY_FLAGS_VSYNC_LOW;
316 
317 	if (EDID_DETAILED_TIMING_FLAG_INTERLACED(*t))
318 		timing->flags = DISPLAY_FLAGS_INTERLACED;
319 
320 	debug("Detailed mode clock %u Hz, %d mm x %d mm\n"
321 	      "               %04x %04x %04x %04x hborder %x\n"
322 	      "               %04x %04x %04x %04x vborder %x\n",
323 	      timing->pixelclock.typ,
324 	      x_mm, y_mm,
325 	      ha, ha + hso, ha + hso + hspw,
326 	      ha + hbl, hborder,
327 	      va, va + vso, va + vso + vspw,
328 	      va + vbl, vborder);
329 }
330 
331 /**
332  * Check if HDMI vendor specific data block is present in CEA block
333  * @param info	CEA extension block
334  * Return: true if block is found
335  */
cea_is_hdmi_vsdb_present(struct edid_cea861_info * info)336 static bool cea_is_hdmi_vsdb_present(struct edid_cea861_info *info)
337 {
338 	u8 end, i = 0;
339 
340 	/* check for end of data block */
341 	end = info->dtd_offset;
342 	if (end == 0)
343 		end = sizeof(info->data);
344 	if (end < 4 || end > sizeof(info->data))
345 		return false;
346 	end -= 4;
347 
348 	while (i < end) {
349 		/* Look for vendor specific data block of appropriate size */
350 		if ((EDID_CEA861_DB_TYPE(*info, i) == EDID_CEA861_DB_VENDOR) &&
351 		    (EDID_CEA861_DB_LEN(*info, i) >= 5)) {
352 			u8 *db = &info->data[i + 1];
353 			u32 oui = db[0] | (db[1] << 8) | (db[2] << 16);
354 
355 			if (oui == HDMI_IEEE_OUI)
356 				return true;
357 		}
358 		i += EDID_CEA861_DB_LEN(*info, i) + 1;
359 	}
360 
361 	return false;
362 }
363 
edid_find_valid_detailed_timing(void * buf,int count,struct display_timing * timing,bool (* mode_valid)(void * priv,const struct display_timing * timing),void * mode_valid_priv)364 static bool edid_find_valid_detailed_timing(void *buf, int count,
365 					    struct display_timing *timing,
366 					    bool (*mode_valid)(void *priv,
367 						const struct display_timing *timing),
368 					    void *mode_valid_priv)
369 {
370 	struct edid_detailed_timing *t = buf;
371 	bool found = false;
372 	int i;
373 
374 	for (i = 0; i < count && !found; i++, t++)
375 		if (EDID_DETAILED_TIMING_PIXEL_CLOCK(*t) != 0) {
376 			decode_timing((u8 *)t, timing);
377 			if (mode_valid)
378 				found = mode_valid(mode_valid_priv,
379 						   timing);
380 			else
381 				found = true;
382 		}
383 
384 	return found;
385 }
386 
edid_get_standard_timing(struct edid1_info * edid,int i,unsigned int * x,unsigned int * y,unsigned int * freq)387 static bool edid_get_standard_timing(struct edid1_info *edid, int i, unsigned int *x,
388 				     unsigned int *y, unsigned int *freq)
389 {
390 	unsigned int aspect = 10000;
391 	unsigned char xres, vfreq;
392 
393 	xres = EDID1_INFO_STANDARD_TIMING_XRESOLUTION(*edid, i);
394 	vfreq = EDID1_INFO_STANDARD_TIMING_VFREQ(*edid, i);
395 	if (xres != vfreq || (xres != 0 && xres != 1) ||
396 	    (vfreq != 0 && vfreq != 1)) {
397 		switch (EDID1_INFO_STANDARD_TIMING_ASPECT(*edid, i)) {
398 		case ASPECT_625: // 16:10
399 			aspect = 6250;
400 			break;
401 		case ASPECT_75: // 4:3
402 			aspect = 7500;
403 			break;
404 		case ASPECT_8: // 5:4
405 			aspect = 8000;
406 			break;
407 		case ASPECT_5625: // 16:9
408 			aspect = 5625;
409 			break;
410 		}
411 
412 		*x = (xres + 31) * 8;
413 		*y = *x * aspect / 10000;
414 		*freq = (vfreq & 0x3f) + 60;
415 
416 		return true;
417 	}
418 
419 	return false;
420 }
421 
422 #if CONFIG_IS_ENABLED(I2C_EDID_STANDARD)
edid_find_valid_standard_timing(struct edid1_info * buf,struct display_timing * timing,bool (* mode_valid)(void * priv,const struct display_timing * timing),void * mode_valid_priv)423 static bool edid_find_valid_standard_timing(struct edid1_info *buf,
424 					    struct display_timing *timing,
425 					    bool (*mode_valid)(void *priv,
426 						const struct display_timing *timing),
427 					    void *mode_valid_priv)
428 {
429 	unsigned int x, y, freq;
430 	bool found = false;
431 	int i, k;
432 
433 	for (i = 0; i < ARRAY_SIZE(buf->standard_timings); i++) {
434 		if (!edid_get_standard_timing(buf, i, &x, &y, &freq))
435 			continue;
436 
437 		for (k = 0; k < ARRAY_SIZE(dmt_timings); k++) {
438 			const struct display_timing *dt = &dmt_timings[k];
439 
440 			if (dt->hactive.typ == x && dt->vactive.typ == y) {
441 				found = mode_valid(mode_valid_priv, dt);
442 				if (found) {
443 					memcpy(timing, dt, sizeof(*timing));
444 					return true;
445 				}
446 			}
447 		}
448 	}
449 
450 	return found;
451 }
452 #endif
453 
edid_get_timing_validate(u8 * buf,int buf_size,struct display_timing * timing,int * panel_bits_per_colourp,bool (* mode_valid)(void * priv,const struct display_timing * timing),void * mode_valid_priv)454 int edid_get_timing_validate(u8 *buf, int buf_size,
455 			     struct display_timing *timing,
456 			     int *panel_bits_per_colourp,
457 			     bool (*mode_valid)(void *priv,
458 					const struct display_timing *timing),
459 			     void *mode_valid_priv)
460 {
461 	struct edid1_info *edid = (struct edid1_info *)buf;
462 	bool found;
463 
464 	if (buf_size < sizeof(*edid) || edid_check_info(edid)) {
465 		debug("%s: Invalid buffer\n", __func__);
466 		return -EINVAL;
467 	}
468 
469 	if (!EDID1_INFO_VIDEO_INPUT_DIGITAL(*edid)) {
470 		debug("%s: Not a digital display\n", __func__);
471 		return -ENOSYS;
472 	}
473 
474 	if (!EDID1_INFO_FEATURE_PREFERRED_TIMING_MODE(*edid)) {
475 		debug("%s: No preferred timing\n", __func__);
476 		return -ENOENT;
477 	}
478 
479 	/* Look for detailed timing in base EDID */
480 	found = edid_find_valid_detailed_timing(edid->monitor_details.descriptor, 4,
481 						timing, mode_valid, mode_valid_priv);
482 
483 	/* Look for detailed timing in CTA-861 Extension Block */
484 	if (!found && edid->extension_flag && buf_size >= EDID_EXT_SIZE) {
485 		struct edid_cea861_info *info =
486 			(struct edid_cea861_info *)(buf + sizeof(*edid));
487 
488 		if (info->extension_tag == EDID_CEA861_EXTENSION_TAG) {
489 			int count = EDID_CEA861_DTD_COUNT(*info);
490 			int offset = info->dtd_offset;
491 			int size = count * sizeof(struct edid_detailed_timing);
492 
493 			if (offset >= 4 && offset + size < EDID_SIZE)
494 				found = edid_find_valid_detailed_timing(
495 					(u8 *)info + offset, count, timing,
496 					mode_valid, mode_valid_priv);
497 		}
498 	}
499 
500 #if CONFIG_IS_ENABLED(I2C_EDID_STANDARD)
501 	/* Look for timing in Standard Timings */
502 	if (!found)
503 		found = edid_find_valid_standard_timing(edid, timing, mode_valid,
504 							mode_valid_priv);
505 #endif
506 
507 	if (!found)
508 		return -EINVAL;
509 
510 	if (edid->version != 1 || edid->revision < 4) {
511 		debug("%s: EDID version %d.%d does not have required info\n",
512 		      __func__, edid->version, edid->revision);
513 		*panel_bits_per_colourp = -1;
514 	} else  {
515 		*panel_bits_per_colourp =
516 			((edid->video_input_definition & 0x70) >> 3) + 4;
517 	}
518 
519 	timing->hdmi_monitor = false;
520 	if (edid->extension_flag && (buf_size >= EDID_EXT_SIZE)) {
521 		struct edid_cea861_info *info =
522 			(struct edid_cea861_info *)(buf + sizeof(*edid));
523 
524 		if (info->extension_tag == EDID_CEA861_EXTENSION_TAG)
525 			timing->hdmi_monitor = cea_is_hdmi_vsdb_present(info);
526 	}
527 
528 	return 0;
529 }
530 
edid_get_timing(u8 * buf,int buf_size,struct display_timing * timing,int * panel_bits_per_colourp)531 int edid_get_timing(u8 *buf, int buf_size, struct display_timing *timing,
532 		    int *panel_bits_per_colourp)
533 {
534 	return edid_get_timing_validate(buf, buf_size, timing,
535 					panel_bits_per_colourp, NULL, NULL);
536 }
537 
538 /**
539  * Snip the tailing whitespace/return of a string.
540  *
541  * @param string	The string to be snipped
542  * Return: the snipped string
543  */
snip(char * string)544 static char *snip(char *string)
545 {
546 	char *s;
547 
548 	/*
549 	 * This is always a 13 character buffer
550 	 * and it's not always terminated.
551 	 */
552 	string[12] = '\0';
553 	s = &string[strlen(string) - 1];
554 
555 	while (s >= string && (isspace(*s) || *s == '\n' || *s == '\r' ||
556 			*s == '\0'))
557 		*(s--) = '\0';
558 
559 	return string;
560 }
561 
562 /**
563  * Print an EDID monitor descriptor block
564  *
565  * @param monitor	The EDID monitor descriptor block
566  * @have_timing		Modifies to 1 if the desciptor contains timing info
567  */
edid_print_dtd(struct edid_monitor_descriptor * monitor,unsigned int * have_timing)568 static void edid_print_dtd(struct edid_monitor_descriptor *monitor,
569 			   unsigned int *have_timing)
570 {
571 	unsigned char *bytes = (unsigned char *)monitor;
572 	struct edid_detailed_timing *timing =
573 			(struct edid_detailed_timing *)monitor;
574 
575 	if (bytes[0] == 0 && bytes[1] == 0) {
576 		if (monitor->type == EDID_MONITOR_DESCRIPTOR_SERIAL)
577 			printf("Monitor serial number: %s\n",
578 			       snip(monitor->data.string));
579 		else if (monitor->type == EDID_MONITOR_DESCRIPTOR_ASCII)
580 			printf("Monitor ID: %s\n",
581 			       snip(monitor->data.string));
582 		else if (monitor->type == EDID_MONITOR_DESCRIPTOR_NAME)
583 			printf("Monitor name: %s\n",
584 			       snip(monitor->data.string));
585 		else if (monitor->type == EDID_MONITOR_DESCRIPTOR_RANGE)
586 			printf("Monitor range limits, horizontal sync: "
587 			       "%d-%d kHz, vertical refresh: "
588 			       "%d-%d Hz, max pixel clock: "
589 			       "%d MHz\n",
590 			       monitor->data.range_data.horizontal_min,
591 			       monitor->data.range_data.horizontal_max,
592 			       monitor->data.range_data.vertical_min,
593 			       monitor->data.range_data.vertical_max,
594 			       monitor->data.range_data.pixel_clock_max * 10);
595 	} else {
596 		uint32_t pixclock, h_active, h_blanking, v_active, v_blanking;
597 		uint32_t h_total, v_total, vfreq;
598 
599 		pixclock = EDID_DETAILED_TIMING_PIXEL_CLOCK(*timing);
600 		h_active = EDID_DETAILED_TIMING_HORIZONTAL_ACTIVE(*timing);
601 		h_blanking = EDID_DETAILED_TIMING_HORIZONTAL_BLANKING(*timing);
602 		v_active = EDID_DETAILED_TIMING_VERTICAL_ACTIVE(*timing);
603 		v_blanking = EDID_DETAILED_TIMING_VERTICAL_BLANKING(*timing);
604 
605 		h_total = h_active + h_blanking;
606 		v_total = v_active + v_blanking;
607 		if (v_total > 0 && h_total > 0)
608 			vfreq = pixclock / (v_total * h_total);
609 		else
610 			vfreq = 1; /* Error case */
611 		printf("\t%dx%d\%c\t%d Hz (detailed)\n", h_active,
612 		       v_active, h_active > 1000 ? ' ' : '\t', vfreq);
613 		*have_timing = 1;
614 	}
615 }
616 
617 /**
618  * Get the manufacturer name from an EDID info.
619  *
620  * @param edid_info     The EDID info to be printed
621  * @param name		Returns the string of the manufacturer name
622  */
edid_get_manufacturer_name(struct edid1_info * edid,char * name)623 static void edid_get_manufacturer_name(struct edid1_info *edid, char *name)
624 {
625 	name[0] = EDID1_INFO_MANUFACTURER_NAME_CHAR1(*edid) + 'A' - 1;
626 	name[1] = EDID1_INFO_MANUFACTURER_NAME_CHAR2(*edid) + 'A' - 1;
627 	name[2] = EDID1_INFO_MANUFACTURER_NAME_CHAR3(*edid) + 'A' - 1;
628 	name[3] = '\0';
629 }
630 
edid_print_info(struct edid1_info * edid_info)631 void edid_print_info(struct edid1_info *edid_info)
632 {
633 	int i;
634 	char manufacturer[4];
635 	unsigned int have_timing = 0;
636 	uint32_t serial_number;
637 
638 	if (edid_check_info(edid_info)) {
639 		printf("Not a valid EDID\n");
640 		return;
641 	}
642 
643 	printf("EDID version: %d.%d\n",
644 	       edid_info->version, edid_info->revision);
645 
646 	printf("Product ID code: %04x\n", EDID1_INFO_PRODUCT_CODE(*edid_info));
647 
648 	edid_get_manufacturer_name(edid_info, manufacturer);
649 	printf("Manufacturer: %s\n", manufacturer);
650 
651 	serial_number = EDID1_INFO_SERIAL_NUMBER(*edid_info);
652 	if (serial_number != 0xffffffff) {
653 		if (strcmp(manufacturer, "MAG") == 0)
654 			serial_number -= 0x7000000;
655 		if (strcmp(manufacturer, "OQI") == 0)
656 			serial_number -= 456150000;
657 		if (strcmp(manufacturer, "VSC") == 0)
658 			serial_number -= 640000000;
659 	}
660 	printf("Serial number: %08x\n", serial_number);
661 	printf("Manufactured in week: %d year: %d\n",
662 	       edid_info->week, edid_info->year + 1990);
663 
664 	printf("Video input definition: %svoltage level %d%s%s%s%s%s\n",
665 	       EDID1_INFO_VIDEO_INPUT_DIGITAL(*edid_info) ?
666 	       "digital signal, " : "analog signal, ",
667 	       EDID1_INFO_VIDEO_INPUT_VOLTAGE_LEVEL(*edid_info),
668 	       EDID1_INFO_VIDEO_INPUT_BLANK_TO_BLACK(*edid_info) ?
669 	       ", blank to black" : "",
670 	       EDID1_INFO_VIDEO_INPUT_SEPARATE_SYNC(*edid_info) ?
671 	       ", separate sync" : "",
672 	       EDID1_INFO_VIDEO_INPUT_COMPOSITE_SYNC(*edid_info) ?
673 	       ", composite sync" : "",
674 	       EDID1_INFO_VIDEO_INPUT_SYNC_ON_GREEN(*edid_info) ?
675 	       ", sync on green" : "",
676 	       EDID1_INFO_VIDEO_INPUT_SERRATION_V(*edid_info) ?
677 	       ", serration v" : "");
678 
679 	printf("Monitor is %s\n",
680 	       EDID1_INFO_FEATURE_RGB(*edid_info) ? "RGB" : "non-RGB");
681 
682 	printf("Maximum visible display size: %d cm x %d cm\n",
683 	       edid_info->max_size_horizontal,
684 	       edid_info->max_size_vertical);
685 
686 	printf("Power management features: %s%s, %s%s, %s%s\n",
687 	       EDID1_INFO_FEATURE_ACTIVE_OFF(*edid_info) ?
688 	       "" : "no ", "active off",
689 	       EDID1_INFO_FEATURE_SUSPEND(*edid_info) ? "" : "no ", "suspend",
690 	       EDID1_INFO_FEATURE_STANDBY(*edid_info) ? "" : "no ", "standby");
691 
692 	printf("Estabilished timings:\n");
693 	if (EDID1_INFO_ESTABLISHED_TIMING_720X400_70(*edid_info))
694 		printf("\t720x400\t\t70 Hz (VGA 640x400, IBM)\n");
695 	if (EDID1_INFO_ESTABLISHED_TIMING_720X400_88(*edid_info))
696 		printf("\t720x400\t\t88 Hz (XGA2)\n");
697 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_60(*edid_info))
698 		printf("\t640x480\t\t60 Hz (VGA)\n");
699 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_67(*edid_info))
700 		printf("\t640x480\t\t67 Hz (Mac II, Apple)\n");
701 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_72(*edid_info))
702 		printf("\t640x480\t\t72 Hz (VESA)\n");
703 	if (EDID1_INFO_ESTABLISHED_TIMING_640X480_75(*edid_info))
704 		printf("\t640x480\t\t75 Hz (VESA)\n");
705 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_56(*edid_info))
706 		printf("\t800x600\t\t56 Hz (VESA)\n");
707 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_60(*edid_info))
708 		printf("\t800x600\t\t60 Hz (VESA)\n");
709 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_72(*edid_info))
710 		printf("\t800x600\t\t72 Hz (VESA)\n");
711 	if (EDID1_INFO_ESTABLISHED_TIMING_800X600_75(*edid_info))
712 		printf("\t800x600\t\t75 Hz (VESA)\n");
713 	if (EDID1_INFO_ESTABLISHED_TIMING_832X624_75(*edid_info))
714 		printf("\t832x624\t\t75 Hz (Mac II)\n");
715 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_87I(*edid_info))
716 		printf("\t1024x768\t87 Hz Interlaced (8514A)\n");
717 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_60(*edid_info))
718 		printf("\t1024x768\t60 Hz (VESA)\n");
719 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_70(*edid_info))
720 		printf("\t1024x768\t70 Hz (VESA)\n");
721 	if (EDID1_INFO_ESTABLISHED_TIMING_1024X768_75(*edid_info))
722 		printf("\t1024x768\t75 Hz (VESA)\n");
723 	if (EDID1_INFO_ESTABLISHED_TIMING_1280X1024_75(*edid_info))
724 		printf("\t1280x1024\t75 (VESA)\n");
725 	if (EDID1_INFO_ESTABLISHED_TIMING_1152X870_75(*edid_info))
726 		printf("\t1152x870\t75 (Mac II)\n");
727 
728 	/* Standard timings. */
729 	printf("Standard timings:\n");
730 	for (i = 0; i < ARRAY_SIZE(edid_info->standard_timings); i++) {
731 		unsigned int x, y, freq;
732 
733 		if (edid_get_standard_timing(edid_info, i, &x, &y, &freq)) {
734 			printf("\t%dx%d%c\t%d Hz\n", x, y,
735 			       x > 1000 ? ' ' : '\t', freq);
736 			have_timing = 1;
737 		}
738 	}
739 
740 	/* Detailed timing information. */
741 	for (i = 0; i < ARRAY_SIZE(edid_info->monitor_details.descriptor);
742 			i++) {
743 		edid_print_dtd(&edid_info->monitor_details.descriptor[i],
744 			       &have_timing);
745 	}
746 
747 	if (!have_timing)
748 		printf("\tNone\n");
749 }
750