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