1 /* 2 * Copyright 2003 NVIDIA, Corporation 3 * Copyright 2006 Dave Airlie 4 * Copyright 2007 Maarten Maathuis 5 * Copyright 2007-2009 Stuart Bennett 6 * 7 * Permission is hereby granted, free of charge, to any person obtaining a 8 * copy of this software and associated documentation files (the "Software"), 9 * to deal in the Software without restriction, including without limitation 10 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 11 * and/or sell copies of the Software, and to permit persons to whom the 12 * Software is furnished to do so, subject to the following conditions: 13 * 14 * The above copyright notice and this permission notice (including the next 15 * paragraph) shall be included in all copies or substantial portions of the 16 * Software. 17 * 18 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 19 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 20 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 21 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 22 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING 23 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER 24 * DEALINGS IN THE SOFTWARE. 25 */ 26 27 #include <drm/drm_crtc_helper.h> 28 #include <drm/drm_fourcc.h> 29 30 #include "nouveau_drv.h" 31 #include "nouveau_reg.h" 32 #include "nouveau_encoder.h" 33 #include "nouveau_connector.h" 34 #include "nouveau_crtc.h" 35 #include "hw.h" 36 #include "nvreg.h" 37 38 #include <drm/i2c/sil164.h> 39 40 #include <subdev/i2c.h> 41 42 #define FP_TG_CONTROL_ON (NV_PRAMDAC_FP_TG_CONTROL_DISPEN_POS | \ 43 NV_PRAMDAC_FP_TG_CONTROL_HSYNC_POS | \ 44 NV_PRAMDAC_FP_TG_CONTROL_VSYNC_POS) 45 #define FP_TG_CONTROL_OFF (NV_PRAMDAC_FP_TG_CONTROL_DISPEN_DISABLE | \ 46 NV_PRAMDAC_FP_TG_CONTROL_HSYNC_DISABLE | \ 47 NV_PRAMDAC_FP_TG_CONTROL_VSYNC_DISABLE) 48 49 static inline bool is_fpc_off(uint32_t fpc) 50 { 51 return ((fpc & (FP_TG_CONTROL_ON | FP_TG_CONTROL_OFF)) == 52 FP_TG_CONTROL_OFF); 53 } 54 55 int nv04_dfp_get_bound_head(struct drm_device *dev, struct dcb_output *dcbent) 56 { 57 /* special case of nv_read_tmds to find crtc associated with an output. 58 * this does not give a correct answer for off-chip dvi, but there's no 59 * use for such an answer anyway 60 */ 61 int ramdac = (dcbent->or & DCB_OUTPUT_C) >> 2; 62 63 NVWriteRAMDAC(dev, ramdac, NV_PRAMDAC_FP_TMDS_CONTROL, 64 NV_PRAMDAC_FP_TMDS_CONTROL_WRITE_DISABLE | 0x4); 65 return ((NVReadRAMDAC(dev, ramdac, NV_PRAMDAC_FP_TMDS_DATA) & 0x8) >> 3) ^ ramdac; 66 } 67 68 void nv04_dfp_bind_head(struct drm_device *dev, struct dcb_output *dcbent, 69 int head, bool dl) 70 { 71 /* The BIOS scripts don't do this for us, sadly 72 * Luckily we do know the values ;-) 73 * 74 * head < 0 indicates we wish to force a setting with the overrideval 75 * (for VT restore etc.) 76 */ 77 78 int ramdac = (dcbent->or & DCB_OUTPUT_C) >> 2; 79 uint8_t tmds04 = 0x80; 80 81 if (head != ramdac) 82 tmds04 = 0x88; 83 84 if (dcbent->type == DCB_OUTPUT_LVDS) 85 tmds04 |= 0x01; 86 87 nv_write_tmds(dev, dcbent->or, 0, 0x04, tmds04); 88 89 if (dl) /* dual link */ 90 nv_write_tmds(dev, dcbent->or, 1, 0x04, tmds04 ^ 0x08); 91 } 92 93 void nv04_dfp_disable(struct drm_device *dev, int head) 94 { 95 struct nv04_crtc_reg *crtcstate = nv04_display(dev)->mode_reg.crtc_reg; 96 97 if (NVReadRAMDAC(dev, head, NV_PRAMDAC_FP_TG_CONTROL) & 98 FP_TG_CONTROL_ON) { 99 /* digital remnants must be cleaned before new crtc 100 * values programmed. delay is time for the vga stuff 101 * to realise it's in control again 102 */ 103 NVWriteRAMDAC(dev, head, NV_PRAMDAC_FP_TG_CONTROL, 104 FP_TG_CONTROL_OFF); 105 msleep(50); 106 } 107 /* don't inadvertently turn it on when state written later */ 108 crtcstate[head].fp_control = FP_TG_CONTROL_OFF; 109 crtcstate[head].CRTC[NV_CIO_CRE_LCD__INDEX] &= 110 ~NV_CIO_CRE_LCD_ROUTE_MASK; 111 } 112 113 void nv04_dfp_update_fp_control(struct drm_encoder *encoder, int mode) 114 { 115 struct drm_device *dev = encoder->dev; 116 struct drm_crtc *crtc; 117 struct nouveau_crtc *nv_crtc; 118 uint32_t *fpc; 119 120 if (mode == DRM_MODE_DPMS_ON) { 121 nv_crtc = nouveau_crtc(encoder->crtc); 122 fpc = &nv04_display(dev)->mode_reg.crtc_reg[nv_crtc->index].fp_control; 123 124 if (is_fpc_off(*fpc)) { 125 /* using saved value is ok, as (is_digital && dpms_on && 126 * fp_control==OFF) is (at present) *only* true when 127 * fpc's most recent change was by below "off" code 128 */ 129 *fpc = nv_crtc->dpms_saved_fp_control; 130 } 131 132 nv_crtc->fp_users |= 1 << nouveau_encoder(encoder)->dcb->index; 133 NVWriteRAMDAC(dev, nv_crtc->index, NV_PRAMDAC_FP_TG_CONTROL, *fpc); 134 } else { 135 list_for_each_entry(crtc, &dev->mode_config.crtc_list, head) { 136 nv_crtc = nouveau_crtc(crtc); 137 fpc = &nv04_display(dev)->mode_reg.crtc_reg[nv_crtc->index].fp_control; 138 139 nv_crtc->fp_users &= ~(1 << nouveau_encoder(encoder)->dcb->index); 140 if (!is_fpc_off(*fpc) && !nv_crtc->fp_users) { 141 nv_crtc->dpms_saved_fp_control = *fpc; 142 /* cut the FP output */ 143 *fpc &= ~FP_TG_CONTROL_ON; 144 *fpc |= FP_TG_CONTROL_OFF; 145 NVWriteRAMDAC(dev, nv_crtc->index, 146 NV_PRAMDAC_FP_TG_CONTROL, *fpc); 147 } 148 } 149 } 150 } 151 152 static struct drm_encoder *get_tmds_slave(struct drm_encoder *encoder) 153 { 154 struct drm_device *dev = encoder->dev; 155 struct dcb_output *dcb = nouveau_encoder(encoder)->dcb; 156 struct drm_encoder *slave; 157 158 if (dcb->type != DCB_OUTPUT_TMDS || dcb->location == DCB_LOC_ON_CHIP) 159 return NULL; 160 161 /* Some BIOSes (e.g. the one in a Quadro FX1000) report several 162 * TMDS transmitters at the same I2C address, in the same I2C 163 * bus. This can still work because in that case one of them is 164 * always hard-wired to a reasonable configuration using straps, 165 * and the other one needs to be programmed. 166 * 167 * I don't think there's a way to know which is which, even the 168 * blob programs the one exposed via I2C for *both* heads, so 169 * let's do the same. 170 */ 171 list_for_each_entry(slave, &dev->mode_config.encoder_list, head) { 172 struct dcb_output *slave_dcb = nouveau_encoder(slave)->dcb; 173 174 if (slave_dcb->type == DCB_OUTPUT_TMDS && get_slave_funcs(slave) && 175 slave_dcb->tmdsconf.slave_addr == dcb->tmdsconf.slave_addr) 176 return slave; 177 } 178 179 return NULL; 180 } 181 182 static bool nv04_dfp_mode_fixup(struct drm_encoder *encoder, 183 const struct drm_display_mode *mode, 184 struct drm_display_mode *adjusted_mode) 185 { 186 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 187 struct nouveau_connector *nv_connector = 188 nv04_encoder_get_connector(nv_encoder); 189 190 if (!nv_connector->native_mode || 191 nv_connector->scaling_mode == DRM_MODE_SCALE_NONE || 192 mode->hdisplay > nv_connector->native_mode->hdisplay || 193 mode->vdisplay > nv_connector->native_mode->vdisplay) { 194 nv_encoder->mode = *adjusted_mode; 195 196 } else { 197 nv_encoder->mode = *nv_connector->native_mode; 198 adjusted_mode->clock = nv_connector->native_mode->clock; 199 } 200 201 return true; 202 } 203 204 static void nv04_dfp_prepare_sel_clk(struct drm_device *dev, 205 struct nouveau_encoder *nv_encoder, int head) 206 { 207 struct nv04_mode_state *state = &nv04_display(dev)->mode_reg; 208 uint32_t bits1618 = nv_encoder->dcb->or & DCB_OUTPUT_A ? 0x10000 : 0x40000; 209 210 if (nv_encoder->dcb->location != DCB_LOC_ON_CHIP) 211 return; 212 213 /* SEL_CLK is only used on the primary ramdac 214 * It toggles spread spectrum PLL output and sets the bindings of PLLs 215 * to heads on digital outputs 216 */ 217 if (head) 218 state->sel_clk |= bits1618; 219 else 220 state->sel_clk &= ~bits1618; 221 222 /* nv30: 223 * bit 0 NVClk spread spectrum on/off 224 * bit 2 MemClk spread spectrum on/off 225 * bit 4 PixClk1 spread spectrum on/off toggle 226 * bit 6 PixClk2 spread spectrum on/off toggle 227 * 228 * nv40 (observations from bios behaviour and mmio traces): 229 * bits 4&6 as for nv30 230 * bits 5&7 head dependent as for bits 4&6, but do not appear with 4&6; 231 * maybe a different spread mode 232 * bits 8&10 seen on dual-link dvi outputs, purpose unknown (set by POST scripts) 233 * The logic behind turning spread spectrum on/off in the first place, 234 * and which bit-pair to use, is unclear on nv40 (for earlier cards, the fp table 235 * entry has the necessary info) 236 */ 237 if (nv_encoder->dcb->type == DCB_OUTPUT_LVDS && nv04_display(dev)->saved_reg.sel_clk & 0xf0) { 238 int shift = (nv04_display(dev)->saved_reg.sel_clk & 0x50) ? 0 : 1; 239 240 state->sel_clk &= ~0xf0; 241 state->sel_clk |= (head ? 0x40 : 0x10) << shift; 242 } 243 } 244 245 static void nv04_dfp_prepare(struct drm_encoder *encoder) 246 { 247 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 248 const struct drm_encoder_helper_funcs *helper = encoder->helper_private; 249 struct drm_device *dev = encoder->dev; 250 int head = nouveau_crtc(encoder->crtc)->index; 251 struct nv04_crtc_reg *crtcstate = nv04_display(dev)->mode_reg.crtc_reg; 252 uint8_t *cr_lcd = &crtcstate[head].CRTC[NV_CIO_CRE_LCD__INDEX]; 253 uint8_t *cr_lcd_oth = &crtcstate[head ^ 1].CRTC[NV_CIO_CRE_LCD__INDEX]; 254 255 helper->dpms(encoder, DRM_MODE_DPMS_OFF); 256 257 nv04_dfp_prepare_sel_clk(dev, nv_encoder, head); 258 259 *cr_lcd = (*cr_lcd & ~NV_CIO_CRE_LCD_ROUTE_MASK) | 0x3; 260 261 if (nv_two_heads(dev)) { 262 if (nv_encoder->dcb->location == DCB_LOC_ON_CHIP) 263 *cr_lcd |= head ? 0x0 : 0x8; 264 else { 265 *cr_lcd |= (nv_encoder->dcb->or << 4) & 0x30; 266 if (nv_encoder->dcb->type == DCB_OUTPUT_LVDS) 267 *cr_lcd |= 0x30; 268 if ((*cr_lcd & 0x30) == (*cr_lcd_oth & 0x30)) { 269 /* avoid being connected to both crtcs */ 270 *cr_lcd_oth &= ~0x30; 271 NVWriteVgaCrtc(dev, head ^ 1, 272 NV_CIO_CRE_LCD__INDEX, 273 *cr_lcd_oth); 274 } 275 } 276 } 277 } 278 279 280 static void nv04_dfp_mode_set(struct drm_encoder *encoder, 281 struct drm_display_mode *mode, 282 struct drm_display_mode *adjusted_mode) 283 { 284 struct drm_device *dev = encoder->dev; 285 struct nvif_object *device = &nouveau_drm(dev)->client.device.object; 286 struct nouveau_drm *drm = nouveau_drm(dev); 287 struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc); 288 struct nv04_crtc_reg *regp = &nv04_display(dev)->mode_reg.crtc_reg[nv_crtc->index]; 289 struct nv04_crtc_reg *savep = &nv04_display(dev)->saved_reg.crtc_reg[nv_crtc->index]; 290 struct nouveau_connector *nv_connector = nouveau_crtc_connector_get(nv_crtc); 291 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 292 struct drm_display_mode *output_mode = &nv_encoder->mode; 293 struct drm_connector *connector = &nv_connector->base; 294 const struct drm_framebuffer *fb = encoder->crtc->primary->fb; 295 uint32_t mode_ratio, panel_ratio; 296 297 NV_DEBUG(drm, "Output mode on CRTC %d:\n", nv_crtc->index); 298 drm_mode_debug_printmodeline(output_mode); 299 300 /* Initialize the FP registers in this CRTC. */ 301 regp->fp_horiz_regs[FP_DISPLAY_END] = output_mode->hdisplay - 1; 302 regp->fp_horiz_regs[FP_TOTAL] = output_mode->htotal - 1; 303 if (!nv_gf4_disp_arch(dev) || 304 (output_mode->hsync_start - output_mode->hdisplay) >= 305 drm->vbios.digital_min_front_porch) 306 regp->fp_horiz_regs[FP_CRTC] = output_mode->hdisplay; 307 else 308 regp->fp_horiz_regs[FP_CRTC] = output_mode->hsync_start - drm->vbios.digital_min_front_porch - 1; 309 regp->fp_horiz_regs[FP_SYNC_START] = output_mode->hsync_start - 1; 310 regp->fp_horiz_regs[FP_SYNC_END] = output_mode->hsync_end - 1; 311 regp->fp_horiz_regs[FP_VALID_START] = output_mode->hskew; 312 regp->fp_horiz_regs[FP_VALID_END] = output_mode->hdisplay - 1; 313 314 regp->fp_vert_regs[FP_DISPLAY_END] = output_mode->vdisplay - 1; 315 regp->fp_vert_regs[FP_TOTAL] = output_mode->vtotal - 1; 316 regp->fp_vert_regs[FP_CRTC] = output_mode->vtotal - 5 - 1; 317 regp->fp_vert_regs[FP_SYNC_START] = output_mode->vsync_start - 1; 318 regp->fp_vert_regs[FP_SYNC_END] = output_mode->vsync_end - 1; 319 regp->fp_vert_regs[FP_VALID_START] = 0; 320 regp->fp_vert_regs[FP_VALID_END] = output_mode->vdisplay - 1; 321 322 /* bit26: a bit seen on some g7x, no as yet discernable purpose */ 323 regp->fp_control = NV_PRAMDAC_FP_TG_CONTROL_DISPEN_POS | 324 (savep->fp_control & (1 << 26 | NV_PRAMDAC_FP_TG_CONTROL_READ_PROG)); 325 /* Deal with vsync/hsync polarity */ 326 /* LVDS screens do set this, but modes with +ve syncs are very rare */ 327 if (output_mode->flags & DRM_MODE_FLAG_PVSYNC) 328 regp->fp_control |= NV_PRAMDAC_FP_TG_CONTROL_VSYNC_POS; 329 if (output_mode->flags & DRM_MODE_FLAG_PHSYNC) 330 regp->fp_control |= NV_PRAMDAC_FP_TG_CONTROL_HSYNC_POS; 331 /* panel scaling first, as native would get set otherwise */ 332 if (nv_connector->scaling_mode == DRM_MODE_SCALE_NONE || 333 nv_connector->scaling_mode == DRM_MODE_SCALE_CENTER) /* panel handles it */ 334 regp->fp_control |= NV_PRAMDAC_FP_TG_CONTROL_MODE_CENTER; 335 else if (adjusted_mode->hdisplay == output_mode->hdisplay && 336 adjusted_mode->vdisplay == output_mode->vdisplay) /* native mode */ 337 regp->fp_control |= NV_PRAMDAC_FP_TG_CONTROL_MODE_NATIVE; 338 else /* gpu needs to scale */ 339 regp->fp_control |= NV_PRAMDAC_FP_TG_CONTROL_MODE_SCALE; 340 if (nvif_rd32(device, NV_PEXTDEV_BOOT_0) & NV_PEXTDEV_BOOT_0_STRAP_FP_IFACE_12BIT) 341 regp->fp_control |= NV_PRAMDAC_FP_TG_CONTROL_WIDTH_12; 342 if (nv_encoder->dcb->location != DCB_LOC_ON_CHIP && 343 output_mode->clock > 165000) 344 regp->fp_control |= (2 << 24); 345 if (nv_encoder->dcb->type == DCB_OUTPUT_LVDS) { 346 bool duallink = false, dummy; 347 if (nv_connector->edid && 348 nv_connector->type == DCB_CONNECTOR_LVDS_SPWG) { 349 duallink = (((u8 *)nv_connector->edid)[121] == 2); 350 } else { 351 nouveau_bios_parse_lvds_table(dev, output_mode->clock, 352 &duallink, &dummy); 353 } 354 355 if (duallink) 356 regp->fp_control |= (8 << 28); 357 } else 358 if (output_mode->clock > 165000) 359 regp->fp_control |= (8 << 28); 360 361 regp->fp_debug_0 = NV_PRAMDAC_FP_DEBUG_0_YWEIGHT_ROUND | 362 NV_PRAMDAC_FP_DEBUG_0_XWEIGHT_ROUND | 363 NV_PRAMDAC_FP_DEBUG_0_YINTERP_BILINEAR | 364 NV_PRAMDAC_FP_DEBUG_0_XINTERP_BILINEAR | 365 NV_RAMDAC_FP_DEBUG_0_TMDS_ENABLED | 366 NV_PRAMDAC_FP_DEBUG_0_YSCALE_ENABLE | 367 NV_PRAMDAC_FP_DEBUG_0_XSCALE_ENABLE; 368 369 /* We want automatic scaling */ 370 regp->fp_debug_1 = 0; 371 /* This can override HTOTAL and VTOTAL */ 372 regp->fp_debug_2 = 0; 373 374 /* Use 20.12 fixed point format to avoid floats */ 375 mode_ratio = (1 << 12) * adjusted_mode->hdisplay / adjusted_mode->vdisplay; 376 panel_ratio = (1 << 12) * output_mode->hdisplay / output_mode->vdisplay; 377 /* if ratios are equal, SCALE_ASPECT will automatically (and correctly) 378 * get treated the same as SCALE_FULLSCREEN */ 379 if (nv_connector->scaling_mode == DRM_MODE_SCALE_ASPECT && 380 mode_ratio != panel_ratio) { 381 uint32_t diff, scale; 382 bool divide_by_2 = nv_gf4_disp_arch(dev); 383 384 if (mode_ratio < panel_ratio) { 385 /* vertical needs to expand to glass size (automatic) 386 * horizontal needs to be scaled at vertical scale factor 387 * to maintain aspect */ 388 389 scale = (1 << 12) * adjusted_mode->vdisplay / output_mode->vdisplay; 390 regp->fp_debug_1 = NV_PRAMDAC_FP_DEBUG_1_XSCALE_TESTMODE_ENABLE | 391 XLATE(scale, divide_by_2, NV_PRAMDAC_FP_DEBUG_1_XSCALE_VALUE); 392 393 /* restrict area of screen used, horizontally */ 394 diff = output_mode->hdisplay - 395 output_mode->vdisplay * mode_ratio / (1 << 12); 396 regp->fp_horiz_regs[FP_VALID_START] += diff / 2; 397 regp->fp_horiz_regs[FP_VALID_END] -= diff / 2; 398 } 399 400 if (mode_ratio > panel_ratio) { 401 /* horizontal needs to expand to glass size (automatic) 402 * vertical needs to be scaled at horizontal scale factor 403 * to maintain aspect */ 404 405 scale = (1 << 12) * adjusted_mode->hdisplay / output_mode->hdisplay; 406 regp->fp_debug_1 = NV_PRAMDAC_FP_DEBUG_1_YSCALE_TESTMODE_ENABLE | 407 XLATE(scale, divide_by_2, NV_PRAMDAC_FP_DEBUG_1_YSCALE_VALUE); 408 409 /* restrict area of screen used, vertically */ 410 diff = output_mode->vdisplay - 411 (1 << 12) * output_mode->hdisplay / mode_ratio; 412 regp->fp_vert_regs[FP_VALID_START] += diff / 2; 413 regp->fp_vert_regs[FP_VALID_END] -= diff / 2; 414 } 415 } 416 417 /* Output property. */ 418 if ((nv_connector->dithering_mode == DITHERING_MODE_ON) || 419 (nv_connector->dithering_mode == DITHERING_MODE_AUTO && 420 fb->format->depth > connector->display_info.bpc * 3)) { 421 if (drm->client.device.info.chipset == 0x11) 422 regp->dither = savep->dither | 0x00010000; 423 else { 424 int i; 425 regp->dither = savep->dither | 0x00000001; 426 for (i = 0; i < 3; i++) { 427 regp->dither_regs[i] = 0xe4e4e4e4; 428 regp->dither_regs[i + 3] = 0x44444444; 429 } 430 } 431 } else { 432 if (drm->client.device.info.chipset != 0x11) { 433 /* reset them */ 434 int i; 435 for (i = 0; i < 3; i++) { 436 regp->dither_regs[i] = savep->dither_regs[i]; 437 regp->dither_regs[i + 3] = savep->dither_regs[i + 3]; 438 } 439 } 440 regp->dither = savep->dither; 441 } 442 443 regp->fp_margin_color = 0; 444 } 445 446 static void nv04_dfp_commit(struct drm_encoder *encoder) 447 { 448 struct drm_device *dev = encoder->dev; 449 struct nouveau_drm *drm = nouveau_drm(dev); 450 const struct drm_encoder_helper_funcs *helper = encoder->helper_private; 451 struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc); 452 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 453 struct dcb_output *dcbe = nv_encoder->dcb; 454 int head = nouveau_crtc(encoder->crtc)->index; 455 struct drm_encoder *slave_encoder; 456 457 if (dcbe->type == DCB_OUTPUT_TMDS) 458 run_tmds_table(dev, dcbe, head, nv_encoder->mode.clock); 459 else if (dcbe->type == DCB_OUTPUT_LVDS) 460 call_lvds_script(dev, dcbe, head, LVDS_RESET, nv_encoder->mode.clock); 461 462 /* update fp_control state for any changes made by scripts, 463 * so correct value is written at DPMS on */ 464 nv04_display(dev)->mode_reg.crtc_reg[head].fp_control = 465 NVReadRAMDAC(dev, head, NV_PRAMDAC_FP_TG_CONTROL); 466 467 /* This could use refinement for flatpanels, but it should work this way */ 468 if (drm->client.device.info.chipset < 0x44) 469 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + nv04_dac_output_offset(encoder), 0xf0000000); 470 else 471 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_TEST_CONTROL + nv04_dac_output_offset(encoder), 0x00100000); 472 473 /* Init external transmitters */ 474 slave_encoder = get_tmds_slave(encoder); 475 if (slave_encoder) 476 get_slave_funcs(slave_encoder)->mode_set( 477 slave_encoder, &nv_encoder->mode, &nv_encoder->mode); 478 479 helper->dpms(encoder, DRM_MODE_DPMS_ON); 480 481 NV_DEBUG(drm, "Output %s is running on CRTC %d using output %c\n", 482 nv04_encoder_get_connector(nv_encoder)->base.name, 483 nv_crtc->index, '@' + ffs(nv_encoder->dcb->or)); 484 } 485 486 static void nv04_dfp_update_backlight(struct drm_encoder *encoder, int mode) 487 { 488 #ifdef __powerpc__ 489 struct drm_device *dev = encoder->dev; 490 struct nvif_object *device = &nouveau_drm(dev)->client.device.object; 491 492 /* BIOS scripts usually take care of the backlight, thanks 493 * Apple for your consistency. 494 */ 495 if (dev->pdev->device == 0x0174 || dev->pdev->device == 0x0179 || 496 dev->pdev->device == 0x0189 || dev->pdev->device == 0x0329) { 497 if (mode == DRM_MODE_DPMS_ON) { 498 nvif_mask(device, NV_PBUS_DEBUG_DUALHEAD_CTL, 1 << 31, 1 << 31); 499 nvif_mask(device, NV_PCRTC_GPIO_EXT, 3, 1); 500 } else { 501 nvif_mask(device, NV_PBUS_DEBUG_DUALHEAD_CTL, 1 << 31, 0); 502 nvif_mask(device, NV_PCRTC_GPIO_EXT, 3, 0); 503 } 504 } 505 #endif 506 } 507 508 static inline bool is_powersaving_dpms(int mode) 509 { 510 return mode != DRM_MODE_DPMS_ON && mode != NV_DPMS_CLEARED; 511 } 512 513 static void nv04_lvds_dpms(struct drm_encoder *encoder, int mode) 514 { 515 struct drm_device *dev = encoder->dev; 516 struct drm_crtc *crtc = encoder->crtc; 517 struct nouveau_drm *drm = nouveau_drm(dev); 518 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 519 bool was_powersaving = is_powersaving_dpms(nv_encoder->last_dpms); 520 521 if (nv_encoder->last_dpms == mode) 522 return; 523 nv_encoder->last_dpms = mode; 524 525 NV_DEBUG(drm, "Setting dpms mode %d on lvds encoder (output %d)\n", 526 mode, nv_encoder->dcb->index); 527 528 if (was_powersaving && is_powersaving_dpms(mode)) 529 return; 530 531 if (nv_encoder->dcb->lvdsconf.use_power_scripts) { 532 /* when removing an output, crtc may not be set, but PANEL_OFF 533 * must still be run 534 */ 535 int head = crtc ? nouveau_crtc(crtc)->index : 536 nv04_dfp_get_bound_head(dev, nv_encoder->dcb); 537 538 if (mode == DRM_MODE_DPMS_ON) { 539 call_lvds_script(dev, nv_encoder->dcb, head, 540 LVDS_PANEL_ON, nv_encoder->mode.clock); 541 } else 542 /* pxclk of 0 is fine for PANEL_OFF, and for a 543 * disconnected LVDS encoder there is no native_mode 544 */ 545 call_lvds_script(dev, nv_encoder->dcb, head, 546 LVDS_PANEL_OFF, 0); 547 } 548 549 nv04_dfp_update_backlight(encoder, mode); 550 nv04_dfp_update_fp_control(encoder, mode); 551 552 if (mode == DRM_MODE_DPMS_ON) 553 nv04_dfp_prepare_sel_clk(dev, nv_encoder, nouveau_crtc(crtc)->index); 554 else { 555 nv04_display(dev)->mode_reg.sel_clk = NVReadRAMDAC(dev, 0, NV_PRAMDAC_SEL_CLK); 556 nv04_display(dev)->mode_reg.sel_clk &= ~0xf0; 557 } 558 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_SEL_CLK, nv04_display(dev)->mode_reg.sel_clk); 559 } 560 561 static void nv04_tmds_dpms(struct drm_encoder *encoder, int mode) 562 { 563 struct nouveau_drm *drm = nouveau_drm(encoder->dev); 564 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 565 566 if (nv_encoder->last_dpms == mode) 567 return; 568 nv_encoder->last_dpms = mode; 569 570 NV_DEBUG(drm, "Setting dpms mode %d on tmds encoder (output %d)\n", 571 mode, nv_encoder->dcb->index); 572 573 nv04_dfp_update_backlight(encoder, mode); 574 nv04_dfp_update_fp_control(encoder, mode); 575 } 576 577 static void nv04_dfp_save(struct drm_encoder *encoder) 578 { 579 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 580 struct drm_device *dev = encoder->dev; 581 582 if (nv_two_heads(dev)) 583 nv_encoder->restore.head = 584 nv04_dfp_get_bound_head(dev, nv_encoder->dcb); 585 } 586 587 static void nv04_dfp_restore(struct drm_encoder *encoder) 588 { 589 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 590 struct drm_device *dev = encoder->dev; 591 int head = nv_encoder->restore.head; 592 593 if (nv_encoder->dcb->type == DCB_OUTPUT_LVDS) { 594 struct nouveau_connector *connector = 595 nv04_encoder_get_connector(nv_encoder); 596 597 if (connector && connector->native_mode) 598 call_lvds_script(dev, nv_encoder->dcb, head, 599 LVDS_PANEL_ON, 600 connector->native_mode->clock); 601 602 } else if (nv_encoder->dcb->type == DCB_OUTPUT_TMDS) { 603 int clock = nouveau_hw_pllvals_to_clk 604 (&nv04_display(dev)->saved_reg.crtc_reg[head].pllvals); 605 606 run_tmds_table(dev, nv_encoder->dcb, head, clock); 607 } 608 609 nv_encoder->last_dpms = NV_DPMS_CLEARED; 610 } 611 612 static void nv04_dfp_destroy(struct drm_encoder *encoder) 613 { 614 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 615 616 if (get_slave_funcs(encoder)) 617 get_slave_funcs(encoder)->destroy(encoder); 618 619 drm_encoder_cleanup(encoder); 620 kfree(nv_encoder); 621 } 622 623 static void nv04_tmds_slave_init(struct drm_encoder *encoder) 624 { 625 struct drm_device *dev = encoder->dev; 626 struct dcb_output *dcb = nouveau_encoder(encoder)->dcb; 627 struct nouveau_drm *drm = nouveau_drm(dev); 628 struct nvkm_i2c *i2c = nvxx_i2c(&drm->client.device); 629 struct nvkm_i2c_bus *bus = nvkm_i2c_bus_find(i2c, NVKM_I2C_BUS_PRI); 630 struct nvkm_i2c_bus_probe info[] = { 631 { 632 { 633 .type = "sil164", 634 .addr = (dcb->tmdsconf.slave_addr == 0x7 ? 0x3a : 0x38), 635 .platform_data = &(struct sil164_encoder_params) { 636 SIL164_INPUT_EDGE_RISING 637 } 638 }, 0 639 }, 640 { } 641 }; 642 int type; 643 644 if (!nv_gf4_disp_arch(dev) || !bus || get_tmds_slave(encoder)) 645 return; 646 647 type = nvkm_i2c_bus_probe(bus, "TMDS transmitter", info, NULL, NULL); 648 if (type < 0) 649 return; 650 651 drm_i2c_encoder_init(dev, to_encoder_slave(encoder), 652 &bus->i2c, &info[type].dev); 653 } 654 655 static const struct drm_encoder_helper_funcs nv04_lvds_helper_funcs = { 656 .dpms = nv04_lvds_dpms, 657 .mode_fixup = nv04_dfp_mode_fixup, 658 .prepare = nv04_dfp_prepare, 659 .commit = nv04_dfp_commit, 660 .mode_set = nv04_dfp_mode_set, 661 .detect = NULL, 662 }; 663 664 static const struct drm_encoder_helper_funcs nv04_tmds_helper_funcs = { 665 .dpms = nv04_tmds_dpms, 666 .mode_fixup = nv04_dfp_mode_fixup, 667 .prepare = nv04_dfp_prepare, 668 .commit = nv04_dfp_commit, 669 .mode_set = nv04_dfp_mode_set, 670 .detect = NULL, 671 }; 672 673 static const struct drm_encoder_funcs nv04_dfp_funcs = { 674 .destroy = nv04_dfp_destroy, 675 }; 676 677 int 678 nv04_dfp_create(struct drm_connector *connector, struct dcb_output *entry) 679 { 680 const struct drm_encoder_helper_funcs *helper; 681 struct nouveau_encoder *nv_encoder = NULL; 682 struct drm_encoder *encoder; 683 int type; 684 685 switch (entry->type) { 686 case DCB_OUTPUT_TMDS: 687 type = DRM_MODE_ENCODER_TMDS; 688 helper = &nv04_tmds_helper_funcs; 689 break; 690 case DCB_OUTPUT_LVDS: 691 type = DRM_MODE_ENCODER_LVDS; 692 helper = &nv04_lvds_helper_funcs; 693 break; 694 default: 695 return -EINVAL; 696 } 697 698 nv_encoder = kzalloc(sizeof(*nv_encoder), GFP_KERNEL); 699 if (!nv_encoder) 700 return -ENOMEM; 701 702 nv_encoder->enc_save = nv04_dfp_save; 703 nv_encoder->enc_restore = nv04_dfp_restore; 704 705 encoder = to_drm_encoder(nv_encoder); 706 707 nv_encoder->dcb = entry; 708 nv_encoder->or = ffs(entry->or) - 1; 709 710 drm_encoder_init(connector->dev, encoder, &nv04_dfp_funcs, type, NULL); 711 drm_encoder_helper_add(encoder, helper); 712 713 encoder->possible_crtcs = entry->heads; 714 encoder->possible_clones = 0; 715 716 if (entry->type == DCB_OUTPUT_TMDS && 717 entry->location != DCB_LOC_ON_CHIP) 718 nv04_tmds_slave_init(encoder); 719 720 drm_connector_attach_encoder(connector, encoder); 721 return 0; 722 } 723