1 | /*␊ |
2 | * edid.c␊ |
3 | * ␊ |
4 | *␊ |
5 | * Created by Evan Lojewski on 12/1/09.␊ |
6 | * Copyright 2009. All rights reserved.␊ |
7 | * ␊ |
8 | *␉Slice 2010␊ |
9 | */␊ |
10 | ␊ |
11 | ␊ |
12 | //#include "libsaio.h"␊ |
13 | #include "edid.h"␊ |
14 | #include "vbe.h"␊ |
15 | #include "graphics.h"␊ |
16 | #include "boot.h"␊ |
17 | //----------------------------------------------------------------------------------␊ |
18 | ␊ |
19 | #define FBMON_FIX_HEADER 1␊ |
20 | #define FBMON_FIX_INPUT 2␊ |
21 | #define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))␊ |
22 | ␊ |
23 | //----------------------------------------------------------------------------------␊ |
24 | /*␊ |
25 | struct broken_edid {␊ |
26 | ␉const char manufacturer[4];␊ |
27 | ␉UInt32 model;␊ |
28 | ␉UInt32 fix;␊ |
29 | };␊ |
30 | ␊ |
31 | //----------------------------------------------------------------------------------␊ |
32 | ␊ |
33 | broken_edid brokendb[] = {␊ |
34 | ␉// DEC FR-PCXAV-YZ *␊ |
35 | ␉{ "DEC", 0x073a, FBMON_FIX_HEADER,},␊ |
36 | ␉// ViewSonic PF775a *␊ |
37 | ␉{ "VSC", 0x5a44, FBMON_FIX_INPUT,␉}␊ |
38 | };␊ |
39 | //----------------------------------------------------------------------------------␊ |
40 | */␊ |
41 | const unsigned char edid_v1_header[] = { 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00␉};␊ |
42 | ␊ |
43 | //----------------------------------------------------------------------------------␊ |
44 | int edid_compare(unsigned char *edid1, unsigned char *edid2)␊ |
45 | {␊ |
46 | ␉int result = 0;␊ |
47 | ␉unsigned char *block = edid1 + ID_MANUFACTURER_NAME, manufacturer1[4], manufacturer2[4];;␊ |
48 | ␉manufacturer1[0] = ((block[0] & 0x7c) >> 2) + '@';␊ |
49 | ␉manufacturer1[1] = ((block[0] & 0x03) << 3) + ((block[1] & 0xe0) >> 5) + '@';␊ |
50 | ␉manufacturer1[2] = (block[1] & 0x1f) + '@';␊ |
51 | ␉manufacturer1[3] = 0;␊ |
52 | ␉␊ |
53 | ␉block = edid2 + ID_MANUFACTURER_NAME;␊ |
54 | ␉manufacturer2[0] = ((block[0] & 0x7c) >> 2) + '@';␊ |
55 | ␉manufacturer2[1] = ((block[0] & 0x03) << 3) + ((block[1] & 0xe0) >> 5) + '@';␊ |
56 | ␉manufacturer2[2] = (block[1] & 0x1f) + '@';␊ |
57 | ␉manufacturer2[3] = 0;␊ |
58 | ␉int x;␊ |
59 | ␉for(x = 0; x < 4; x++)␊ |
60 | ␉{␊ |
61 | ␉␉if(manufacturer1[x] == manufacturer2[x])␊ |
62 | ␉␉␉result++;␊ |
63 | ␉}␊ |
64 | ␉␊ |
65 | ␉return result;␊ |
66 | }␊ |
67 | ␊ |
68 | int check_edid(unsigned char *edid)␊ |
69 | {␊ |
70 | ␉unsigned char *block = edid + ID_MANUFACTURER_NAME, manufacturer[4];␊ |
71 | ␉//unsigned char *b;␊ |
72 | ␉UInt32 model;␊ |
73 | ␉//int i, fix = 0, ret = 0;␊ |
74 | ␉␊ |
75 | ␉manufacturer[0] = ((block[0] & 0x7c) >> 2) + '@';␊ |
76 | ␉manufacturer[1] = ((block[0] & 0x03) << 3) +␊ |
77 | ␉((block[1] & 0xe0) >> 5) + '@';␊ |
78 | ␉manufacturer[2] = (block[1] & 0x1f) + '@';␊ |
79 | ␉manufacturer[3] = 0;␊ |
80 | ␉model = block[2] + (block[3] << 8);␊ |
81 | /*␉␊ |
82 | ␉for (i = 0; i < (int)ARRAY_SIZE(brokendb); i++) {␊ |
83 | ␉␉if (!strncmp((const char *)manufacturer, brokendb[i].manufacturer, 4) &&␊ |
84 | ␉␉␉brokendb[i].model == model) {␊ |
85 | ␉␉␉DEBG("ATIFB: The EDID Block of "␊ |
86 | ␉␉␉␉ "Manufacturer: %s Model: 0x%08lx is known to "␊ |
87 | ␉␉␉␉ "be broken,\n", manufacturer, model);␊ |
88 | ␉␉␉fix = brokendb[i].fix;␊ |
89 | ␉␉␉break;␊ |
90 | ␉␉}␊ |
91 | ␉}␊ |
92 | ␉␊ |
93 | ␉switch (fix) {␊ |
94 | ␉␉case FBMON_FIX_HEADER:␊ |
95 | ␉␉␉for (i = 0; i < 8; i++) {␊ |
96 | ␉␉␉␉if (edid[i] != edid_v1_header[i])␊ |
97 | ␉␉␉␉␉ret = fix;␊ |
98 | ␉␉␉}␊ |
99 | ␉␉␉break;␊ |
100 | ␉␉case FBMON_FIX_INPUT:␊ |
101 | ␉␉␉b = edid + EDID_STRUCT_DISPLAY;␊ |
102 | ␉␉␉/// Only if display is GTF capable will␊ |
103 | ␉␉␉ //the input type be reset to analog *␊ |
104 | ␉␉␉if (b[4] & 0x01 && b[0] & 0x80)␊ |
105 | ␉␉␉␉ret = fix;␊ |
106 | ␉␉␉break;␊ |
107 | ␉}␊ |
108 | */␉␊ |
109 | ␉return 0; //ret;␊ |
110 | }␊ |
111 | ␊ |
112 | //----------------------------------------------------------------------------------␊ |
113 | ␊ |
114 | static void fix_edid(unsigned char *edid, int fix)␊ |
115 | {␊ |
116 | ␉unsigned char *b;␊ |
117 | ␉␊ |
118 | ␉switch (fix) {␊ |
119 | ␉␉case FBMON_FIX_HEADER:␊ |
120 | ␉␉␉msglog("EDID: trying a header reconstruct\n");␊ |
121 | ␉␉␉memcpy(edid, edid_v1_header, 8);␊ |
122 | ␉␉␉break;␊ |
123 | ␉␉case FBMON_FIX_INPUT:␊ |
124 | ␉␉␉msglog("EDID: trying to fix input type\n");␊ |
125 | ␉␉␉b = edid + EDID_STRUCT_DISPLAY;␊ |
126 | ␉␉␉b[0] &= ~0x80;␊ |
127 | ␉␉␉edid[127] += 0x80;␊ |
128 | ␉}␊ |
129 | }␊ |
130 | ␊ |
131 | //----------------------------------------------------------------------------------␊ |
132 | ␊ |
133 | int edid_checksum(unsigned char *edid)␊ |
134 | {␊ |
135 | ␉unsigned char i, csum = 0, all_null = 0;␊ |
136 | ␉int err = 0, fix = check_edid(edid);␊ |
137 | ␉␊ |
138 | ␉if (fix)␊ |
139 | ␉␉fix_edid(edid, fix);␊ |
140 | ␉␊ |
141 | ␉for (i = 0; i < EDID_LENGTH; i++) {␊ |
142 | ␉␉csum += edid[i];␊ |
143 | ␉␉all_null |= edid[i];␊ |
144 | ␉}␊ |
145 | ␉␊ |
146 | ␉if (csum == 0x00 && all_null) {␊ |
147 | ␉␉/* checksum passed, everything's good */␊ |
148 | ␉␉err = 1;␊ |
149 | ␉}␊ |
150 | ␉␊ |
151 | ␉return err;␊ |
152 | }␊ |
153 | ␊ |
154 | //----------------------------------------------------------------------------------␊ |
155 | ␊ |
156 | static int edid_check_header(unsigned char *edid)␊ |
157 | {␊ |
158 | ␉int i, err = 1, fix = check_edid(edid);␊ |
159 | ␉␊ |
160 | ␉if (fix)␊ |
161 | ␉␉fix_edid(edid, fix);␊ |
162 | ␉␊ |
163 | ␉for (i = 0; i < 8; i++) {␊ |
164 | ␉␉if (edid[i] != edid_v1_header[i])␊ |
165 | ␉␉␉err = 0;␊ |
166 | ␉}␊ |
167 | ␉␊ |
168 | ␉return err;␊ |
169 | }␊ |
170 | //------------------------------------------------------------------------␊ |
171 | bool verifyEDID(unsigned char *edid)␊ |
172 | {␊ |
173 | ␉if (edid == NULL || !edid_checksum(edid) ||␉!edid_check_header(edid)) ␊ |
174 | ␉{␊ |
175 | ␉␉return false;␊ |
176 | ␉}␊ |
177 | ␉return true;␊ |
178 | }␊ |
179 | ␊ |
180 | int edid_is_timing_block(unsigned char *block)␊ |
181 | {␊ |
182 | ␉if ((block[0] != 0x00) || (block[1] != 0x00) ||␊ |
183 | ␉␉(block[2] != 0x00) || (block[4] != 0x00))␊ |
184 | ␉␉return 1;␊ |
185 | ␉else␊ |
186 | ␉␉return 0;␊ |
187 | }␊ |
188 | //----------------------------------------------------------------------------------␊ |
189 | ␊ |
190 | int fb_parse_edid(struct EDID *edid, UInt32* x, UInt32* y)␊ |
191 | {␊ |
192 | ␉int i;␊ |
193 | ␉unsigned char *block;␊ |
194 | ␉␊ |
195 | ␉if(!verifyEDID((unsigned char *)edid)) return 1;␊ |
196 | ␉␊ |
197 | ␉block = (unsigned char *)edid + DETAILED_TIMING_DESCRIPTIONS_START; //54␊ |
198 | ␉␊ |
199 | ␉for (i = 0; i < 4; i++, block += DETAILED_TIMING_DESCRIPTION_SIZE) {␊ |
200 | ␉␉if (edid_is_timing_block(block)) {␊ |
201 | ␉␉␉*x = H_ACTIVE;␊ |
202 | ␉␉␉*y = V_ACTIVE;␊ |
203 | ␉␉␉/*␊ |
204 | ␉␉␉var->xres = var->xres_virtual = H_ACTIVE;␊ |
205 | ␉␉␉var->yres = var->yres_virtual = V_ACTIVE;␊ |
206 | ␉␉␉var->height = var->width = -1;␊ |
207 | ␉␉␉var->right_margin = H_SYNC_OFFSET;␊ |
208 | ␉␉␉var->left_margin = (H_ACTIVE + H_BLANKING) -␊ |
209 | ␉␉␉(H_ACTIVE + H_SYNC_OFFSET + H_SYNC_WIDTH);␊ |
210 | ␉␉␉var->upper_margin = V_BLANKING - V_SYNC_OFFSET -␊ |
211 | ␉␉␉V_SYNC_WIDTH;␊ |
212 | ␉␉␉var->lower_margin = V_SYNC_OFFSET;␊ |
213 | ␉␉␉var->hsync_len = H_SYNC_WIDTH;␊ |
214 | ␉␉␉var->vsync_len = V_SYNC_WIDTH;␊ |
215 | ␉␉␉var->pixclock = PIXEL_CLOCK;␊ |
216 | ␉␉␉var->pixclock /= 1000;␊ |
217 | ␉␉␉var->pixclock = KHZ2PICOS(var->pixclock);␊ |
218 | ␉␉␉␊ |
219 | ␉␉␉if (HSYNC_POSITIVE)␊ |
220 | ␉␉␉␉var->sync |= FB_SYNC_HOR_HIGH_ACT;␊ |
221 | ␉␉␉if (VSYNC_POSITIVE)␊ |
222 | ␉␉␉␉var->sync |= FB_SYNC_VERT_HIGH_ACT;␊ |
223 | ␉␉␉ */␊ |
224 | ␉␉␉return 0;␊ |
225 | ␉␉}␊ |
226 | ␉}␊ |
227 | ␉return 1;␊ |
228 | }␊ |
229 | ␊ |
230 | void getResolution(UInt32* x, UInt32* y, UInt32* bp)␊ |
231 | {␊ |
232 | ␉int val;␊ |
233 | ␉static UInt32 xResolution, yResolution, bpResolution;␊ |
234 | ␊ |
235 | ␉if(getIntForKey(kScreenWidth, &val, &bootInfo->bootConfig))␊ |
236 | ␉{␊ |
237 | ␉␉xResolution = val;␊ |
238 | ␉}␊ |
239 | ␉␊ |
240 | ␉if(getIntForKey(kScreenHeight, &val, &bootInfo->bootConfig))␊ |
241 | ␉{␊ |
242 | ␉␉yResolution = val;␊ |
243 | ␉}␊ |
244 | ␊ |
245 | ␉bpResolution = 32;␉// assume 32bits␊ |
246 | ␊ |
247 | ␉␊ |
248 | ␉if(!xResolution || !yResolution || !bpResolution)␊ |
249 | ␉{␊ |
250 | ␉␉␊ |
251 | ␉␉char* edidInfo = readEDID();␊ |
252 | ␉␉␊ |
253 | ␉␉if(!edidInfo) return;␊ |
254 | ␉␉␊ |
255 | ␉␉// TODO: check *all* resolutions reported and either use the highest, or the native resolution (if there is a flag for that)␊ |
256 | ␉␉//xResolution = edidInfo[56] | ((edidInfo[58] & 0xF0) << 4); ␊ |
257 | ␉␉//yResolution = edidInfo[59] | ((edidInfo[61] & 0xF0) << 4); ␊ |
258 | ␉␉if(fb_parse_edid(edidInfo, &xResolution, &yResolution))␊ |
259 | ␉␉{␊ |
260 | ␉␉␉xResolution = DEFAULT_SCREEN_WIDTH;␊ |
261 | ␉␉␉yResolution = DEFAULT_SCREEN_HEIGHT;␊ |
262 | ␉␉}␊ |
263 | ␉␉/*␊ |
264 | ␉␉ 0x00 0xFF 0xFF 0xFF 0xFF 0xFF 0xFF 0x00 0x32 0x0C␊ |
265 | ␉␉ 0x00 0xDF 0x00 0x00 0x00 0x00 0xFF 0xFF 0xFF 0x00␊ |
266 | ␉␉ 0x0C 0xDF 0x00 0x00 0x12 0x03 0x21 0x78 0xE9 0x99 ␊ |
267 | ␉␉ 0x53 0x28 0xFF 0xFF 0x32 0xDF 0x00 0x12 0x80 0x78 ␊ |
268 | ␉␉ 0xD5 0x53 0x26 0x00 0x01 0x01 0x01 0x01 0xFF 0x00 ␊ |
269 | ␉␉ 0xDF 0x00 0x03 0x78 0x99 0x28 0x00 0x01 0x01 0x01 ␊ |
270 | ␉␉ 0x01 0x21 0x84 0x20 0xFF 0x0C 0x00 0x03 0x0A 0x53 ␊ |
271 | ␉␉ 0x54 0x01 0x01 0x01 0xDE 0x84 0x56 0x00 0xA0 0x30␊ |
272 | ␉␉ 0xFF 0xDF 0x12 0x78 0x53 0x00 0x01 0x01 0x01 0x84 ␊ |
273 | ␉␉ 0x00 0x18 0x84 0x00 0x00 0x57 0xFF 0x00 0x80 0x99␊ |
274 | ␉␉ 0x54 0x01 0x01 0x21 0x20 0x00 0x50 0x00 0x00 0x35␊ |
275 | ␉␉ 0x57 0xFE 0x00 0x00 0x78 0x28 0x01 0x01 0x21 0x20␊ |
276 | ␉␉ 0x18 0x30 0x00 0x57 0x34 0xFE 0xAA 0x9A ␊ |
277 | ␊ |
278 | ␉␉ */␊ |
279 | ␉␉␊ |
280 | ␉␉//msglog("H Active = %d ", edidInfo[56] | ((edidInfo[58] & 0xF0) << 4) );␊ |
281 | ␉␉//msglog("V Active = %d \n", edidInfo[59] | ((edidInfo[61] & 0xF0) << 4) );␊ |
282 | ␉␉␊ |
283 | ␉␉free( edidInfo );␊ |
284 | ␉␉␊ |
285 | ␉␉//if(!xResolution) xResolution = DEFAULT_SCREEN_WIDTH;␊ |
286 | ␉␉//if(!yResolution) yResolution = DEFAULT_SCREEN_HEIGHT;␊ |
287 | ␊ |
288 | ␉}␊ |
289 | ␊ |
290 | ␉*x = xResolution;␊ |
291 | ␉*y = yResolution;␊ |
292 | ␉*bp = bpResolution;␊ |
293 | ␊ |
294 | }␊ |
295 | ␊ |
296 | char* readEDID()␊ |
297 | {␊ |
298 | ␉SInt16 last_reported = -1;␊ |
299 | ␉UInt8 edidInfo[EDID_BLOCK_SIZE];␊ |
300 | ␊ |
301 | ␉UInt8 header1[] = {0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00};␊ |
302 | ␉UInt8 header2[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};␊ |
303 | ␉␊ |
304 | ␉SInt16 status;␊ |
305 | ␉UInt16 blocks_left = 1;␊ |
306 | ␉msglog("readEDID\n");␊ |
307 | ␉do␊ |
308 | ␉{␊ |
309 | ␉␉// TODO: This currently only retrieves the *last* block, make the block buffer expand as needed / calculated from the first block␊ |
310 | ␊ |
311 | ␉␉bzero( edidInfo, EDID_BLOCK_SIZE);␊ |
312 | ␊ |
313 | ␉␉status = getEDID(edidInfo, blocks_left);␊ |
314 | ␉␉␊ |
315 | ␉␉␊ |
316 | ␉␉msglog("Buffer location: 0x%X status: %d\n", SEG(edidInfo) << 16 | OFF(edidInfo), status);␊ |
317 | ␉␉␊ |
318 | ␉␉int j, i;␊ |
319 | ␉␉for (j = 0; j < 8; j++) {␊ |
320 | ␉␉␉for(i = 0; i < 16; i++) msglog("0x%02X ", edidInfo[((i+1) * (j + 1)) - 1]);␊ |
321 | ␉␉␉msglog("\n");␊ |
322 | ␉␉}␊ |
323 | ␉␉␊ |
324 | ␉␉␊ |
325 | ␉␉␊ |
326 | ␉␉if(status == 0)␊ |
327 | ␉␉{␊ |
328 | ␉␉␉//if( edidInfo[0] == 0x00 || edidInfo[0] == 0xFF)␊ |
329 | ␉␉␉if((memcmp(edidInfo, header1, sizeof(header1)) != 0) ||␊ |
330 | ␉␉␉ (memcmp(edidInfo, header2, sizeof(header2)) != 0) )␊ |
331 | ␉␉␉{␊ |
332 | ␉␉␉␉blocks_left--;␊ |
333 | ␉␉␉␉int reported = edidInfo[ EDID_V1_BLOCKS_TO_GO_OFFSET ];␊ |
334 | ␉␉␉␉␊ |
335 | ␉␉␉␉if ( reported > blocks_left )␊ |
336 | ␉␉␉␉{␊ |
337 | ␉␉␉␉␉␊ |
338 | ␉␉␉␉␉msglog("EDID claims %d more blocks left\n", reported);␊ |
339 | ␉␉␉␉}␊ |
340 | ␉␉␉␉␊ |
341 | ␉␉␉␉if ( (last_reported <= reported && last_reported != -1)␊ |
342 | ␉␉␉␉␉|| reported == 0xff␊ |
343 | ␉␉␉␉␉/* 0xff frequently comes up in corrupt edids */␊ |
344 | ␉␉␉␉␉//|| reported == MAGIC␊ |
345 | ␉␉␉␉␉)␊ |
346 | ␉␉␉␉{␊ |
347 | ␉␉␉␉␉msglog("Last reported %d\n", last_reported);␊ |
348 | ␉␉␉␉␉msglog( "EDID blocks left is wrong.\n"␊ |
349 | ␉␉␉␉␉␉ "Your EDID is probably invalid.\n");␊ |
350 | ␉␉␉␉␉return 0;␊ |
351 | ␉␉␉␉}␊ |
352 | ␉␉␉␉else␊ |
353 | ␉␉␉␉{␊ |
354 | ␉␉␉␉␉//printf("Reading EDID block\n");␊ |
355 | ␉␉␉␉␉//printf("H Active = %d", ebiosInfo[56] | ((ebiosInfo[58] & 0xF0) << 4) );␊ |
356 | ␉␉␉␉␉//printf("V Active = %d", ebiosInfo[59] | ((ebiosInfo[61] & 0xF0) << 4) );␊ |
357 | ␊ |
358 | ␉␉␉␉␉last_reported = reported;␊ |
359 | ␉␉␉␉␉blocks_left = reported;␊ |
360 | ␉␉␉␉}␊ |
361 | ␉␉␉} ␊ |
362 | ␉␉␉else␊ |
363 | ␉␉␉{␊ |
364 | ␉␉␉␉msglog("Invalid block %d\n", blocks_left);␊ |
365 | ␉␉␉␉msglog("Header1 = %d", memcmp(edidInfo, header1, sizeof(header1)) );␊ |
366 | ␉␉␉␉msglog("Header2 = %d", memcmp(edidInfo, header2, sizeof(header2)) );␊ |
367 | ␉␉␉␉return 0;␊ |
368 | ␉␉␉}␊ |
369 | ␉␉}␊ |
370 | ␉␉blocks_left = 0;␉␊ |
371 | ␉} while(blocks_left);␊ |
372 | ␊ |
373 | ␉char* ret = malloc(sizeof(edidInfo));␊ |
374 | ␉memcpy(ret, edidInfo, sizeof(edidInfo));␊ |
375 | ␉return ret;␊ |
376 | }␊ |
377 | |