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