Commit | Line | Data |
---|---|---|
a09e091a JB |
1 | /* xf86DDC.c |
2 | * | |
3 | * Copyright 1998,1999 by Egbert Eich <Egbert.Eich@Physik.TU-Darmstadt.DE> | |
4 | */ | |
5 | ||
6 | /* | |
7 | * A note on terminology. DDC1 is the original dumb serial protocol, and | |
8 | * can only do up to 128 bytes of EDID. DDC2 is I2C-encapsulated and | |
9 | * introduces extension blocks. EDID is the old display identification | |
10 | * block, DisplayID is the new one. | |
11 | */ | |
12 | ||
13 | #ifdef HAVE_XORG_CONFIG_H | |
14 | #include <xorg-config.h> | |
15 | #endif | |
16 | ||
17 | #include "misc.h" | |
18 | #include "xf86.h" | |
19 | #include "xf86_OSproc.h" | |
20 | #include "xf86DDC.h" | |
21 | #include <string.h> | |
22 | ||
23 | #define RETRIES 4 | |
24 | ||
25 | typedef enum { | |
26 | DDCOPT_NODDC1, | |
27 | DDCOPT_NODDC2, | |
28 | DDCOPT_NODDC | |
29 | } DDCOpts; | |
30 | ||
31 | static const OptionInfoRec DDCOptions[] = { | |
32 | {DDCOPT_NODDC1, "NoDDC1", OPTV_BOOLEAN, {0}, FALSE}, | |
33 | {DDCOPT_NODDC2, "NoDDC2", OPTV_BOOLEAN, {0}, FALSE}, | |
34 | {DDCOPT_NODDC, "NoDDC", OPTV_BOOLEAN, {0}, FALSE}, | |
35 | {-1, NULL, OPTV_NONE, {0}, FALSE}, | |
36 | }; | |
37 | ||
38 | /* DDC1 */ | |
39 | ||
40 | static int | |
41 | find_start(unsigned int *ptr) | |
42 | { | |
43 | unsigned int comp[9], test[9]; | |
44 | int i, j; | |
45 | ||
46 | for (i = 0; i < 9; i++) { | |
47 | comp[i] = *(ptr++); | |
48 | test[i] = 1; | |
49 | } | |
50 | for (i = 0; i < 127; i++) { | |
51 | for (j = 0; j < 9; j++) { | |
52 | test[j] = test[j] & !(comp[j] ^ *(ptr++)); | |
53 | } | |
54 | } | |
55 | for (i = 0; i < 9; i++) | |
56 | if (test[i]) | |
57 | return i + 1; | |
58 | return -1; | |
59 | } | |
60 | ||
61 | static unsigned char * | |
62 | find_header(unsigned char *block) | |
63 | { | |
64 | unsigned char *ptr, *head_ptr, *end; | |
65 | unsigned char header[] = { 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00 }; | |
66 | ||
67 | ptr = block; | |
68 | end = block + EDID1_LEN; | |
69 | while (ptr < end) { | |
70 | int i; | |
71 | ||
72 | head_ptr = ptr; | |
73 | for (i = 0; i < 8; i++) { | |
74 | if (header[i] != *(head_ptr++)) | |
75 | break; | |
76 | if (head_ptr == end) | |
77 | head_ptr = block; | |
78 | } | |
79 | if (i == 8) | |
80 | break; | |
81 | ptr++; | |
82 | } | |
83 | if (ptr == end) | |
84 | return NULL; | |
85 | return ptr; | |
86 | } | |
87 | ||
88 | static unsigned char * | |
89 | resort(unsigned char *s_block) | |
90 | { | |
91 | unsigned char *d_new, *d_ptr, *d_end, *s_ptr, *s_end; | |
92 | unsigned char tmp; | |
93 | ||
94 | s_ptr = find_header(s_block); | |
95 | if (!s_ptr) | |
96 | return NULL; | |
97 | s_end = s_block + EDID1_LEN; | |
98 | ||
99 | d_new = malloc(EDID1_LEN); | |
100 | if (!d_new) | |
101 | return NULL; | |
102 | d_end = d_new + EDID1_LEN; | |
103 | ||
104 | for (d_ptr = d_new; d_ptr < d_end; d_ptr++) { | |
105 | tmp = *(s_ptr++); | |
106 | *d_ptr = tmp; | |
107 | if (s_ptr == s_end) | |
108 | s_ptr = s_block; | |
109 | } | |
110 | free(s_block); | |
111 | return d_new; | |
112 | } | |
113 | ||
114 | static int | |
115 | DDC_checksum(const unsigned char *block, int len) | |
116 | { | |
117 | int i, result = 0; | |
118 | int not_null = 0; | |
119 | ||
120 | for (i = 0; i < len; i++) { | |
121 | not_null |= block[i]; | |
122 | result += block[i]; | |
123 | } | |
124 | ||
125 | #ifdef DEBUG | |
126 | if (result & 0xFF) | |
127 | ErrorF("DDC checksum not correct\n"); | |
128 | if (!not_null) | |
129 | ErrorF("DDC read all Null\n"); | |
130 | #endif | |
131 | ||
132 | /* catch the trivial case where all bytes are 0 */ | |
133 | if (!not_null) | |
134 | return 1; | |
135 | ||
136 | return result & 0xFF; | |
137 | } | |
138 | ||
139 | static unsigned char * | |
140 | GetEDID_DDC1(unsigned int *s_ptr) | |
141 | { | |
142 | unsigned char *d_block, *d_pos; | |
143 | unsigned int *s_pos, *s_end; | |
144 | int s_start; | |
145 | int i, j; | |
146 | ||
147 | s_start = find_start(s_ptr); | |
148 | if (s_start == -1) | |
149 | return NULL; | |
150 | s_end = s_ptr + NUM; | |
151 | s_pos = s_ptr + s_start; | |
152 | d_block = malloc(EDID1_LEN); | |
153 | if (!d_block) | |
154 | return NULL; | |
155 | d_pos = d_block; | |
156 | for (i = 0; i < EDID1_LEN; i++) { | |
157 | for (j = 0; j < 8; j++) { | |
158 | *d_pos <<= 1; | |
159 | if (*s_pos) { | |
160 | *d_pos |= 0x01; | |
161 | } | |
162 | s_pos++; | |
163 | if (s_pos == s_end) | |
164 | s_pos = s_ptr; | |
165 | }; | |
166 | s_pos++; | |
167 | if (s_pos == s_end) | |
168 | s_pos = s_ptr; | |
169 | d_pos++; | |
170 | } | |
171 | free(s_ptr); | |
172 | if (d_block && DDC_checksum(d_block, EDID1_LEN)) { | |
173 | free(d_block); | |
174 | return NULL; | |
175 | } | |
176 | return (resort(d_block)); | |
177 | } | |
178 | ||
179 | /* fetch entire EDID record; DDC bit needs to be masked */ | |
180 | static unsigned int * | |
181 | FetchEDID_DDC1(register ScrnInfoPtr pScrn, | |
182 | register unsigned int (*read_DDC) (ScrnInfoPtr)) | |
183 | { | |
184 | int count = NUM; | |
185 | unsigned int *ptr, *xp; | |
186 | ||
187 | ptr = xp = malloc(sizeof(int) * NUM); | |
188 | ||
189 | if (!ptr) | |
190 | return NULL; | |
191 | do { | |
192 | /* wait for next retrace */ | |
193 | *xp = read_DDC(pScrn); | |
194 | xp++; | |
195 | } while (--count); | |
196 | return ptr; | |
197 | } | |
198 | ||
199 | /* test if DDC1 return 0 if not */ | |
200 | static Bool | |
201 | TestDDC1(ScrnInfoPtr pScrn, unsigned int (*read_DDC) (ScrnInfoPtr)) | |
202 | { | |
203 | int old, count; | |
204 | ||
205 | old = read_DDC(pScrn); | |
206 | count = HEADER * BITS_PER_BYTE; | |
207 | do { | |
208 | /* wait for next retrace */ | |
209 | if (old != read_DDC(pScrn)) | |
210 | break; | |
211 | } while (count--); | |
212 | return count; | |
213 | } | |
214 | ||
215 | /* | |
216 | * read EDID record , pass it to callback function to interpret. | |
217 | * callback function will store it for further use by calling | |
218 | * function; it will also decide if we need to reread it | |
219 | */ | |
220 | static unsigned char * | |
221 | EDIDRead_DDC1(ScrnInfoPtr pScrn, DDC1SetSpeedProc DDCSpeed, | |
222 | unsigned int (*read_DDC) (ScrnInfoPtr)) | |
223 | { | |
224 | unsigned char *EDID_block = NULL; | |
225 | int count = RETRIES; | |
226 | ||
227 | if (!read_DDC) { | |
228 | xf86DrvMsg(pScrn->scrnIndex, X_PROBED, | |
229 | "chipset doesn't support DDC1\n"); | |
230 | return NULL; | |
231 | }; | |
232 | ||
233 | if (TestDDC1(pScrn, read_DDC) == -1) { | |
234 | xf86DrvMsg(pScrn->scrnIndex, X_PROBED, "No DDC signal\n"); | |
235 | return NULL; | |
236 | }; | |
237 | ||
238 | if (DDCSpeed) | |
239 | DDCSpeed(pScrn, DDC_FAST); | |
240 | do { | |
241 | EDID_block = GetEDID_DDC1(FetchEDID_DDC1(pScrn, read_DDC)); | |
242 | count--; | |
243 | } while (!EDID_block && count); | |
244 | if (DDCSpeed) | |
245 | DDCSpeed(pScrn, DDC_SLOW); | |
246 | ||
247 | return EDID_block; | |
248 | } | |
249 | ||
250 | /** | |
251 | * Attempts to probe the monitor for EDID information, if NoDDC and NoDDC1 are | |
252 | * unset. EDID information blocks are interpreted and the results returned in | |
253 | * an xf86MonPtr. | |
254 | * | |
255 | * This function does not affect the list of modes used by drivers -- it is up | |
256 | * to the driver to decide policy on what to do with EDID information. | |
257 | * | |
258 | * @return pointer to a new xf86MonPtr containing the EDID information. | |
259 | * @return NULL if no monitor attached or failure to interpret the EDID. | |
260 | */ | |
261 | xf86MonPtr | |
262 | xf86DoEDID_DDC1(ScrnInfoPtr pScrn, DDC1SetSpeedProc DDC1SetSpeed, | |
263 | unsigned int (*DDC1Read) (ScrnInfoPtr)) | |
264 | { | |
265 | unsigned char *EDID_block = NULL; | |
266 | xf86MonPtr tmp = NULL; | |
267 | ||
268 | /* Default DDC and DDC1 to enabled. */ | |
269 | Bool noddc = FALSE, noddc1 = FALSE; | |
270 | OptionInfoPtr options; | |
271 | ||
272 | options = xnfalloc(sizeof(DDCOptions)); | |
273 | (void) memcpy(options, DDCOptions, sizeof(DDCOptions)); | |
274 | xf86ProcessOptions(pScrn->scrnIndex, pScrn->options, options); | |
275 | ||
276 | xf86GetOptValBool(options, DDCOPT_NODDC, &noddc); | |
277 | xf86GetOptValBool(options, DDCOPT_NODDC1, &noddc1); | |
278 | free(options); | |
279 | ||
280 | if (noddc || noddc1) | |
281 | return NULL; | |
282 | ||
283 | OsBlockSignals(); | |
284 | EDID_block = EDIDRead_DDC1(pScrn, DDC1SetSpeed, DDC1Read); | |
285 | OsReleaseSignals(); | |
286 | ||
287 | if (EDID_block) { | |
288 | tmp = xf86InterpretEDID(pScrn->scrnIndex, EDID_block); | |
289 | } | |
290 | #ifdef DEBUG | |
291 | else | |
292 | ErrorF("No EDID block returned\n"); | |
293 | if (!tmp) | |
294 | ErrorF("Cannot interpret EDID block\n"); | |
295 | #endif | |
296 | return tmp; | |
297 | } | |
298 | ||
299 | /* DDC2 */ | |
300 | ||
301 | static I2CDevPtr | |
302 | DDC2MakeDevice(I2CBusPtr pBus, int address, char *name) | |
303 | { | |
304 | I2CDevPtr dev = NULL; | |
305 | ||
306 | if (!(dev = xf86I2CFindDev(pBus, address))) { | |
307 | dev = xf86CreateI2CDevRec(); | |
308 | dev->DevName = name; | |
309 | dev->SlaveAddr = address; | |
310 | dev->ByteTimeout = 2200; /* VESA DDC spec 3 p. 43 (+10 %) */ | |
311 | dev->StartTimeout = 550; | |
312 | dev->BitTimeout = 40; | |
313 | dev->AcknTimeout = 40; | |
314 | ||
315 | dev->pI2CBus = pBus; | |
316 | if (!xf86I2CDevInit(dev)) { | |
317 | xf86DrvMsg(pBus->scrnIndex, X_PROBED, "No DDC2 device\n"); | |
318 | return NULL; | |
319 | } | |
320 | } | |
321 | ||
322 | return dev; | |
323 | } | |
324 | ||
325 | static I2CDevPtr | |
326 | DDC2Init(I2CBusPtr pBus) | |
327 | { | |
328 | I2CDevPtr dev = NULL; | |
329 | ||
330 | /* | |
331 | * Slow down the bus so that older monitors don't | |
332 | * miss things. | |
333 | */ | |
334 | pBus->RiseFallTime = 20; | |
335 | ||
336 | dev = DDC2MakeDevice(pBus, 0x00A0, "ddc2"); | |
337 | if (xf86I2CProbeAddress(pBus, 0x0060)) | |
338 | DDC2MakeDevice(pBus, 0x0060, "E-EDID segment register"); | |
339 | ||
340 | return dev; | |
341 | } | |
342 | ||
343 | /* Mmmm, smell the hacks */ | |
344 | static void | |
345 | EEDIDStop(I2CDevPtr d) | |
346 | { | |
347 | } | |
348 | ||
349 | /* block is the EDID block number. a segment is two blocks. */ | |
350 | static Bool | |
351 | DDC2Read(I2CDevPtr dev, int block, unsigned char *R_Buffer) | |
352 | { | |
353 | unsigned char W_Buffer[1]; | |
354 | int i, segment; | |
355 | I2CDevPtr seg; | |
356 | void (*stop) (I2CDevPtr); | |
357 | ||
358 | for (i = 0; i < RETRIES; i++) { | |
359 | /* Stop bits reset the segment pointer to 0, so be careful here. */ | |
360 | segment = block >> 1; | |
361 | if (segment) { | |
362 | Bool b; | |
363 | ||
364 | if (!(seg = xf86I2CFindDev(dev->pI2CBus, 0x0060))) | |
365 | return FALSE; | |
366 | ||
367 | W_Buffer[0] = segment; | |
368 | ||
369 | stop = dev->pI2CBus->I2CStop; | |
370 | dev->pI2CBus->I2CStop = EEDIDStop; | |
371 | ||
372 | b = xf86I2CWriteRead(seg, W_Buffer, 1, NULL, 0); | |
373 | ||
374 | dev->pI2CBus->I2CStop = stop; | |
375 | if (!b) { | |
376 | dev->pI2CBus->I2CStop(dev); | |
377 | continue; | |
378 | } | |
379 | } | |
380 | ||
381 | W_Buffer[0] = (block & 0x01) * EDID1_LEN; | |
382 | ||
383 | if (xf86I2CWriteRead(dev, W_Buffer, 1, R_Buffer, EDID1_LEN)) { | |
384 | if (!DDC_checksum(R_Buffer, EDID1_LEN)) | |
385 | return TRUE; | |
386 | } | |
387 | } | |
388 | ||
389 | return FALSE; | |
390 | } | |
391 | ||
392 | /** | |
393 | * Attempts to probe the monitor for EDID information, if NoDDC and NoDDC2 are | |
394 | * unset. EDID information blocks are interpreted and the results returned in | |
395 | * an xf86MonPtr. Unlike xf86DoEDID_DDC[12](), this function will return | |
396 | * the complete EDID data, including all extension blocks, if the 'complete' | |
397 | * parameter is TRUE; | |
398 | * | |
399 | * This function does not affect the list of modes used by drivers -- it is up | |
400 | * to the driver to decide policy on what to do with EDID information. | |
401 | * | |
402 | * @return pointer to a new xf86MonPtr containing the EDID information. | |
403 | * @return NULL if no monitor attached or failure to interpret the EDID. | |
404 | */ | |
405 | xf86MonPtr | |
406 | xf86DoEEDID(ScrnInfoPtr pScrn, I2CBusPtr pBus, Bool complete) | |
407 | { | |
408 | unsigned char *EDID_block = NULL; | |
409 | xf86MonPtr tmp = NULL; | |
410 | I2CDevPtr dev = NULL; | |
411 | ||
412 | /* Default DDC and DDC2 to enabled. */ | |
413 | Bool noddc = FALSE, noddc2 = FALSE; | |
414 | OptionInfoPtr options; | |
415 | ||
416 | options = malloc(sizeof(DDCOptions)); | |
417 | if (!options) | |
418 | return NULL; | |
419 | memcpy(options, DDCOptions, sizeof(DDCOptions)); | |
420 | xf86ProcessOptions(pScrn->scrnIndex, pScrn->options, options); | |
421 | ||
422 | xf86GetOptValBool(options, DDCOPT_NODDC, &noddc); | |
423 | xf86GetOptValBool(options, DDCOPT_NODDC2, &noddc2); | |
424 | free(options); | |
425 | ||
426 | if (noddc || noddc2) | |
427 | return NULL; | |
428 | ||
429 | if (!(dev = DDC2Init(pBus))) | |
430 | return NULL; | |
431 | ||
432 | EDID_block = calloc(1, EDID1_LEN); | |
433 | if (!EDID_block) | |
434 | return NULL; | |
435 | ||
436 | if (DDC2Read(dev, 0, EDID_block)) { | |
437 | int i, n = EDID_block[0x7e]; | |
438 | ||
439 | if (complete && n) { | |
440 | EDID_block = realloc(EDID_block, EDID1_LEN * (1 + n)); | |
441 | ||
442 | for (i = 0; i < n; i++) | |
443 | DDC2Read(dev, i + 1, EDID_block + (EDID1_LEN * (1 + i))); | |
444 | } | |
445 | ||
446 | tmp = xf86InterpretEEDID(pScrn->scrnIndex, EDID_block); | |
447 | } | |
448 | ||
449 | if (tmp && complete) | |
450 | tmp->flags |= MONITOR_EDID_COMPLETE_RAWDATA; | |
451 | ||
452 | return tmp; | |
453 | } | |
454 | ||
455 | /** | |
456 | * Attempts to probe the monitor for EDID information, if NoDDC and NoDDC2 are | |
457 | * unset. EDID information blocks are interpreted and the results returned in | |
458 | * an xf86MonPtr. | |
459 | * | |
460 | * This function does not affect the list of modes used by drivers -- it is up | |
461 | * to the driver to decide policy on what to do with EDID information. | |
462 | * | |
463 | * @return pointer to a new xf86MonPtr containing the EDID information. | |
464 | * @return NULL if no monitor attached or failure to interpret the EDID. | |
465 | */ | |
466 | xf86MonPtr | |
467 | xf86DoEDID_DDC2(ScrnInfoPtr pScrn, I2CBusPtr pBus) | |
468 | { | |
469 | return xf86DoEEDID(pScrn, pBus, FALSE); | |
470 | } | |
471 | ||
472 | /* XXX write me */ | |
473 | static void * | |
474 | DDC2ReadDisplayID(void) | |
475 | { | |
476 | return FALSE; | |
477 | } | |
478 | ||
479 | /** | |
480 | * Attempts to probe the monitor for DisplayID information, if NoDDC and | |
481 | * NoDDC2 are unset. DisplayID blocks are interpreted and the results | |
482 | * returned in an xf86MonPtr. | |
483 | * | |
484 | * This function does not affect the list of modes used by drivers -- it is up | |
485 | * to the driver to decide policy on what to do with DisplayID information. | |
486 | * | |
487 | * @return pointer to a new xf86MonPtr containing the DisplayID information. | |
488 | * @return NULL if no monitor attached or failure to interpret the DisplayID. | |
489 | */ | |
490 | xf86MonPtr | |
491 | xf86DoDisplayID(ScrnInfoPtr pScrn, I2CBusPtr pBus) | |
492 | { | |
493 | unsigned char *did = NULL; | |
494 | xf86MonPtr tmp = NULL; | |
495 | I2CDevPtr dev = NULL; | |
496 | ||
497 | /* Default DDC and DDC2 to enabled. */ | |
498 | Bool noddc = FALSE, noddc2 = FALSE; | |
499 | OptionInfoPtr options; | |
500 | ||
501 | options = malloc(sizeof(DDCOptions)); | |
502 | if (!options) | |
503 | return NULL; | |
504 | memcpy(options, DDCOptions, sizeof(DDCOptions)); | |
505 | xf86ProcessOptions(pScrn->scrnIndex, pScrn->options, options); | |
506 | ||
507 | xf86GetOptValBool(options, DDCOPT_NODDC, &noddc); | |
508 | xf86GetOptValBool(options, DDCOPT_NODDC2, &noddc2); | |
509 | free(options); | |
510 | ||
511 | if (noddc || noddc2) | |
512 | return NULL; | |
513 | ||
514 | if (!(dev = DDC2Init(pBus))) | |
515 | return NULL; | |
516 | ||
517 | if ((did = DDC2ReadDisplayID())) { | |
518 | tmp = calloc(1, sizeof(*tmp)); | |
519 | if (!tmp) | |
520 | return NULL; | |
521 | ||
522 | tmp->scrnIndex = pScrn->scrnIndex; | |
523 | tmp->flags |= MONITOR_DISPLAYID; | |
524 | tmp->rawData = did; | |
525 | } | |
526 | ||
527 | return tmp; | |
528 | } |