xref: /linux/drivers/video/fbdev/aty/radeon_monitor.c (revision 3932b9ca55b0be314a36d3e84faff3e823c081f5)
1 #include "radeonfb.h"
2 
3 #include <linux/slab.h>
4 
5 #include "../edid.h"
6 
7 static struct fb_var_screeninfo radeonfb_default_var = {
8 	.xres		= 640,
9 	.yres		= 480,
10 	.xres_virtual	= 640,
11 	.yres_virtual	= 480,
12 	.bits_per_pixel = 8,
13 	.red		= { .length = 8 },
14 	.green		= { .length = 8 },
15 	.blue		= { .length = 8 },
16 	.activate	= FB_ACTIVATE_NOW,
17 	.height		= -1,
18 	.width		= -1,
19 	.pixclock	= 39721,
20 	.left_margin	= 40,
21 	.right_margin	= 24,
22 	.upper_margin	= 32,
23 	.lower_margin	= 11,
24 	.hsync_len	= 96,
25 	.vsync_len	= 2,
26 	.vmode		= FB_VMODE_NONINTERLACED
27 };
28 
29 static char *radeon_get_mon_name(int type)
30 {
31 	char *pret = NULL;
32 
33 	switch (type) {
34 		case MT_NONE:
35 			pret = "no";
36 			break;
37 		case MT_CRT:
38 			pret = "CRT";
39 			break;
40 		case MT_DFP:
41 			pret = "DFP";
42 			break;
43 		case MT_LCD:
44 			pret = "LCD";
45 			break;
46 		case MT_CTV:
47 			pret = "CTV";
48 			break;
49 		case MT_STV:
50 			pret = "STV";
51 			break;
52 	}
53 
54 	return pret;
55 }
56 
57 
58 #if defined(CONFIG_PPC_OF) || defined(CONFIG_SPARC)
59 /*
60  * Try to find monitor informations & EDID data out of the Open Firmware
61  * device-tree. This also contains some "hacks" to work around a few machine
62  * models with broken OF probing by hard-coding known EDIDs for some Mac
63  * laptops internal LVDS panel. (XXX: not done yet)
64  */
65 static int radeon_parse_montype_prop(struct device_node *dp, u8 **out_EDID,
66 				     int hdno)
67 {
68         static char *propnames[] = { "DFP,EDID", "LCD,EDID", "EDID",
69 				     "EDID1", "EDID2",  NULL };
70 	const u8 *pedid = NULL;
71 	const u8 *pmt = NULL;
72 	u8 *tmp;
73         int i, mt = MT_NONE;
74 
75 	pr_debug("analyzing OF properties...\n");
76 	pmt = of_get_property(dp, "display-type", NULL);
77 	if (!pmt)
78 		return MT_NONE;
79 	pr_debug("display-type: %s\n", pmt);
80 	/* OF says "LCD" for DFP as well, we discriminate from the caller of this
81 	 * function
82 	 */
83 	if (!strcmp(pmt, "LCD") || !strcmp(pmt, "DFP"))
84 		mt = MT_DFP;
85 	else if (!strcmp(pmt, "CRT"))
86 		mt = MT_CRT;
87 	else {
88 		if (strcmp(pmt, "NONE") != 0)
89 			printk(KERN_WARNING "radeonfb: Unknown OF display-type: %s\n",
90 			       pmt);
91 		return MT_NONE;
92 	}
93 
94 	for (i = 0; propnames[i] != NULL; ++i) {
95 		pedid = of_get_property(dp, propnames[i], NULL);
96 		if (pedid != NULL)
97 			break;
98 	}
99 	/* We didn't find the EDID in the leaf node, some cards will actually
100 	 * put EDID1/EDID2 in the parent, look for these (typically M6 tipb).
101 	 * single-head cards have hdno == -1 and skip this step
102 	 */
103 	if (pedid == NULL && dp->parent && (hdno != -1))
104 		pedid = of_get_property(dp->parent,
105 				(hdno == 0) ? "EDID1" : "EDID2", NULL);
106 	if (pedid == NULL && dp->parent && (hdno == 0))
107 		pedid = of_get_property(dp->parent, "EDID", NULL);
108 	if (pedid == NULL)
109 		return mt;
110 
111 	tmp = kmemdup(pedid, EDID_LENGTH, GFP_KERNEL);
112 	if (!tmp)
113 		return mt;
114 	*out_EDID = tmp;
115 	return mt;
116 }
117 
118 static int radeon_probe_OF_head(struct radeonfb_info *rinfo, int head_no,
119 				u8 **out_EDID)
120 {
121         struct device_node *dp;
122 
123 	pr_debug("radeon_probe_OF_head\n");
124 
125         dp = rinfo->of_node;
126         while (dp == NULL)
127 		return MT_NONE;
128 
129 	if (rinfo->has_CRTC2) {
130 		const char *pname;
131 		int len, second = 0;
132 
133 		dp = dp->child;
134 		do {
135 			if (!dp)
136 				return MT_NONE;
137 			pname = of_get_property(dp, "name", NULL);
138 			if (!pname)
139 				return MT_NONE;
140 			len = strlen(pname);
141 			pr_debug("head: %s (letter: %c, head_no: %d)\n",
142 			       pname, pname[len-1], head_no);
143 			if (pname[len-1] == 'A' && head_no == 0) {
144 				int mt = radeon_parse_montype_prop(dp, out_EDID, 0);
145 				/* Maybe check for LVDS_GEN_CNTL here ? I need to check out
146 				 * what OF does when booting with lid closed
147 				 */
148 				if (mt == MT_DFP && rinfo->is_mobility)
149 					mt = MT_LCD;
150 				return mt;
151 			} else if (pname[len-1] == 'B' && head_no == 1)
152 				return radeon_parse_montype_prop(dp, out_EDID, 1);
153 			second = 1;
154 			dp = dp->sibling;
155 		} while(!second);
156 	} else {
157 		if (head_no > 0)
158 			return MT_NONE;
159 		return radeon_parse_montype_prop(dp, out_EDID, -1);
160 	}
161         return MT_NONE;
162 }
163 #endif /* CONFIG_PPC_OF || CONFIG_SPARC */
164 
165 
166 static int radeon_get_panel_info_BIOS(struct radeonfb_info *rinfo)
167 {
168 	unsigned long tmp, tmp0;
169 	char stmp[30];
170 	int i;
171 
172 	if (!rinfo->bios_seg)
173 		return 0;
174 
175 	if (!(tmp = BIOS_IN16(rinfo->fp_bios_start + 0x40))) {
176 		printk(KERN_ERR "radeonfb: Failed to detect DFP panel info using BIOS\n");
177 		rinfo->panel_info.pwr_delay = 200;
178 		return 0;
179 	}
180 
181 	for(i=0; i<24; i++)
182 		stmp[i] = BIOS_IN8(tmp+i+1);
183 	stmp[24] = 0;
184 	printk("radeonfb: panel ID string: %s\n", stmp);
185 	rinfo->panel_info.xres = BIOS_IN16(tmp + 25);
186 	rinfo->panel_info.yres = BIOS_IN16(tmp + 27);
187 	printk("radeonfb: detected LVDS panel size from BIOS: %dx%d\n",
188 		rinfo->panel_info.xres, rinfo->panel_info.yres);
189 
190 	rinfo->panel_info.pwr_delay = BIOS_IN16(tmp + 44);
191 	pr_debug("BIOS provided panel power delay: %d\n", rinfo->panel_info.pwr_delay);
192 	if (rinfo->panel_info.pwr_delay > 2000 || rinfo->panel_info.pwr_delay <= 0)
193 		rinfo->panel_info.pwr_delay = 2000;
194 
195 	/*
196 	 * Some panels only work properly with some divider combinations
197 	 */
198 	rinfo->panel_info.ref_divider = BIOS_IN16(tmp + 46);
199 	rinfo->panel_info.post_divider = BIOS_IN8(tmp + 48);
200 	rinfo->panel_info.fbk_divider = BIOS_IN16(tmp + 49);
201 	if (rinfo->panel_info.ref_divider != 0 &&
202 	    rinfo->panel_info.fbk_divider > 3) {
203 		rinfo->panel_info.use_bios_dividers = 1;
204 		printk(KERN_INFO "radeondb: BIOS provided dividers will be used\n");
205 		pr_debug("ref_divider = %x\n", rinfo->panel_info.ref_divider);
206 		pr_debug("post_divider = %x\n", rinfo->panel_info.post_divider);
207 		pr_debug("fbk_divider = %x\n", rinfo->panel_info.fbk_divider);
208 	}
209 	pr_debug("Scanning BIOS table ...\n");
210 	for(i=0; i<32; i++) {
211 		tmp0 = BIOS_IN16(tmp+64+i*2);
212 		if (tmp0 == 0)
213 			break;
214 		pr_debug(" %d x %d\n", BIOS_IN16(tmp0), BIOS_IN16(tmp0+2));
215 		if ((BIOS_IN16(tmp0) == rinfo->panel_info.xres) &&
216 		    (BIOS_IN16(tmp0+2) == rinfo->panel_info.yres)) {
217 			rinfo->panel_info.hblank = (BIOS_IN16(tmp0+17) - BIOS_IN16(tmp0+19)) * 8;
218 			rinfo->panel_info.hOver_plus = ((BIOS_IN16(tmp0+21) -
219 							 BIOS_IN16(tmp0+19) -1) * 8) & 0x7fff;
220 			rinfo->panel_info.hSync_width = BIOS_IN8(tmp0+23) * 8;
221 			rinfo->panel_info.vblank = BIOS_IN16(tmp0+24) - BIOS_IN16(tmp0+26);
222 			rinfo->panel_info.vOver_plus = (BIOS_IN16(tmp0+28) & 0x7ff) - BIOS_IN16(tmp0+26);
223 			rinfo->panel_info.vSync_width = (BIOS_IN16(tmp0+28) & 0xf800) >> 11;
224 			rinfo->panel_info.clock = BIOS_IN16(tmp0+9);
225 			/* Assume high active syncs for now until ATI tells me more... maybe we
226 			 * can probe register values here ?
227 			 */
228 			rinfo->panel_info.hAct_high = 1;
229 			rinfo->panel_info.vAct_high = 1;
230 			/* Mark panel infos valid */
231 			rinfo->panel_info.valid = 1;
232 
233 			pr_debug("Found panel in BIOS table:\n");
234 			pr_debug("  hblank: %d\n", rinfo->panel_info.hblank);
235 			pr_debug("  hOver_plus: %d\n", rinfo->panel_info.hOver_plus);
236 			pr_debug("  hSync_width: %d\n", rinfo->panel_info.hSync_width);
237 			pr_debug("  vblank: %d\n", rinfo->panel_info.vblank);
238 			pr_debug("  vOver_plus: %d\n", rinfo->panel_info.vOver_plus);
239 			pr_debug("  vSync_width: %d\n", rinfo->panel_info.vSync_width);
240 			pr_debug("  clock: %d\n", rinfo->panel_info.clock);
241 
242 			return 1;
243 		}
244 	}
245 	pr_debug("Didn't find panel in BIOS table !\n");
246 
247 	return 0;
248 }
249 
250 /* Try to extract the connector informations from the BIOS. This
251  * doesn't quite work yet, but it's output is still useful for
252  * debugging
253  */
254 static void radeon_parse_connector_info(struct radeonfb_info *rinfo)
255 {
256 	int offset, chips, connectors, tmp, i, conn, type;
257 
258 	static char* __conn_type_table[16] = {
259 		"NONE", "Proprietary", "CRT", "DVI-I", "DVI-D", "Unknown", "Unknown",
260 		"Unknown", "Unknown", "Unknown", "Unknown", "Unknown", "Unknown",
261 		"Unknown", "Unknown", "Unknown"
262 	};
263 
264 	if (!rinfo->bios_seg)
265 		return;
266 
267 	offset = BIOS_IN16(rinfo->fp_bios_start + 0x50);
268 	if (offset == 0) {
269 		printk(KERN_WARNING "radeonfb: No connector info table detected\n");
270 		return;
271 	}
272 
273 	/* Don't do much more at this point but displaying the data if
274 	 * DEBUG is enabled
275 	 */
276 	chips = BIOS_IN8(offset++) >> 4;
277 	pr_debug("%d chips in connector info\n", chips);
278 	for (i = 0; i < chips; i++) {
279 		tmp = BIOS_IN8(offset++);
280 		connectors = tmp & 0x0f;
281 		pr_debug(" - chip %d has %d connectors\n", tmp >> 4, connectors);
282 		for (conn = 0; ; conn++) {
283 			tmp = BIOS_IN16(offset);
284 			if (tmp == 0)
285 				break;
286 			offset += 2;
287 			type = (tmp >> 12) & 0x0f;
288 			pr_debug("  * connector %d of type %d (%s) : %04x\n",
289 			       conn, type, __conn_type_table[type], tmp);
290 		}
291 	}
292 }
293 
294 
295 /*
296  * Probe physical connection of a CRT. This code comes from XFree
297  * as well and currently is only implemented for the CRT DAC, the
298  * code for the TVDAC is commented out in XFree as "non working"
299  */
300 static int radeon_crt_is_connected(struct radeonfb_info *rinfo, int is_crt_dac)
301 {
302     int	          connected = 0;
303 
304     /* the monitor either wasn't connected or it is a non-DDC CRT.
305      * try to probe it
306      */
307     if (is_crt_dac) {
308 	unsigned long ulOrigVCLK_ECP_CNTL;
309 	unsigned long ulOrigDAC_CNTL;
310 	unsigned long ulOrigDAC_EXT_CNTL;
311 	unsigned long ulOrigCRTC_EXT_CNTL;
312 	unsigned long ulData;
313 	unsigned long ulMask;
314 
315 	ulOrigVCLK_ECP_CNTL = INPLL(VCLK_ECP_CNTL);
316 
317 	ulData              = ulOrigVCLK_ECP_CNTL;
318 	ulData             &= ~(PIXCLK_ALWAYS_ONb
319 				| PIXCLK_DAC_ALWAYS_ONb);
320 	ulMask              = ~(PIXCLK_ALWAYS_ONb
321 				| PIXCLK_DAC_ALWAYS_ONb);
322 	OUTPLLP(VCLK_ECP_CNTL, ulData, ulMask);
323 
324 	ulOrigCRTC_EXT_CNTL = INREG(CRTC_EXT_CNTL);
325 	ulData              = ulOrigCRTC_EXT_CNTL;
326 	ulData             |= CRTC_CRT_ON;
327 	OUTREG(CRTC_EXT_CNTL, ulData);
328 
329 	ulOrigDAC_EXT_CNTL = INREG(DAC_EXT_CNTL);
330 	ulData             = ulOrigDAC_EXT_CNTL;
331 	ulData            &= ~DAC_FORCE_DATA_MASK;
332 	ulData            |=  (DAC_FORCE_BLANK_OFF_EN
333 			       |DAC_FORCE_DATA_EN
334 			       |DAC_FORCE_DATA_SEL_MASK);
335 	if ((rinfo->family == CHIP_FAMILY_RV250) ||
336 	    (rinfo->family == CHIP_FAMILY_RV280))
337 	    ulData |= (0x01b6 << DAC_FORCE_DATA_SHIFT);
338 	else
339 	    ulData |= (0x01ac << DAC_FORCE_DATA_SHIFT);
340 
341 	OUTREG(DAC_EXT_CNTL, ulData);
342 
343 	ulOrigDAC_CNTL     = INREG(DAC_CNTL);
344 	ulData             = ulOrigDAC_CNTL;
345 	ulData            |= DAC_CMP_EN;
346 	ulData            &= ~(DAC_RANGE_CNTL_MASK
347 			       | DAC_PDWN);
348 	ulData            |= 0x2;
349 	OUTREG(DAC_CNTL, ulData);
350 
351 	mdelay(1);
352 
353 	ulData     = INREG(DAC_CNTL);
354 	connected =  (DAC_CMP_OUTPUT & ulData) ? 1 : 0;
355 
356 	ulData    = ulOrigVCLK_ECP_CNTL;
357 	ulMask    = 0xFFFFFFFFL;
358 	OUTPLLP(VCLK_ECP_CNTL, ulData, ulMask);
359 
360 	OUTREG(DAC_CNTL,      ulOrigDAC_CNTL     );
361 	OUTREG(DAC_EXT_CNTL,  ulOrigDAC_EXT_CNTL );
362 	OUTREG(CRTC_EXT_CNTL, ulOrigCRTC_EXT_CNTL);
363     }
364 
365     return connected ? MT_CRT : MT_NONE;
366 }
367 
368 /*
369  * Parse the "monitor_layout" string if any. This code is mostly
370  * copied from XFree's radeon driver
371  */
372 static int radeon_parse_monitor_layout(struct radeonfb_info *rinfo,
373 				       const char *monitor_layout)
374 {
375 	char s1[5], s2[5];
376 	int i = 0, second = 0;
377 	const char *s;
378 
379 	if (!monitor_layout)
380 		return 0;
381 
382 	s = monitor_layout;
383 	do {
384 		switch(*s) {
385 		case ',':
386 			s1[i] = '\0';
387 			i = 0;
388 			second = 1;
389 			break;
390 		case ' ':
391 		case '\0':
392 			break;
393 		default:
394 			if (i > 4)
395 				break;
396 			if (second)
397 				s2[i] = *s;
398 			else
399 				s1[i] = *s;
400 			i++;
401 		}
402 
403 		if (i > 4)
404 			i = 4;
405 
406 	} while (*s++);
407 	if (second)
408 		s2[i] = 0;
409 	else {
410 		s1[i] = 0;
411 		s2[0] = 0;
412 	}
413 	if (strcmp(s1, "CRT") == 0)
414 		rinfo->mon1_type = MT_CRT;
415 	else if (strcmp(s1, "TMDS") == 0)
416 		rinfo->mon1_type = MT_DFP;
417 	else if (strcmp(s1, "LVDS") == 0)
418 		rinfo->mon1_type = MT_LCD;
419 
420 	if (strcmp(s2, "CRT") == 0)
421 		rinfo->mon2_type = MT_CRT;
422 	else if (strcmp(s2, "TMDS") == 0)
423 		rinfo->mon2_type = MT_DFP;
424 	else if (strcmp(s2, "LVDS") == 0)
425 		rinfo->mon2_type = MT_LCD;
426 
427 	return 1;
428 }
429 
430 /*
431  * Probe display on both primary and secondary card's connector (if any)
432  * by various available techniques (i2c, OF device tree, BIOS, ...) and
433  * try to retrieve EDID. The algorithm here comes from XFree's radeon
434  * driver
435  */
436 void radeon_probe_screens(struct radeonfb_info *rinfo,
437 			  const char *monitor_layout, int ignore_edid)
438 {
439 #ifdef CONFIG_FB_RADEON_I2C
440 	int ddc_crt2_used = 0;
441 #endif
442 	int tmp, i;
443 
444 	radeon_parse_connector_info(rinfo);
445 
446 	if (radeon_parse_monitor_layout(rinfo, monitor_layout)) {
447 
448 		/*
449 		 * If user specified a monitor_layout option, use it instead
450 		 * of auto-detecting. Maybe we should only use this argument
451 		 * on the first radeon card probed or provide a way to specify
452 		 * a layout for each card ?
453 		 */
454 
455 		pr_debug("Using specified monitor layout: %s", monitor_layout);
456 #ifdef CONFIG_FB_RADEON_I2C
457 		if (!ignore_edid) {
458 			if (rinfo->mon1_type != MT_NONE)
459 				if (!radeon_probe_i2c_connector(rinfo, ddc_dvi, &rinfo->mon1_EDID)) {
460 					radeon_probe_i2c_connector(rinfo, ddc_crt2, &rinfo->mon1_EDID);
461 					ddc_crt2_used = 1;
462 				}
463 			if (rinfo->mon2_type != MT_NONE)
464 				if (!radeon_probe_i2c_connector(rinfo, ddc_vga, &rinfo->mon2_EDID) &&
465 				    !ddc_crt2_used)
466 					radeon_probe_i2c_connector(rinfo, ddc_crt2, &rinfo->mon2_EDID);
467 		}
468 #endif /* CONFIG_FB_RADEON_I2C */
469 		if (rinfo->mon1_type == MT_NONE) {
470 			if (rinfo->mon2_type != MT_NONE) {
471 				rinfo->mon1_type = rinfo->mon2_type;
472 				rinfo->mon1_EDID = rinfo->mon2_EDID;
473 			} else {
474 				rinfo->mon1_type = MT_CRT;
475 				printk(KERN_INFO "radeonfb: No valid monitor, assuming CRT on first port\n");
476 			}
477 			rinfo->mon2_type = MT_NONE;
478 			rinfo->mon2_EDID = NULL;
479 		}
480 	} else {
481 		/*
482 		 * Auto-detecting display type (well... trying to ...)
483 		 */
484 
485 		pr_debug("Starting monitor auto detection...\n");
486 
487 #if defined(DEBUG) && defined(CONFIG_FB_RADEON_I2C)
488 		{
489 			u8 *EDIDs[4] = { NULL, NULL, NULL, NULL };
490 			int mon_types[4] = {MT_NONE, MT_NONE, MT_NONE, MT_NONE};
491 			int i;
492 
493 			for (i = 0; i < 4; i++)
494 				mon_types[i] = radeon_probe_i2c_connector(rinfo,
495 									  i+1, &EDIDs[i]);
496 		}
497 #endif /* DEBUG */
498 		/*
499 		 * Old single head cards
500 		 */
501 		if (!rinfo->has_CRTC2) {
502 #if defined(CONFIG_PPC_OF) || defined(CONFIG_SPARC)
503 			if (rinfo->mon1_type == MT_NONE)
504 				rinfo->mon1_type = radeon_probe_OF_head(rinfo, 0,
505 									&rinfo->mon1_EDID);
506 #endif /* CONFIG_PPC_OF || CONFIG_SPARC */
507 #ifdef CONFIG_FB_RADEON_I2C
508 			if (rinfo->mon1_type == MT_NONE)
509 				rinfo->mon1_type =
510 					radeon_probe_i2c_connector(rinfo, ddc_dvi,
511 								   &rinfo->mon1_EDID);
512 			if (rinfo->mon1_type == MT_NONE)
513 				rinfo->mon1_type =
514 					radeon_probe_i2c_connector(rinfo, ddc_vga,
515 								   &rinfo->mon1_EDID);
516 			if (rinfo->mon1_type == MT_NONE)
517 				rinfo->mon1_type =
518 					radeon_probe_i2c_connector(rinfo, ddc_crt2,
519 								   &rinfo->mon1_EDID);
520 #endif /* CONFIG_FB_RADEON_I2C */
521 			if (rinfo->mon1_type == MT_NONE)
522 				rinfo->mon1_type = MT_CRT;
523 			goto bail;
524 		}
525 
526 		/*
527 		 * Check for cards with reversed DACs or TMDS controllers using BIOS
528 		 */
529 		if (rinfo->bios_seg &&
530 		    (tmp = BIOS_IN16(rinfo->fp_bios_start + 0x50))) {
531 			for (i = 1; i < 4; i++) {
532 				unsigned int tmp0;
533 
534 				if (!BIOS_IN8(tmp + i*2) && i > 1)
535 					break;
536 				tmp0 = BIOS_IN16(tmp + i*2);
537 				if ((!(tmp0 & 0x01)) && (((tmp0 >> 8) & 0x0f) == ddc_dvi)) {
538 					rinfo->reversed_DAC = 1;
539 					printk(KERN_INFO "radeonfb: Reversed DACs detected\n");
540 				}
541 				if ((((tmp0 >> 8) & 0x0f) == ddc_dvi) && ((tmp0 >> 4) & 0x01)) {
542 					rinfo->reversed_TMDS = 1;
543 					printk(KERN_INFO "radeonfb: Reversed TMDS detected\n");
544 				}
545 			}
546 		}
547 
548 		/*
549 		 * Probe primary head (DVI or laptop internal panel)
550 		 */
551 #if defined(CONFIG_PPC_OF) || defined(CONFIG_SPARC)
552 		if (rinfo->mon1_type == MT_NONE)
553 			rinfo->mon1_type = radeon_probe_OF_head(rinfo, 0,
554 								&rinfo->mon1_EDID);
555 #endif /* CONFIG_PPC_OF || CONFIG_SPARC */
556 #ifdef CONFIG_FB_RADEON_I2C
557 		if (rinfo->mon1_type == MT_NONE)
558 			rinfo->mon1_type = radeon_probe_i2c_connector(rinfo, ddc_dvi,
559 								      &rinfo->mon1_EDID);
560 		if (rinfo->mon1_type == MT_NONE) {
561 			rinfo->mon1_type = radeon_probe_i2c_connector(rinfo, ddc_crt2,
562 								      &rinfo->mon1_EDID);
563 			if (rinfo->mon1_type != MT_NONE)
564 				ddc_crt2_used = 1;
565 		}
566 #endif /* CONFIG_FB_RADEON_I2C */
567 		if (rinfo->mon1_type == MT_NONE && rinfo->is_mobility &&
568 		    ((rinfo->bios_seg && (INREG(BIOS_4_SCRATCH) & 4))
569 		     || (INREG(LVDS_GEN_CNTL) & LVDS_ON))) {
570 			rinfo->mon1_type = MT_LCD;
571 			printk("Non-DDC laptop panel detected\n");
572 		}
573 		if (rinfo->mon1_type == MT_NONE)
574 			rinfo->mon1_type = radeon_crt_is_connected(rinfo, rinfo->reversed_DAC);
575 
576 		/*
577 		 * Probe secondary head (mostly VGA, can be DVI)
578 		 */
579 #if defined(CONFIG_PPC_OF) || defined(CONFIG_SPARC)
580 		if (rinfo->mon2_type == MT_NONE)
581 			rinfo->mon2_type = radeon_probe_OF_head(rinfo, 1,
582 								&rinfo->mon2_EDID);
583 #endif /* CONFIG_PPC_OF || defined(CONFIG_SPARC) */
584 #ifdef CONFIG_FB_RADEON_I2C
585 		if (rinfo->mon2_type == MT_NONE)
586 			rinfo->mon2_type = radeon_probe_i2c_connector(rinfo, ddc_vga,
587 								      &rinfo->mon2_EDID);
588 		if (rinfo->mon2_type == MT_NONE && !ddc_crt2_used)
589 			rinfo->mon2_type = radeon_probe_i2c_connector(rinfo, ddc_crt2,
590 								      &rinfo->mon2_EDID);
591 #endif /* CONFIG_FB_RADEON_I2C */
592 		if (rinfo->mon2_type == MT_NONE)
593 			rinfo->mon2_type = radeon_crt_is_connected(rinfo, !rinfo->reversed_DAC);
594 
595 		/*
596 		 * If we only detected port 2, we swap them, if none detected,
597 		 * assume CRT (maybe fallback to old BIOS_SCRATCH stuff ? or look
598 		 * at FP registers ?)
599 		 */
600 		if (rinfo->mon1_type == MT_NONE) {
601 			if (rinfo->mon2_type != MT_NONE) {
602 				rinfo->mon1_type = rinfo->mon2_type;
603 				rinfo->mon1_EDID = rinfo->mon2_EDID;
604 			} else
605 				rinfo->mon1_type = MT_CRT;
606 			rinfo->mon2_type = MT_NONE;
607 			rinfo->mon2_EDID = NULL;
608 		}
609 
610 		/*
611 		 * Deal with reversed TMDS
612 		 */
613 		if (rinfo->reversed_TMDS) {
614 			/* Always keep internal TMDS as primary head */
615 			if (rinfo->mon1_type == MT_DFP || rinfo->mon2_type == MT_DFP) {
616 				int tmp_type = rinfo->mon1_type;
617 				u8 *tmp_EDID = rinfo->mon1_EDID;
618 				rinfo->mon1_type = rinfo->mon2_type;
619 				rinfo->mon1_EDID = rinfo->mon2_EDID;
620 				rinfo->mon2_type = tmp_type;
621 				rinfo->mon2_EDID = tmp_EDID;
622 				if (rinfo->mon1_type == MT_CRT || rinfo->mon2_type == MT_CRT)
623 					rinfo->reversed_DAC ^= 1;
624 			}
625 		}
626 	}
627 	if (ignore_edid) {
628 		kfree(rinfo->mon1_EDID);
629 		rinfo->mon1_EDID = NULL;
630 		kfree(rinfo->mon2_EDID);
631 		rinfo->mon2_EDID = NULL;
632 	}
633 
634  bail:
635 	printk(KERN_INFO "radeonfb: Monitor 1 type %s found\n",
636 	       radeon_get_mon_name(rinfo->mon1_type));
637 	if (rinfo->mon1_EDID)
638 		printk(KERN_INFO "radeonfb: EDID probed\n");
639 	if (!rinfo->has_CRTC2)
640 		return;
641 	printk(KERN_INFO "radeonfb: Monitor 2 type %s found\n",
642 	       radeon_get_mon_name(rinfo->mon2_type));
643 	if (rinfo->mon2_EDID)
644 		printk(KERN_INFO "radeonfb: EDID probed\n");
645 }
646 
647 
648 /*
649  * This functions applyes any arch/model/machine specific fixups
650  * to the panel info. It may eventually alter EDID block as
651  * well or whatever is specific to a given model and not probed
652  * properly by the default code
653  */
654 static void radeon_fixup_panel_info(struct radeonfb_info *rinfo)
655 {
656 #ifdef CONFIG_PPC_OF
657 	/*
658 	 * LCD Flat panels should use fixed dividers, we enfore that on
659 	 * PPC only for now...
660 	 */
661 	if (!rinfo->panel_info.use_bios_dividers && rinfo->mon1_type == MT_LCD
662 	    && rinfo->is_mobility) {
663 		int ppll_div_sel;
664 		u32 ppll_divn;
665 		ppll_div_sel = INREG8(CLOCK_CNTL_INDEX + 1) & 0x3;
666 		radeon_pll_errata_after_index(rinfo);
667 		ppll_divn = INPLL(PPLL_DIV_0 + ppll_div_sel);
668 		rinfo->panel_info.ref_divider = rinfo->pll.ref_div;
669 		rinfo->panel_info.fbk_divider = ppll_divn & 0x7ff;
670 		rinfo->panel_info.post_divider = (ppll_divn >> 16) & 0x7;
671 		rinfo->panel_info.use_bios_dividers = 1;
672 
673 		printk(KERN_DEBUG "radeonfb: Using Firmware dividers 0x%08x "
674 		       "from PPLL %d\n",
675 		       rinfo->panel_info.fbk_divider |
676 		       (rinfo->panel_info.post_divider << 16),
677 		       ppll_div_sel);
678 	}
679 #endif /* CONFIG_PPC_OF */
680 }
681 
682 
683 /*
684  * Fill up panel infos from a mode definition, either returned by the EDID
685  * or from the default mode when we can't do any better
686  */
687 static void radeon_var_to_panel_info(struct radeonfb_info *rinfo, struct fb_var_screeninfo *var)
688 {
689 	rinfo->panel_info.xres = var->xres;
690 	rinfo->panel_info.yres = var->yres;
691 	rinfo->panel_info.clock = 100000000 / var->pixclock;
692 	rinfo->panel_info.hOver_plus = var->right_margin;
693 	rinfo->panel_info.hSync_width = var->hsync_len;
694        	rinfo->panel_info.hblank = var->left_margin +
695 		(var->right_margin + var->hsync_len);
696 	rinfo->panel_info.vOver_plus = var->lower_margin;
697 	rinfo->panel_info.vSync_width = var->vsync_len;
698        	rinfo->panel_info.vblank = var->upper_margin +
699 		(var->lower_margin + var->vsync_len);
700 	rinfo->panel_info.hAct_high =
701 		(var->sync & FB_SYNC_HOR_HIGH_ACT) != 0;
702 	rinfo->panel_info.vAct_high =
703 		(var->sync & FB_SYNC_VERT_HIGH_ACT) != 0;
704 	rinfo->panel_info.valid = 1;
705 	/* We use a default of 200ms for the panel power delay,
706 	 * I need to have a real schedule() instead of mdelay's in the panel code.
707 	 * we might be possible to figure out a better power delay either from
708 	 * MacOS OF tree or from the EDID block (proprietary extensions ?)
709 	 */
710 	rinfo->panel_info.pwr_delay = 200;
711 }
712 
713 static void radeon_videomode_to_var(struct fb_var_screeninfo *var,
714 				    const struct fb_videomode *mode)
715 {
716 	var->xres = mode->xres;
717 	var->yres = mode->yres;
718 	var->xres_virtual = mode->xres;
719 	var->yres_virtual = mode->yres;
720 	var->xoffset = 0;
721 	var->yoffset = 0;
722 	var->pixclock = mode->pixclock;
723 	var->left_margin = mode->left_margin;
724 	var->right_margin = mode->right_margin;
725 	var->upper_margin = mode->upper_margin;
726 	var->lower_margin = mode->lower_margin;
727 	var->hsync_len = mode->hsync_len;
728 	var->vsync_len = mode->vsync_len;
729 	var->sync = mode->sync;
730 	var->vmode = mode->vmode;
731 }
732 
733 #ifdef CONFIG_PPC_PSERIES
734 static int is_powerblade(const char *model)
735 {
736 	struct device_node *root;
737 	const char* cp;
738 	int len, l, rc = 0;
739 
740 	root = of_find_node_by_path("/");
741 	if (root && model) {
742 		l = strlen(model);
743 		cp = of_get_property(root, "model", &len);
744 		if (cp)
745 			rc = memcmp(model, cp, min(len, l)) == 0;
746 		of_node_put(root);
747 	}
748 	return rc;
749 }
750 #endif
751 
752 /*
753  * Build the modedb for head 1 (head 2 will come later), check panel infos
754  * from either BIOS or EDID, and pick up the default mode
755  */
756 void radeon_check_modes(struct radeonfb_info *rinfo, const char *mode_option)
757 {
758 	struct fb_info * info = rinfo->info;
759 	int has_default_mode = 0;
760 
761 	/*
762 	 * Fill default var first
763 	 */
764 	info->var = radeonfb_default_var;
765 	INIT_LIST_HEAD(&info->modelist);
766 
767 	/*
768 	 * First check out what BIOS has to say
769 	 */
770 	if (rinfo->mon1_type == MT_LCD)
771 		radeon_get_panel_info_BIOS(rinfo);
772 
773 	/*
774 	 * Parse EDID detailed timings and deduce panel infos if any. Right now
775 	 * we only deal with first entry returned by parse_EDID, we may do better
776 	 * some day...
777 	 */
778 	if (!rinfo->panel_info.use_bios_dividers && rinfo->mon1_type != MT_CRT
779 	    && rinfo->mon1_EDID) {
780 		struct fb_var_screeninfo var;
781 		pr_debug("Parsing EDID data for panel info\n");
782 		if (fb_parse_edid(rinfo->mon1_EDID, &var) == 0) {
783 			if (var.xres >= rinfo->panel_info.xres &&
784 			    var.yres >= rinfo->panel_info.yres)
785 				radeon_var_to_panel_info(rinfo, &var);
786 		}
787 	}
788 
789 	/*
790 	 * Do any additional platform/arch fixups to the panel infos
791 	 */
792 	radeon_fixup_panel_info(rinfo);
793 
794 	/*
795 	 * If we have some valid panel infos, we setup the default mode based on
796 	 * those
797 	 */
798 	if (rinfo->mon1_type != MT_CRT && rinfo->panel_info.valid) {
799 		struct fb_var_screeninfo *var = &info->var;
800 
801 		pr_debug("Setting up default mode based on panel info\n");
802 		var->xres = rinfo->panel_info.xres;
803 		var->yres = rinfo->panel_info.yres;
804 		var->xres_virtual = rinfo->panel_info.xres;
805 		var->yres_virtual = rinfo->panel_info.yres;
806 		var->xoffset = var->yoffset = 0;
807 		var->bits_per_pixel = 8;
808 		var->pixclock = 100000000 / rinfo->panel_info.clock;
809 		var->left_margin = (rinfo->panel_info.hblank - rinfo->panel_info.hOver_plus
810 				    - rinfo->panel_info.hSync_width);
811 		var->right_margin = rinfo->panel_info.hOver_plus;
812 		var->upper_margin = (rinfo->panel_info.vblank - rinfo->panel_info.vOver_plus
813 				     - rinfo->panel_info.vSync_width);
814 		var->lower_margin = rinfo->panel_info.vOver_plus;
815 		var->hsync_len = rinfo->panel_info.hSync_width;
816 		var->vsync_len = rinfo->panel_info.vSync_width;
817 		var->sync = 0;
818 		if (rinfo->panel_info.hAct_high)
819 			var->sync |= FB_SYNC_HOR_HIGH_ACT;
820 		if (rinfo->panel_info.vAct_high)
821 			var->sync |= FB_SYNC_VERT_HIGH_ACT;
822 		var->vmode = 0;
823 		has_default_mode = 1;
824 	}
825 
826 	/*
827 	 * Now build modedb from EDID
828 	 */
829 	if (rinfo->mon1_EDID) {
830 		fb_edid_to_monspecs(rinfo->mon1_EDID, &info->monspecs);
831 		fb_videomode_to_modelist(info->monspecs.modedb,
832 					 info->monspecs.modedb_len,
833 					 &info->modelist);
834 		rinfo->mon1_modedb = info->monspecs.modedb;
835 		rinfo->mon1_dbsize = info->monspecs.modedb_len;
836 	}
837 
838 
839 	/*
840 	 * Finally, if we don't have panel infos we need to figure some (or
841 	 * we try to read it from card), we try to pick a default mode
842 	 * and create some panel infos. Whatever...
843 	 */
844 	if (rinfo->mon1_type != MT_CRT && !rinfo->panel_info.valid) {
845 		struct fb_videomode	*modedb;
846 		int			dbsize;
847 		char			modename[32];
848 
849 		pr_debug("Guessing panel info...\n");
850 		if (rinfo->panel_info.xres == 0 || rinfo->panel_info.yres == 0) {
851 			u32 tmp = INREG(FP_HORZ_STRETCH) & HORZ_PANEL_SIZE;
852 			rinfo->panel_info.xres = ((tmp >> HORZ_PANEL_SHIFT) + 1) * 8;
853 			tmp = INREG(FP_VERT_STRETCH) & VERT_PANEL_SIZE;
854 			rinfo->panel_info.yres = (tmp >> VERT_PANEL_SHIFT) + 1;
855 		}
856 		if (rinfo->panel_info.xres == 0 || rinfo->panel_info.yres == 0) {
857 			printk(KERN_WARNING "radeonfb: Can't find panel size, going back to CRT\n");
858 			rinfo->mon1_type = MT_CRT;
859 			goto pickup_default;
860 		}
861 		printk(KERN_WARNING "radeonfb: Assuming panel size %dx%d\n",
862 		       rinfo->panel_info.xres, rinfo->panel_info.yres);
863 		modedb = rinfo->mon1_modedb;
864 		dbsize = rinfo->mon1_dbsize;
865 		snprintf(modename, 31, "%dx%d", rinfo->panel_info.xres, rinfo->panel_info.yres);
866 		if (fb_find_mode(&info->var, info, modename,
867 				 modedb, dbsize, NULL, 8) == 0) {
868 			printk(KERN_WARNING "radeonfb: Can't find mode for panel size, going back to CRT\n");
869 			rinfo->mon1_type = MT_CRT;
870 			goto pickup_default;
871 		}
872 		has_default_mode = 1;
873 		radeon_var_to_panel_info(rinfo, &info->var);
874 	}
875 
876  pickup_default:
877 	/*
878 	 * Apply passed-in mode option if any
879 	 */
880 	if (mode_option) {
881 		if (fb_find_mode(&info->var, info, mode_option,
882 				 info->monspecs.modedb,
883 				 info->monspecs.modedb_len, NULL, 8) != 0)
884 			has_default_mode = 1;
885  	}
886 
887 #ifdef CONFIG_PPC_PSERIES
888 	if (!has_default_mode && (
889 		is_powerblade("IBM,8842") || /* JS20 */
890 		is_powerblade("IBM,8844") || /* JS21 */
891 		is_powerblade("IBM,7998") || /* JS12/JS21/JS22 */
892 		is_powerblade("IBM,0792") || /* QS21 */
893 		is_powerblade("IBM,0793")    /* QS22 */
894 	    )) {
895 		printk("Falling back to 800x600 on JSxx hardware\n");
896 		if (fb_find_mode(&info->var, info, "800x600@60",
897 				 info->monspecs.modedb,
898 				 info->monspecs.modedb_len, NULL, 8) != 0)
899 			has_default_mode = 1;
900 	}
901 #endif
902 
903 	/*
904 	 * Still no mode, let's pick up a default from the db
905 	 */
906 	if (!has_default_mode && info->monspecs.modedb != NULL) {
907 		struct fb_monspecs *specs = &info->monspecs;
908 		struct fb_videomode *modedb = NULL;
909 
910 		/* get preferred timing */
911 		if (specs->misc & FB_MISC_1ST_DETAIL) {
912 			int i;
913 
914 			for (i = 0; i < specs->modedb_len; i++) {
915 				if (specs->modedb[i].flag & FB_MODE_IS_FIRST) {
916 					modedb = &specs->modedb[i];
917 					break;
918 				}
919 			}
920 		} else {
921 			/* otherwise, get first mode in database */
922 			modedb = &specs->modedb[0];
923 		}
924 		if (modedb != NULL) {
925 			info->var.bits_per_pixel = 8;
926 			radeon_videomode_to_var(&info->var, modedb);
927 			has_default_mode = 1;
928 		}
929 	}
930 	if (1) {
931 		struct fb_videomode mode;
932 		/* Make sure that whatever mode got selected is actually in the
933 		 * modelist or the kernel may die
934 		 */
935 		fb_var_to_videomode(&mode, &info->var);
936 		fb_add_videomode(&mode, &info->modelist);
937 	}
938 }
939 
940 /*
941  * The code below is used to pick up a mode in check_var and
942  * set_var. It should be made generic
943  */
944 
945 /*
946  * This is used when looking for modes. We assign a "distance" value
947  * to a mode in the modedb depending how "close" it is from what we
948  * are looking for.
949  * Currently, we don't compare that much, we could do better but
950  * the current fbcon doesn't quite mind ;)
951  */
952 static int radeon_compare_modes(const struct fb_var_screeninfo *var,
953 				const struct fb_videomode *mode)
954 {
955 	int distance = 0;
956 
957 	distance = mode->yres - var->yres;
958 	distance += (mode->xres - var->xres)/2;
959 	return distance;
960 }
961 
962 /*
963  * This function is called by check_var, it gets the passed in mode parameter, and
964  * outputs a valid mode matching the passed-in one as closely as possible.
965  * We need something better ultimately. Things like fbcon basically pass us out
966  * current mode with xres/yres hacked, while things like XFree will actually
967  * produce a full timing that we should respect as much as possible.
968  *
969  * This is why I added the FB_ACTIVATE_FIND that is used by fbcon. Without this,
970  * we do a simple spec match, that's all. With it, we actually look for a mode in
971  * either our monitor modedb or the vesa one if none
972  *
973  */
974 int  radeon_match_mode(struct radeonfb_info *rinfo,
975 		       struct fb_var_screeninfo *dest,
976 		       const struct fb_var_screeninfo *src)
977 {
978 	const struct fb_videomode	*db = vesa_modes;
979 	int				i, dbsize = 34;
980 	int				has_rmx, native_db = 0;
981 	int				distance = INT_MAX;
982 	const struct fb_videomode	*candidate = NULL;
983 
984 	/* Start with a copy of the requested mode */
985 	memcpy(dest, src, sizeof(struct fb_var_screeninfo));
986 
987 	/* Check if we have a modedb built from EDID */
988 	if (rinfo->mon1_modedb) {
989 		db = rinfo->mon1_modedb;
990 		dbsize = rinfo->mon1_dbsize;
991 		native_db = 1;
992 	}
993 
994 	/* Check if we have a scaler allowing any fancy mode */
995 	has_rmx = rinfo->mon1_type == MT_LCD || rinfo->mon1_type == MT_DFP;
996 
997 	/* If we have a scaler and are passed FB_ACTIVATE_TEST or
998 	 * FB_ACTIVATE_NOW, just do basic checking and return if the
999 	 * mode match
1000 	 */
1001 	if ((src->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_TEST ||
1002 	    (src->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) {
1003 		/* We don't have an RMX, validate timings. If we don't have
1004 	 	 * monspecs, we should be paranoid and not let use go above
1005 		 * 640x480-60, but I assume userland knows what it's doing here
1006 		 * (though I may be proven wrong...)
1007 		 */
1008 		if (has_rmx == 0 && rinfo->mon1_modedb)
1009 			if (fb_validate_mode((struct fb_var_screeninfo *)src, rinfo->info))
1010 				return -EINVAL;
1011 		return 0;
1012 	}
1013 
1014 	/* Now look for a mode in the database */
1015 	while (db) {
1016 		for (i = 0; i < dbsize; i++) {
1017 			int d;
1018 
1019 			if (db[i].yres < src->yres)
1020 				continue;
1021 			if (db[i].xres < src->xres)
1022 				continue;
1023 			d = radeon_compare_modes(src, &db[i]);
1024 			/* If the new mode is at least as good as the previous one,
1025 			 * then it's our new candidate
1026 			 */
1027 			if (d < distance) {
1028 				candidate = &db[i];
1029 				distance = d;
1030 			}
1031 		}
1032 		db = NULL;
1033 		/* If we have a scaler, we allow any mode from the database */
1034 		if (native_db && has_rmx) {
1035 			db = vesa_modes;
1036 			dbsize = 34;
1037 			native_db = 0;
1038 		}
1039 	}
1040 
1041 	/* If we have found a match, return it */
1042 	if (candidate != NULL) {
1043 		radeon_videomode_to_var(dest, candidate);
1044 		return 0;
1045 	}
1046 
1047 	/* If we haven't and don't have a scaler, fail */
1048 	if (!has_rmx)
1049 		return -EINVAL;
1050 
1051 	return 0;
1052 }
1053