Root/
Source at commit 2740 created 8 years 11 months ago. By ifabio, sync with trunk. | |
---|---|
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, based on Joblo works␊ |
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, edid_mode* var) //(struct EDID *edid, UInt32* x, UInt32* y)␊ |
191 | {␊ |
192 | ␉int i;␊ |
193 | ␉unsigned char *block;␊ |
194 | ␉␊ |
195 | ␉if(!verifyEDID((unsigned char *)edid)) return 0;␊ |
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 | ␉␉␉var->h_active = H_ACTIVE;␊ |
202 | ␉␉␉var->v_active = V_ACTIVE;␊ |
203 | ␉␉␉var->h_sync_offset = H_SYNC_OFFSET;␊ |
204 | ␉␉␉var->h_sync_width = H_SYNC_WIDTH;␊ |
205 | ␉␉␉var->h_blanking = H_BLANKING;␊ |
206 | ␉␉␉var->v_blanking = V_BLANKING;␊ |
207 | ␉␉␉var->pixel_clock = PIXEL_CLOCK;␊ |
208 | ␉␉␉var->v_sync_offset = V_SYNC_OFFSET;␊ |
209 | ␉␉␉var->v_sync_width = V_SYNC_WIDTH;␊ |
210 | ␉␉␉/*␊ |
211 | ␉␉␉var->xres = var->xres_virtual = H_ACTIVE;␊ |
212 | ␉␉␉var->yres = var->yres_virtual = V_ACTIVE;␊ |
213 | ␉␉␉var->height = var->width = -1;␊ |
214 | ␉␉␉var->right_margin = H_SYNC_OFFSET;␊ |
215 | ␉␉␉var->left_margin = (H_ACTIVE + H_BLANKING) -␊ |
216 | ␉␉␉(H_ACTIVE + H_SYNC_OFFSET + H_SYNC_WIDTH);␊ |
217 | ␉␉␉var->upper_margin = V_BLANKING - V_SYNC_OFFSET -␊ |
218 | ␉␉␉V_SYNC_WIDTH;␊ |
219 | ␉␉␉var->lower_margin = V_SYNC_OFFSET;␊ |
220 | ␉␉␉var->hsync_len = H_SYNC_WIDTH;␊ |
221 | ␉␉␉var->vsync_len = V_SYNC_WIDTH;␊ |
222 | ␉␉␉var->pixclock = PIXEL_CLOCK;␊ |
223 | ␉␉␉var->pixclock /= 1000;␊ |
224 | ␉␉␉var->pixclock = KHZ2PICOS(var->pixclock);␊ |
225 | ␉␉␉␊ |
226 | ␉␉␉if (HSYNC_POSITIVE)␊ |
227 | ␉␉␉␉var->sync |= FB_SYNC_HOR_HIGH_ACT;␊ |
228 | ␉␉␉if (VSYNC_POSITIVE)␊ |
229 | ␉␉␉␉var->sync |= FB_SYNC_VERT_HIGH_ACT;␊ |
230 | ␉␉␉ */␊ |
231 | ␉␉␉return 1;␊ |
232 | ␉␉}␊ |
233 | ␉}␊ |
234 | ␉return 0;␊ |
235 | }␊ |
236 | ␊ |
237 | void getResolution(UInt32* x, UInt32* y, UInt32* bp)␊ |
238 | {␊ |
239 | //␉int val;␊ |
240 | ␉static UInt32 xResolution, yResolution, bpResolution;␊ |
241 | /*␊ |
242 | ␉if(getIntForKey(kScreenWidth, &val, &bootInfo->chameleonConfig))␊ |
243 | ␉{␊ |
244 | ␉␉xResolution = val;␊ |
245 | ␉}␊ |
246 | ␉␊ |
247 | ␉if(getIntForKey(kScreenHeight, &val, &bootInfo->chameleonConfig))␊ |
248 | ␉{␊ |
249 | ␉␉yResolution = val;␊ |
250 | ␉}␊ |
251 | */␊ |
252 | ␉bpResolution = 32;␉// assume 32bits␊ |
253 | ␊ |
254 | ␉␊ |
255 | ␉if(!xResolution || !yResolution || !bpResolution)␊ |
256 | ␉{␊ |
257 | ␉␉␊ |
258 | ␉␉char* edidInfo = readEDID();␊ |
259 | ␉␉␊ |
260 | ␉␉if(!edidInfo) return;␊ |
261 | ␉␉␊ |
262 | ␉␉edid_mode mode;␊ |
263 | ␉␉// TODO: check *all* resolutions reported and either use the highest, or the native resolution (if there is a flag for that)␊ |
264 | ␉␉//xResolution = edidInfo[56] | ((edidInfo[58] & 0xF0) << 4); ␊ |
265 | ␉␉//yResolution = edidInfo[59] | ((edidInfo[61] & 0xF0) << 4); ␊ |
266 | ␉␉//Slice - done here␊ |
267 | ␉␉␊ |
268 | ␉␉if(fb_parse_edid((struct EDID *)edidInfo, &mode) == 0)␊ |
269 | ␉␉{␊ |
270 | ␉␉␉xResolution = DEFAULT_SCREEN_WIDTH;␊ |
271 | ␉␉␉yResolution = DEFAULT_SCREEN_HEIGHT;␊ |
272 | ␉␉}␊ |
273 | ␉␉else {␊ |
274 | ␉␉␉xResolution = mode.h_active;␊ |
275 | ␉␉␉yResolution = mode.v_active;␊ |
276 | ␉␉}␊ |
277 | ␊ |
278 | ␉␉/*␊ |
279 | ␉␉ 0x00 0xFF 0xFF 0xFF 0xFF 0xFF 0xFF 0x00 0x32 0x0C␊ |
280 | ␉␉ 0x00 0xDF 0x00 0x00 0x00 0x00 0xFF 0xFF 0xFF 0x00␊ |
281 | ␉␉ 0x0C 0xDF 0x00 0x00 0x12 0x03 0x21 0x78 0xE9 0x99 ␊ |
282 | ␉␉ 0x53 0x28 0xFF 0xFF 0x32 0xDF 0x00 0x12 0x80 0x78 ␊ |
283 | ␉␉ 0xD5 0x53 0x26 0x00 0x01 0x01 0x01 0x01 0xFF 0x00 ␊ |
284 | ␉␉ 0xDF 0x00 0x03 0x78 0x99 0x28 0x00 0x01 0x01 0x01 ␊ |
285 | ␉␉ 0x01 0x21 0x84 0x20 0xFF 0x0C 0x00 0x03 0x0A 0x53 ␊ |
286 | ␉␉ 0x54 0x01 0x01 0x01 0xDE 0x84 0x56 0x00 0xA0 0x30␊ |
287 | ␉␉ 0xFF 0xDF 0x12 0x78 0x53 0x00 0x01 0x01 0x01 0x84 ␊ |
288 | ␉␉ 0x00 0x18 0x84 0x00 0x00 0x57 0xFF 0x00 0x80 0x99␊ |
289 | ␉␉ 0x54 0x01 0x01 0x21 0x20 0x00 0x50 0x00 0x00 0x35␊ |
290 | ␉␉ 0x57 0xFE 0x00 0x00 0x78 0x28 0x01 0x01 0x21 0x20␊ |
291 | ␉␉ 0x18 0x30 0x00 0x57 0x34 0xFE 0xAA 0x9A ␊ |
292 | ␊ |
293 | ␉␉ */␊ |
294 | ␉␉␊ |
295 | ␉␉//msglog("H Active = %d ", edidInfo[56] | ((edidInfo[58] & 0xF0) << 4) );␊ |
296 | ␉␉//msglog("V Active = %d \n", edidInfo[59] | ((edidInfo[61] & 0xF0) << 4) );␊ |
297 | ␉␉␊ |
298 | ␉␉free( edidInfo );␊ |
299 | ␉␉␊ |
300 | ␉␉//if(!xResolution) xResolution = DEFAULT_SCREEN_WIDTH;␊ |
301 | ␉␉//if(!yResolution) yResolution = DEFAULT_SCREEN_HEIGHT;␊ |
302 | ␊ |
303 | ␉}␊ |
304 | ␊ |
305 | ␉*x = xResolution;␊ |
306 | ␉*y = yResolution;␊ |
307 | ␉*bp = bpResolution;␊ |
308 | ␊ |
309 | }␊ |
310 | ␊ |
311 | char* readEDID()␊ |
312 | {␊ |
313 | ␉SInt16 last_reported = -1;␊ |
314 | ␉UInt8 edidInfo[EDID_BLOCK_SIZE];␊ |
315 | ␊ |
316 | ␉UInt8 header1[] = {0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00};␊ |
317 | ␉UInt8 header2[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};␊ |
318 | ␉␊ |
319 | ␉SInt16 status;␊ |
320 | ␉UInt16 blocks_left = 1;␊ |
321 | //␉msglog("readEDID\n");␊ |
322 | ␉do␊ |
323 | ␉{␊ |
324 | ␉␉// TODO: This currently only retrieves the *last* block, make the block buffer expand as needed / calculated from the first block␊ |
325 | ␊ |
326 | ␉␉bzero( edidInfo, EDID_BLOCK_SIZE);␊ |
327 | ␊ |
328 | ␉␉status = getEDID(edidInfo, blocks_left);␊ |
329 | ␉␉␊ |
330 | ␉␉/*␊ |
331 | ␉␉msglog("Buffer location: 0x%X status: %d\n", SEG(edidInfo) << 16 | OFF(edidInfo), status);␊ |
332 | ␉␉␊ |
333 | ␉␉int j, i;␊ |
334 | ␉␉for (j = 0; j < 8; j++) {␊ |
335 | ␉␉␉for(i = 0; i < 16; i++) msglog(" 0x%02X", edidInfo[((i+1) * (j + 1)) - 1]);␊ |
336 | ␉␉␉msglog("\n");␊ |
337 | ␉␉}␊ |
338 | ␉␉*/␊ |
339 | ␉␉␊ |
340 | ␉␉␊ |
341 | ␉␉if(status == 0)␊ |
342 | ␉␉{␊ |
343 | ␉␉␉//if( edidInfo[0] == 0x00 || edidInfo[0] == 0xFF)␊ |
344 | ␉␉␉if((memcmp(edidInfo, header1, sizeof(header1)) != 0) ||␊ |
345 | ␉␉␉ (memcmp(edidInfo, header2, sizeof(header2)) != 0) )␊ |
346 | ␉␉␉{␊ |
347 | ␉␉␉␉blocks_left--;␊ |
348 | ␉␉␉␉int reported = edidInfo[ EDID_V1_BLOCKS_TO_GO_OFFSET ];␊ |
349 | ␉␉␉␉␊ |
350 | ␉␉␉␉if ( reported > blocks_left )␊ |
351 | ␉␉␉␉{␊ |
352 | ␉␉␉␉␉␊ |
353 | ␉␉␉␉␉msglog("EDID claims %d more blocks left\n", reported);␊ |
354 | ␉␉␉␉}␊ |
355 | ␉␉␉␉␊ |
356 | ␉␉␉␉if ( (last_reported <= reported && last_reported != -1)␊ |
357 | ␉␉␉␉␉|| reported == 0xff␊ |
358 | ␉␉␉␉␉/* 0xff frequently comes up in corrupt edids */␊ |
359 | ␉␉␉␉␉//|| reported == MAGIC␊ |
360 | ␉␉␉␉␉)␊ |
361 | ␉␉␉␉{␊ |
362 | ␉␉␉␉␉msglog("Last reported %d\n", last_reported);␊ |
363 | ␉␉␉␉␉msglog("EDID blocks left is wrong.\n"␊ |
364 | ␉␉␉␉␉␉ "Your EDID is probably invalid.\n");␊ |
365 | ␉␉␉␉␉return 0;␊ |
366 | ␉␉␉␉}␊ |
367 | ␉␉␉␉else␊ |
368 | ␉␉␉␉{␊ |
369 | ␉␉␉␉␉//printf("Reading EDID block\n");␊ |
370 | ␉␉␉␉␉//printf("H Active = %d", ebiosInfo[56] | ((ebiosInfo[58] & 0xF0) << 4) );␊ |
371 | ␉␉␉␉␉//printf("V Active = %d", ebiosInfo[59] | ((ebiosInfo[61] & 0xF0) << 4) );␊ |
372 | ␊ |
373 | ␉␉␉␉␉last_reported = reported;␊ |
374 | ␉␉␉␉␉blocks_left = reported;␊ |
375 | ␉␉␉␉}␊ |
376 | ␉␉␉} ␊ |
377 | ␉␉␉else␊ |
378 | ␉␉␉{␊ |
379 | ␉␉␉␉msglog("Invalid block %d\n", blocks_left);␊ |
380 | ␉␉␉␉msglog("Header1 = %d", memcmp(edidInfo, header1, sizeof(header1)) );␊ |
381 | ␉␉␉␉msglog("Header2 = %d", memcmp(edidInfo, header2, sizeof(header2)) );␊ |
382 | ␉␉␉␉return 0;␊ |
383 | ␉␉␉}␊ |
384 | ␉␉}␊ |
385 | ␉␉blocks_left = 0;␉␊ |
386 | ␉} while(blocks_left);␊ |
387 | ␊ |
388 | ␉char* ret = malloc(sizeof(edidInfo));␊ |
389 | ␉memcpy(ret, edidInfo, sizeof(edidInfo));␊ |
390 | ␉return ret;␊ |
391 | }␊ |
392 | ␊ |
393 | ␊ |
394 | int getEDID( void * edidBlock, UInt8 block)␊ |
395 | {␊ |
396 | ␉biosBuf_t bb;␊ |
397 | ␉␊ |
398 | ␉bzero(&bb, sizeof(bb));␊ |
399 | bb.intno = 0x10;␊ |
400 | bb.eax.rr = 0x4F15;␊ |
401 | ␉bb.ebx.r.l= 0x01;␊ |
402 | ␉bb.edx.rr = block;␊ |
403 | ␉␊ |
404 | bb.es = SEG( edidBlock );␊ |
405 | bb.edi.rr = OFF( edidBlock );␊ |
406 | ␉␊ |
407 | bios( &bb );␊ |
408 | return(bb.eax.r.h);␊ |
409 | }␊ |
410 |