1278798Shselasky/* $NetBSD: edid.c,v 1.12 2013/02/08 16:35:10 skrll Exp $ */
2278798Shselasky/* $FreeBSD$ */
3278798Shselasky
4278798Shselasky/*-
5278798Shselasky * Copyright (c) 2006 Itronix Inc.
6278798Shselasky * All rights reserved.
7278798Shselasky *
8278798Shselasky * Written by Garrett D'Amore for Itronix Inc.
9278798Shselasky *
10278798Shselasky * Redistribution and use in source and binary forms, with or without
11278798Shselasky * modification, are permitted provided that the following conditions
12278798Shselasky * are met:
13278798Shselasky * 1. Redistributions of source code must retain the above copyright
14278798Shselasky *    notice, this list of conditions and the following disclaimer.
15278798Shselasky * 2. Redistributions in binary form must reproduce the above copyright
16278798Shselasky *    notice, this list of conditions and the following disclaimer in the
17278798Shselasky *    documentation and/or other materials provided with the distribution.
18278798Shselasky * 3. The name of Itronix Inc. may not be used to endorse
19278798Shselasky *    or promote products derived from this software without specific
20278798Shselasky *    prior written permission.
21278798Shselasky *
22278798Shselasky * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND ANY EXPRESS
23278798Shselasky * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
24278798Shselasky * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25278798Shselasky * ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
26278798Shselasky * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27278798Shselasky * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
28278798Shselasky * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29278798Shselasky * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
30278798Shselasky * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
31278798Shselasky * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
32278798Shselasky * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33278798Shselasky */
34278798Shselasky
35278798Shselasky#include <sys/cdefs.h>
36278798Shselasky__FBSDID("$FreeBSD$");
37278798Shselasky
38278798Shselasky#include <sys/param.h>
39278798Shselasky#include <sys/systm.h>
40278798Shselasky#include <sys/kernel.h>
41278798Shselasky#include <sys/malloc.h>
42278798Shselasky#include <sys/libkern.h>
43278798Shselasky#include <dev/videomode/videomode.h>
44278798Shselasky#include <dev/videomode/ediddevs.h>
45278798Shselasky#include <dev/videomode/edidreg.h>
46278798Shselasky#include <dev/videomode/edidvar.h>
47278798Shselasky#include <dev/videomode/vesagtf.h>
48278798Shselasky
49278798Shselasky#define	EDIDVERBOSE	1
50278798Shselasky#define	DIVIDE(x,y)	(((x) + ((y) / 2)) / (y))
51278798Shselasky
52278798Shselasky/* These are reversed established timing order */
53278798Shselaskystatic const char *_edid_modes[] =  {
54278798Shselasky	"1280x1024x75",
55278798Shselasky	"1024x768x75",
56278798Shselasky	"1024x768x70",
57278798Shselasky	"1024x768x60",
58278798Shselasky	"1024x768x87i",
59278798Shselasky	"832x624x74",	/* rounding error, 74.55 Hz aka "832x624x75" */
60278798Shselasky	"800x600x75",
61278798Shselasky	"800x600x72",
62278798Shselasky	"800x600x60",
63278798Shselasky	"800x600x56",
64278798Shselasky	"640x480x75",
65278798Shselasky	"640x480x72",
66278798Shselasky	"640x480x67",
67278798Shselasky	"640x480x60",
68278798Shselasky	"720x400x87",	/* rounding error, 87.85 Hz aka "720x400x88" */
69278798Shselasky	"720x400x70",
70278798Shselasky};
71278798Shselasky
72278798Shselasky#ifdef	EDIDVERBOSE
73278798Shselaskystruct edid_vendor {
74278798Shselasky	const char	*vendor;
75278798Shselasky	const char	*name;
76278798Shselasky};
77278798Shselasky
78278798Shselaskystruct edid_product {
79278798Shselasky	const char	*vendor;
80278798Shselasky	uint16_t	product;
81278798Shselasky	const char	*name;
82278798Shselasky};
83278798Shselasky
84278798Shselasky#include <dev/videomode/ediddevs_data.h>
85278798Shselasky#endif	/* EDIDVERBOSE */
86278798Shselasky
87278798Shselaskystatic const char *
88278798Shselaskyedid_findvendor(const char *vendor)
89278798Shselasky{
90278798Shselasky#ifdef	EDIDVERBOSE
91278798Shselasky	int	n;
92278798Shselasky
93278798Shselasky	for (n = 0; n < edid_nvendors; n++)
94278798Shselasky		if (memcmp(edid_vendors[n].vendor, vendor, 3) == 0)
95278798Shselasky			return edid_vendors[n].name;
96278798Shselasky#endif
97278798Shselasky	return NULL;
98278798Shselasky}
99278798Shselasky
100278798Shselaskystatic const char *
101278798Shselaskyedid_findproduct(const char *vendor, uint16_t product)
102278798Shselasky{
103278798Shselasky#ifdef	EDIDVERBOSE
104278798Shselasky	int	n;
105278798Shselasky
106278798Shselasky	for (n = 0; n < edid_nproducts; n++)
107278798Shselasky		if (edid_products[n].product == product &&
108278798Shselasky		    memcmp(edid_products[n].vendor, vendor, 3) == 0)
109278798Shselasky			return edid_products[n].name;
110278798Shselasky#endif	/* EDIDVERBOSE */
111278798Shselasky	return NULL;
112278798Shselasky
113278798Shselasky}
114278798Shselasky
115278798Shselaskystatic void
116278798Shselaskyedid_strchomp(char *ptr)
117278798Shselasky{
118278798Shselasky	for (;;) {
119278798Shselasky		switch (*ptr) {
120278798Shselasky		case '\0':
121278798Shselasky			return;
122278798Shselasky		case '\r':
123278798Shselasky		case '\n':
124278798Shselasky			*ptr = '\0';
125278798Shselasky			return;
126278798Shselasky		}
127278798Shselasky		ptr++;
128278798Shselasky	}
129278798Shselasky}
130278798Shselasky
131278798Shselaskyint
132278798Shselaskyedid_is_valid(uint8_t *d)
133278798Shselasky{
134278798Shselasky	int sum = 0, i;
135278798Shselasky	uint8_t sig[8] = EDID_SIGNATURE;
136278798Shselasky
137278798Shselasky	if (memcmp(d, sig, 8) != 0)
138278798Shselasky		return EINVAL;
139278798Shselasky
140278798Shselasky	for (i = 0; i < 128; i++)
141278798Shselasky		sum += d[i];
142278798Shselasky	if ((sum & 0xff) != 0)
143278798Shselasky		return EINVAL;
144278798Shselasky
145278798Shselasky	return 0;
146278798Shselasky}
147278798Shselasky
148278798Shselaskyvoid
149278798Shselaskyedid_print(struct edid_info *edid)
150278798Shselasky{
151278798Shselasky	int	i;
152278798Shselasky
153278798Shselasky	if (edid == NULL)
154278798Shselasky		return;
155278798Shselasky	printf("Vendor: [%s] %s\n", edid->edid_vendor, edid->edid_vendorname);
156278798Shselasky	printf("Product: [%04X] %s\n", edid->edid_product,
157278798Shselasky	    edid->edid_productname);
158278798Shselasky	printf("Serial number: %s\n", edid->edid_serial);
159278798Shselasky	printf("Manufactured %d Week %d\n",
160278798Shselasky	    edid->edid_year, edid->edid_week);
161278798Shselasky	printf("EDID Version %d.%d\n", edid->edid_version,
162278798Shselasky	    edid->edid_revision);
163278798Shselasky	printf("EDID Comment: %s\n", edid->edid_comment);
164278798Shselasky
165278798Shselasky	printf("Video Input: %x\n", edid->edid_video_input);
166278798Shselasky	if (edid->edid_video_input & EDID_VIDEO_INPUT_DIGITAL) {
167278798Shselasky		printf("\tDigital");
168278798Shselasky		if (edid->edid_video_input & EDID_VIDEO_INPUT_DFP1_COMPAT)
169278798Shselasky			printf(" (DFP 1.x compatible)");
170278798Shselasky		printf("\n");
171278798Shselasky	} else {
172278798Shselasky		printf("\tAnalog\n");
173278798Shselasky		switch (EDID_VIDEO_INPUT_LEVEL(edid->edid_video_input)) {
174278798Shselasky		case 0:
175278798Shselasky			printf("\t-0.7, 0.3V\n");
176278798Shselasky			break;
177278798Shselasky		case 1:
178278798Shselasky			printf("\t-0.714, 0.286V\n");
179278798Shselasky			break;
180278798Shselasky		case 2:
181278798Shselasky			printf("\t-1.0, 0.4V\n");
182278798Shselasky			break;
183278798Shselasky		case 3:
184278798Shselasky			printf("\t-0.7, 0.0V\n");
185278798Shselasky			break;
186278798Shselasky		}
187278798Shselasky		if (edid->edid_video_input & EDID_VIDEO_INPUT_BLANK_TO_BLACK)
188278798Shselasky			printf("\tBlank-to-black setup\n");
189278798Shselasky		if (edid->edid_video_input & EDID_VIDEO_INPUT_SEPARATE_SYNCS)
190278798Shselasky			printf("\tSeperate syncs\n");
191278798Shselasky		if (edid->edid_video_input & EDID_VIDEO_INPUT_COMPOSITE_SYNC)
192278798Shselasky			printf("\tComposite sync\n");
193278798Shselasky		if (edid->edid_video_input & EDID_VIDEO_INPUT_SYNC_ON_GRN)
194278798Shselasky			printf("\tSync on green\n");
195278798Shselasky		if (edid->edid_video_input & EDID_VIDEO_INPUT_SERRATION)
196278798Shselasky			printf("\tSerration vsync\n");
197278798Shselasky	}
198278798Shselasky
199278798Shselasky	printf("Gamma: %d.%02d\n",
200278798Shselasky	    edid->edid_gamma / 100, edid->edid_gamma % 100);
201278798Shselasky
202278798Shselasky	printf("Max Size: %d cm x %d cm\n",
203278798Shselasky	    edid->edid_max_hsize, edid->edid_max_vsize);
204278798Shselasky
205278798Shselasky	printf("Features: %x\n", edid->edid_features);
206278798Shselasky	if (edid->edid_features & EDID_FEATURES_STANDBY)
207278798Shselasky		printf("\tDPMS standby\n");
208278798Shselasky	if (edid->edid_features & EDID_FEATURES_SUSPEND)
209278798Shselasky		printf("\tDPMS suspend\n");
210278798Shselasky	if (edid->edid_features & EDID_FEATURES_ACTIVE_OFF)
211278798Shselasky		printf("\tDPMS active-off\n");
212278798Shselasky	switch (EDID_FEATURES_DISP_TYPE(edid->edid_features)) {
213278798Shselasky	case EDID_FEATURES_DISP_TYPE_MONO:
214278798Shselasky		printf("\tMonochrome\n");
215278798Shselasky		break;
216278798Shselasky	case EDID_FEATURES_DISP_TYPE_RGB:
217278798Shselasky		printf("\tRGB\n");
218278798Shselasky		break;
219278798Shselasky	case EDID_FEATURES_DISP_TYPE_NON_RGB:
220278798Shselasky		printf("\tMulticolor\n");
221278798Shselasky		break;
222278798Shselasky	case EDID_FEATURES_DISP_TYPE_UNDEFINED:
223278798Shselasky		printf("\tUndefined monitor type\n");
224278798Shselasky		break;
225278798Shselasky	}
226278798Shselasky	if (edid->edid_features & EDID_FEATURES_STD_COLOR)
227278798Shselasky		printf("\tStandard color space\n");
228278798Shselasky	if (edid->edid_features & EDID_FEATURES_PREFERRED_TIMING)
229278798Shselasky		printf("\tPreferred timing\n");
230278798Shselasky	if (edid->edid_features & EDID_FEATURES_DEFAULT_GTF)
231278798Shselasky		printf("\tDefault GTF supported\n");
232278798Shselasky
233278798Shselasky	printf("Chroma Info:\n");
234278798Shselasky	printf("\tRed X: 0.%03d\n", edid->edid_chroma.ec_redx);
235278798Shselasky	printf("\tRed Y: 0.%03d\n", edid->edid_chroma.ec_redy);
236278798Shselasky	printf("\tGrn X: 0.%03d\n", edid->edid_chroma.ec_greenx);
237278798Shselasky	printf("\tGrn Y: 0.%03d\n", edid->edid_chroma.ec_greeny);
238278798Shselasky	printf("\tBlu X: 0.%03d\n", edid->edid_chroma.ec_bluex);
239278798Shselasky	printf("\tBlu Y: 0.%03d\n", edid->edid_chroma.ec_bluey);
240278798Shselasky	printf("\tWht X: 0.%03d\n", edid->edid_chroma.ec_whitex);
241278798Shselasky	printf("\tWht Y: 0.%03d\n", edid->edid_chroma.ec_whitey);
242278798Shselasky
243278798Shselasky	if (edid->edid_have_range) {
244278798Shselasky		printf("Range:\n");
245278798Shselasky		printf("\tHorizontal: %d - %d kHz\n",
246278798Shselasky		    edid->edid_range.er_min_hfreq,
247278798Shselasky		    edid->edid_range.er_max_hfreq);
248278798Shselasky		printf("\tVertical: %d - %d Hz\n",
249278798Shselasky		    edid->edid_range.er_min_vfreq,
250278798Shselasky		    edid->edid_range.er_max_vfreq);
251278798Shselasky		printf("\tMax Dot Clock: %d MHz\n",
252278798Shselasky		    edid->edid_range.er_max_clock);
253278798Shselasky		if (edid->edid_range.er_have_gtf2) {
254278798Shselasky			printf("\tGTF2 hfreq: %d\n",
255278798Shselasky			    edid->edid_range.er_gtf2_hfreq);
256278798Shselasky			printf("\tGTF2 C: %d\n", edid->edid_range.er_gtf2_c);
257278798Shselasky			printf("\tGTF2 M: %d\n", edid->edid_range.er_gtf2_m);
258278798Shselasky			printf("\tGTF2 J: %d\n", edid->edid_range.er_gtf2_j);
259278798Shselasky			printf("\tGTF2 K: %d\n", edid->edid_range.er_gtf2_k);
260278798Shselasky		}
261278798Shselasky	}
262278798Shselasky	printf("Video modes:\n");
263278798Shselasky	for (i = 0; i < edid->edid_nmodes; i++) {
264278798Shselasky		printf("\t%dx%d @ %dHz",
265278798Shselasky		    edid->edid_modes[i].hdisplay,
266278798Shselasky		    edid->edid_modes[i].vdisplay,
267278798Shselasky		    DIVIDE(DIVIDE(edid->edid_modes[i].dot_clock * 1000,
268278798Shselasky		    edid->edid_modes[i].htotal), edid->edid_modes[i].vtotal));
269278798Shselasky		printf(" (%d %d %d %d %d %d %d",
270278798Shselasky		    edid->edid_modes[i].dot_clock,
271278798Shselasky		    edid->edid_modes[i].hsync_start,
272278798Shselasky		    edid->edid_modes[i].hsync_end,
273278798Shselasky		    edid->edid_modes[i].htotal,
274278798Shselasky		    edid->edid_modes[i].vsync_start,
275278798Shselasky		    edid->edid_modes[i].vsync_end,
276278798Shselasky		    edid->edid_modes[i].vtotal);
277278798Shselasky		printf(" %s%sH %s%sV)\n",
278278798Shselasky		    edid->edid_modes[i].flags & VID_PHSYNC ? "+" : "",
279278798Shselasky		    edid->edid_modes[i].flags & VID_NHSYNC ? "-" : "",
280278798Shselasky		    edid->edid_modes[i].flags & VID_PVSYNC ? "+" : "",
281278798Shselasky		    edid->edid_modes[i].flags & VID_NVSYNC ? "-" : "");
282278798Shselasky	}
283278798Shselasky	if (edid->edid_preferred_mode)
284278798Shselasky		printf("Preferred mode: %dx%d @ %dHz\n",
285278798Shselasky		    edid->edid_preferred_mode->hdisplay,
286278798Shselasky		    edid->edid_preferred_mode->vdisplay,
287278798Shselasky		    DIVIDE(DIVIDE(edid->edid_preferred_mode->dot_clock * 1000,
288278798Shselasky		    edid->edid_preferred_mode->htotal),
289278798Shselasky		    edid->edid_preferred_mode->vtotal));
290278798Shselasky
291278798Shselasky	printf("Number of extension blocks: %d\n", edid->edid_ext_block_count);
292278798Shselasky}
293278798Shselasky
294278798Shselaskystatic const struct videomode *
295278798Shselaskyedid_mode_lookup_list(const char *name)
296278798Shselasky{
297278798Shselasky	int	i;
298278798Shselasky
299278798Shselasky	for (i = 0; i < videomode_count; i++)
300278798Shselasky		if (strcmp(name, videomode_list[i].name) == 0)
301278798Shselasky			return &videomode_list[i];
302278798Shselasky	return NULL;
303278798Shselasky}
304278798Shselasky
305278798Shselaskystatic struct videomode *
306278798Shselaskyedid_search_mode(struct edid_info *edid, const struct videomode *mode)
307278798Shselasky{
308278798Shselasky	int	refresh, i;
309278798Shselasky
310278798Shselasky	refresh = DIVIDE(DIVIDE(mode->dot_clock * 1000,
311278798Shselasky	    mode->htotal), mode->vtotal);
312278798Shselasky	for (i = 0; i < edid->edid_nmodes; i++) {
313278798Shselasky		if (mode->hdisplay == edid->edid_modes[i].hdisplay &&
314278798Shselasky		    mode->vdisplay == edid->edid_modes[i].vdisplay &&
315278798Shselasky		    refresh == DIVIDE(DIVIDE(
316278798Shselasky		    edid->edid_modes[i].dot_clock * 1000,
317278798Shselasky		    edid->edid_modes[i].htotal), edid->edid_modes[i].vtotal)) {
318278798Shselasky			return &edid->edid_modes[i];
319278798Shselasky		}
320278798Shselasky	}
321278798Shselasky	return NULL;
322278798Shselasky}
323278798Shselasky
324278798Shselaskystatic int
325278798Shselaskyedid_std_timing(uint8_t *data, struct videomode *vmp)
326278798Shselasky{
327278798Shselasky	unsigned			x, y, f;
328278798Shselasky	const struct videomode		*lookup;
329278798Shselasky	char				name[80];
330278798Shselasky
331278798Shselasky	if ((data[0] == 1 && data[1] == 1) ||
332278798Shselasky	    (data[0] == 0 && data[1] == 0) ||
333278798Shselasky	    (data[0] == 0x20 && data[1] == 0x20))
334278798Shselasky		return 0;
335278798Shselasky
336278798Shselasky	x = EDID_STD_TIMING_HRES(data);
337278798Shselasky	switch (EDID_STD_TIMING_RATIO(data)) {
338278798Shselasky	case EDID_STD_TIMING_RATIO_16_10:
339278798Shselasky		y = x * 10 / 16;
340278798Shselasky		break;
341278798Shselasky	case EDID_STD_TIMING_RATIO_4_3:
342278798Shselasky		y = x * 3 / 4;
343278798Shselasky		break;
344278798Shselasky	case EDID_STD_TIMING_RATIO_5_4:
345278798Shselasky		y = x * 4 / 5;
346278798Shselasky		break;
347278798Shselasky	case EDID_STD_TIMING_RATIO_16_9:
348278798Shselasky	default:
349278798Shselasky		y = x * 9 / 16;
350278798Shselasky		break;
351278798Shselasky	}
352278798Shselasky	f = EDID_STD_TIMING_VFREQ(data);
353278798Shselasky
354278798Shselasky	/* first try to lookup the mode as a DMT timing */
355278798Shselasky	snprintf(name, sizeof(name), "%dx%dx%d", x, y, f);
356278798Shselasky	if ((lookup = edid_mode_lookup_list(name)) != NULL) {
357278798Shselasky		*vmp = *lookup;
358278798Shselasky	} else {
359278798Shselasky		/* failing that, calculate it using gtf */
360278798Shselasky		/*
361278798Shselasky		 * Hmm. I'm not using alternate GTF timings, which
362278798Shselasky		 * could, in theory, be present.
363278798Shselasky		 */
364278798Shselasky		vesagtf_mode(x, y, f, vmp);
365278798Shselasky	}
366278798Shselasky	return 1;
367278798Shselasky}
368278798Shselasky
369278798Shselaskystatic int
370278798Shselaskyedid_det_timing(uint8_t *data, struct videomode *vmp)
371278798Shselasky{
372278798Shselasky	unsigned	hactive, hblank, hsyncwid, hsyncoff;
373278798Shselasky	unsigned	vactive, vblank, vsyncwid, vsyncoff;
374278798Shselasky	uint8_t		flags;
375278798Shselasky
376278798Shselasky	flags = EDID_DET_TIMING_FLAGS(data);
377278798Shselasky
378278798Shselasky	/* we don't support stereo modes (for now) */
379278798Shselasky	if (flags & (EDID_DET_TIMING_FLAG_STEREO |
380278798Shselasky		EDID_DET_TIMING_FLAG_STEREO_MODE))
381278798Shselasky		return 0;
382278798Shselasky
383278798Shselasky	vmp->dot_clock = EDID_DET_TIMING_DOT_CLOCK(data) / 1000;
384278798Shselasky
385278798Shselasky	hactive = EDID_DET_TIMING_HACTIVE(data);
386278798Shselasky	hblank = EDID_DET_TIMING_HBLANK(data);
387278798Shselasky	hsyncwid = EDID_DET_TIMING_HSYNC_WIDTH(data);
388278798Shselasky	hsyncoff = EDID_DET_TIMING_HSYNC_OFFSET(data);
389278798Shselasky
390278798Shselasky	vactive = EDID_DET_TIMING_VACTIVE(data);
391278798Shselasky	vblank = EDID_DET_TIMING_VBLANK(data);
392278798Shselasky	vsyncwid = EDID_DET_TIMING_VSYNC_WIDTH(data);
393278798Shselasky	vsyncoff = EDID_DET_TIMING_VSYNC_OFFSET(data);
394278798Shselasky
395278798Shselasky	/* Borders are contained within the blank areas. */
396278798Shselasky
397278798Shselasky	vmp->hdisplay = hactive;
398278798Shselasky	vmp->htotal = hactive + hblank;
399278798Shselasky	vmp->hsync_start = hactive + hsyncoff;
400278798Shselasky	vmp->hsync_end = vmp->hsync_start + hsyncwid;
401278798Shselasky
402278798Shselasky	vmp->vdisplay = vactive;
403278798Shselasky	vmp->vtotal = vactive + vblank;
404278798Shselasky	vmp->vsync_start = vactive + vsyncoff;
405278798Shselasky	vmp->vsync_end = vmp->vsync_start + vsyncwid;
406278798Shselasky
407278798Shselasky	vmp->flags = 0;
408278798Shselasky
409278798Shselasky	if (flags & EDID_DET_TIMING_FLAG_INTERLACE)
410278798Shselasky		vmp->flags |= VID_INTERLACE;
411278798Shselasky	if (flags & EDID_DET_TIMING_FLAG_HSYNC_POSITIVE)
412278798Shselasky		vmp->flags |= VID_PHSYNC;
413278798Shselasky	else
414278798Shselasky		vmp->flags |= VID_NHSYNC;
415278798Shselasky
416278798Shselasky	if (flags & EDID_DET_TIMING_FLAG_VSYNC_POSITIVE)
417278798Shselasky		vmp->flags |= VID_PVSYNC;
418278798Shselasky	else
419278798Shselasky		vmp->flags |= VID_NVSYNC;
420278798Shselasky
421278798Shselasky	return 1;
422278798Shselasky}
423278798Shselasky
424278798Shselaskystatic void
425278798Shselaskyedid_block(struct edid_info *edid, uint8_t *data)
426278798Shselasky{
427278798Shselasky	int			i;
428278798Shselasky	struct videomode	mode, *exist_mode;
429278798Shselasky
430278798Shselasky	if (EDID_BLOCK_IS_DET_TIMING(data)) {
431278798Shselasky		if (!edid_det_timing(data, &mode))
432278798Shselasky			return;
433278798Shselasky		/* Does this mode already exist? */
434278798Shselasky		exist_mode = edid_search_mode(edid, &mode);
435278798Shselasky		if (exist_mode != NULL) {
436278798Shselasky			*exist_mode = mode;
437278798Shselasky			if (edid->edid_preferred_mode == NULL)
438278798Shselasky				edid->edid_preferred_mode = exist_mode;
439278798Shselasky		} else {
440278798Shselasky			edid->edid_modes[edid->edid_nmodes] = mode;
441278798Shselasky			if (edid->edid_preferred_mode == NULL)
442278798Shselasky				edid->edid_preferred_mode =
443278798Shselasky				    &edid->edid_modes[edid->edid_nmodes];
444278798Shselasky			edid->edid_nmodes++;
445278798Shselasky		}
446278798Shselasky		return;
447278798Shselasky	}
448278798Shselasky
449278798Shselasky	switch (EDID_BLOCK_TYPE(data)) {
450278798Shselasky	case EDID_DESC_BLOCK_TYPE_SERIAL:
451278798Shselasky		memcpy(edid->edid_serial, data + EDID_DESC_ASCII_DATA_OFFSET,
452278798Shselasky		    EDID_DESC_ASCII_DATA_LEN);
453278798Shselasky		edid->edid_serial[sizeof(edid->edid_serial) - 1] = 0;
454278798Shselasky		break;
455278798Shselasky
456278798Shselasky	case EDID_DESC_BLOCK_TYPE_ASCII:
457278798Shselasky		memcpy(edid->edid_comment, data + EDID_DESC_ASCII_DATA_OFFSET,
458278798Shselasky		    EDID_DESC_ASCII_DATA_LEN);
459278798Shselasky		edid->edid_comment[sizeof(edid->edid_comment) - 1] = 0;
460278798Shselasky		break;
461278798Shselasky
462278798Shselasky	case EDID_DESC_BLOCK_TYPE_RANGE:
463278798Shselasky		edid->edid_have_range = 1;
464278798Shselasky		edid->edid_range.er_min_vfreq =	EDID_DESC_RANGE_MIN_VFREQ(data);
465278798Shselasky		edid->edid_range.er_max_vfreq =	EDID_DESC_RANGE_MAX_VFREQ(data);
466278798Shselasky		edid->edid_range.er_min_hfreq =	EDID_DESC_RANGE_MIN_HFREQ(data);
467278798Shselasky		edid->edid_range.er_max_hfreq =	EDID_DESC_RANGE_MAX_HFREQ(data);
468278798Shselasky		edid->edid_range.er_max_clock = EDID_DESC_RANGE_MAX_CLOCK(data);
469278798Shselasky		if (!EDID_DESC_RANGE_HAVE_GTF2(data))
470278798Shselasky			break;
471278798Shselasky		edid->edid_range.er_have_gtf2 = 1;
472278798Shselasky		edid->edid_range.er_gtf2_hfreq =
473278798Shselasky		    EDID_DESC_RANGE_GTF2_HFREQ(data);
474278798Shselasky		edid->edid_range.er_gtf2_c = EDID_DESC_RANGE_GTF2_C(data);
475278798Shselasky		edid->edid_range.er_gtf2_m = EDID_DESC_RANGE_GTF2_M(data);
476278798Shselasky		edid->edid_range.er_gtf2_j = EDID_DESC_RANGE_GTF2_J(data);
477278798Shselasky		edid->edid_range.er_gtf2_k = EDID_DESC_RANGE_GTF2_K(data);
478278798Shselasky		break;
479278798Shselasky
480278798Shselasky	case EDID_DESC_BLOCK_TYPE_NAME:
481278798Shselasky		/* copy the product name into place */
482278798Shselasky		memcpy(edid->edid_productname,
483278798Shselasky		    data + EDID_DESC_ASCII_DATA_OFFSET,
484278798Shselasky		    EDID_DESC_ASCII_DATA_LEN);
485278798Shselasky		break;
486278798Shselasky
487278798Shselasky	case EDID_DESC_BLOCK_TYPE_STD_TIMING:
488278798Shselasky		data += EDID_DESC_STD_TIMING_START;
489278798Shselasky		for (i = 0; i < EDID_DESC_STD_TIMING_COUNT; i++) {
490278798Shselasky			if (edid_std_timing(data, &mode)) {
491278798Shselasky				/* Does this mode already exist? */
492278798Shselasky				exist_mode = edid_search_mode(edid, &mode);
493278798Shselasky				if (exist_mode == NULL) {
494278798Shselasky					edid->edid_modes[edid->edid_nmodes] =
495278798Shselasky					    mode;
496278798Shselasky					edid->edid_nmodes++;
497278798Shselasky				}
498278798Shselasky			}
499278798Shselasky			data += 2;
500278798Shselasky		}
501278798Shselasky		break;
502278798Shselasky
503278798Shselasky	case EDID_DESC_BLOCK_TYPE_COLOR_POINT:
504278798Shselasky		/* XXX: not implemented yet */
505278798Shselasky		break;
506278798Shselasky	}
507278798Shselasky}
508278798Shselasky
509278798Shselasky/*
510278798Shselasky * Gets EDID version in BCD, e.g. EDID v1.3  returned as 0x0103
511278798Shselasky */
512278798Shselaskyint
513278798Shselaskyedid_parse(uint8_t *data, struct edid_info *edid)
514278798Shselasky{
515278798Shselasky	uint16_t		manfid, estmodes;
516278798Shselasky	const struct videomode	*vmp;
517278798Shselasky	int			i;
518278798Shselasky	const char		*name;
519278798Shselasky	int max_dotclock = 0;
520278798Shselasky	int mhz;
521278798Shselasky
522278798Shselasky	if (edid_is_valid(data) != 0)
523278798Shselasky		return -1;
524278798Shselasky
525278798Shselasky	/* get product identification */
526278798Shselasky	manfid = EDID_VENDOR_ID(data);
527278798Shselasky	edid->edid_vendor[0] = EDID_MANFID_0(manfid);
528278798Shselasky	edid->edid_vendor[1] = EDID_MANFID_1(manfid);
529278798Shselasky	edid->edid_vendor[2] = EDID_MANFID_2(manfid);
530278798Shselasky	edid->edid_vendor[3] = 0;	/* null terminate for convenience */
531278798Shselasky
532278798Shselasky	edid->edid_product = data[EDID_OFFSET_PRODUCT_ID] +
533278798Shselasky	    (data[EDID_OFFSET_PRODUCT_ID + 1] << 8);
534278798Shselasky
535278798Shselasky	name = edid_findvendor(edid->edid_vendor);
536278798Shselasky	if (name != NULL)
537278798Shselasky		strlcpy(edid->edid_vendorname, name,
538278798Shselasky		    sizeof(edid->edid_vendorname));
539278798Shselasky	else
540278798Shselasky		edid->edid_vendorname[0] = '\0';
541278798Shselasky
542278798Shselasky	name = edid_findproduct(edid->edid_vendor, edid->edid_product);
543278798Shselasky	if (name != NULL)
544278798Shselasky		strlcpy(edid->edid_productname, name,
545278798Shselasky		    sizeof(edid->edid_productname));
546278798Shselasky	else
547278798Shselasky	    edid->edid_productname[0] = '\0';
548278798Shselasky
549278798Shselasky	snprintf(edid->edid_serial, sizeof(edid->edid_serial), "%08x",
550278798Shselasky	    EDID_SERIAL_NUMBER(data));
551278798Shselasky
552278798Shselasky	edid->edid_week = EDID_WEEK(data);
553278798Shselasky	edid->edid_year = EDID_YEAR(data);
554278798Shselasky
555278798Shselasky	/* get edid revision */
556278798Shselasky	edid->edid_version = EDID_VERSION(data);
557278798Shselasky	edid->edid_revision = EDID_REVISION(data);
558278798Shselasky
559278798Shselasky	edid->edid_video_input = EDID_VIDEO_INPUT(data);
560278798Shselasky	edid->edid_max_hsize = EDID_MAX_HSIZE(data);
561278798Shselasky	edid->edid_max_vsize = EDID_MAX_VSIZE(data);
562278798Shselasky
563278798Shselasky	edid->edid_gamma = EDID_GAMMA(data);
564278798Shselasky	edid->edid_features = EDID_FEATURES(data);
565278798Shselasky
566278798Shselasky	edid->edid_chroma.ec_redx = EDID_CHROMA_REDX(data);
567278798Shselasky	edid->edid_chroma.ec_redy = EDID_CHROMA_REDX(data);
568278798Shselasky	edid->edid_chroma.ec_greenx = EDID_CHROMA_GREENX(data);
569278798Shselasky	edid->edid_chroma.ec_greeny = EDID_CHROMA_GREENY(data);
570278798Shselasky	edid->edid_chroma.ec_bluex = EDID_CHROMA_BLUEX(data);
571278798Shselasky	edid->edid_chroma.ec_bluey = EDID_CHROMA_BLUEY(data);
572278798Shselasky	edid->edid_chroma.ec_whitex = EDID_CHROMA_WHITEX(data);
573278798Shselasky	edid->edid_chroma.ec_whitey = EDID_CHROMA_WHITEY(data);
574278798Shselasky
575278798Shselasky	edid->edid_ext_block_count = EDID_EXT_BLOCK_COUNT(data);
576278798Shselasky
577278798Shselasky	/* lookup established modes */
578278798Shselasky	edid->edid_nmodes = 0;
579278798Shselasky	edid->edid_preferred_mode = NULL;
580278798Shselasky	estmodes = EDID_EST_TIMING(data);
581278798Shselasky	/* Iterate in esztablished timing order */
582278798Shselasky	for (i = 15; i >= 0; i--) {
583278798Shselasky		if (estmodes & (1 << i)) {
584278798Shselasky			vmp = edid_mode_lookup_list(_edid_modes[i]);
585278798Shselasky			if (vmp != NULL) {
586278798Shselasky				edid->edid_modes[edid->edid_nmodes] = *vmp;
587278798Shselasky				edid->edid_nmodes++;
588278798Shselasky			}
589278798Shselasky#ifdef DIAGNOSTIC
590278798Shselasky			  else
591278798Shselasky				printf("no data for est. mode %s\n",
592278798Shselasky				    _edid_modes[i]);
593278798Shselasky#endif
594278798Shselasky		}
595278798Shselasky	}
596278798Shselasky
597278798Shselasky	/* do standard timing section */
598278798Shselasky	for (i = 0; i < EDID_STD_TIMING_COUNT; i++) {
599278798Shselasky		struct videomode	mode, *exist_mode;
600278798Shselasky		if (edid_std_timing(data + EDID_OFFSET_STD_TIMING + i * 2,
601278798Shselasky			&mode)) {
602278798Shselasky			/* Does this mode already exist? */
603278798Shselasky			exist_mode = edid_search_mode(edid, &mode);
604278798Shselasky			if (exist_mode == NULL) {
605278798Shselasky				edid->edid_modes[edid->edid_nmodes] = mode;
606278798Shselasky				edid->edid_nmodes++;
607278798Shselasky			}
608278798Shselasky		}
609278798Shselasky	}
610278798Shselasky
611278798Shselasky	/* do detailed timings and descriptors */
612278798Shselasky	for (i = 0; i < EDID_BLOCK_COUNT; i++) {
613278798Shselasky		edid_block(edid, data + EDID_OFFSET_DESC_BLOCK +
614278798Shselasky		    i * EDID_BLOCK_SIZE);
615278798Shselasky	}
616278798Shselasky
617278798Shselasky	edid_strchomp(edid->edid_vendorname);
618278798Shselasky	edid_strchomp(edid->edid_productname);
619278798Shselasky	edid_strchomp(edid->edid_serial);
620278798Shselasky	edid_strchomp(edid->edid_comment);
621278798Shselasky
622278798Shselasky	/*
623278798Shselasky	 * XXX
624278798Shselasky	 * some monitors lie about their maximum supported dot clock
625278798Shselasky	 * by claiming to support modes which need a higher dot clock
626278798Shselasky	 * than the stated maximum.
627278798Shselasky	 * For sanity's sake we bump it to the highest dot clock we find
628278798Shselasky	 * in the list of supported modes
629278798Shselasky	 */
630278798Shselasky	for (i = 0; i < edid->edid_nmodes; i++)
631278798Shselasky		if (edid->edid_modes[i].dot_clock > max_dotclock)
632278798Shselasky			max_dotclock = edid->edid_modes[i].dot_clock;
633278798Shselasky	if (bootverbose) {
634278798Shselasky		printf("edid: max_dotclock according to supported modes: %d\n",
635278798Shselasky		    max_dotclock);
636278798Shselasky	}
637278798Shselasky	mhz = (max_dotclock + 999) / 1000;
638278798Shselasky
639278798Shselasky	if (edid->edid_have_range) {
640278798Shselasky		if (mhz > edid->edid_range.er_max_clock)
641278798Shselasky			edid->edid_range.er_max_clock = mhz;
642278798Shselasky	} else
643278798Shselasky		edid->edid_range.er_max_clock = mhz;
644278798Shselasky
645278798Shselasky	return 0;
646278798Shselasky}
647278798Shselasky
648