1 /* 2 * Copyright (C) 2009 Francisco Jerez. 3 * All Rights Reserved. 4 * 5 * Permission is hereby granted, free of charge, to any person obtaining 6 * a copy of this software and associated documentation files (the 7 * "Software"), to deal in the Software without restriction, including 8 * without limitation the rights to use, copy, modify, merge, publish, 9 * distribute, sublicense, and/or sell copies of the Software, and to 10 * permit persons to whom the Software is furnished to do so, subject to 11 * the following conditions: 12 * 13 * The above copyright notice and this permission notice (including the 14 * next paragraph) shall be included in all copies or substantial 15 * portions of the Software. 16 * 17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 18 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 19 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. 20 * IN NO EVENT SHALL THE COPYRIGHT OWNER(S) AND/OR ITS SUPPLIERS BE 21 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION 22 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION 23 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. 24 * 25 */ 26 27 #include <drm/drmP.h> 28 #include "nouveau_drm.h" 29 #include "nouveau_reg.h" 30 #include "nouveau_encoder.h" 31 #include "nouveau_connector.h" 32 #include "nouveau_crtc.h" 33 #include "hw.h" 34 #include <drm/drm_crtc_helper.h> 35 36 #include <drm/i2c/ch7006.h> 37 38 static struct nvkm_i2c_bus_probe nv04_tv_encoder_info[] = { 39 { 40 { 41 I2C_BOARD_INFO("ch7006", 0x75), 42 .platform_data = &(struct ch7006_encoder_params) { 43 CH7006_FORMAT_RGB24m12I, CH7006_CLOCK_MASTER, 44 0, 0, 0, 45 CH7006_SYNC_SLAVE, CH7006_SYNC_SEPARATED, 46 CH7006_POUT_3_3V, CH7006_ACTIVE_HSYNC 47 } 48 }, 49 0 50 }, 51 { } 52 }; 53 54 int nv04_tv_identify(struct drm_device *dev, int i2c_index) 55 { 56 struct nouveau_drm *drm = nouveau_drm(dev); 57 struct nvkm_i2c *i2c = nvxx_i2c(&drm->device); 58 struct nvkm_i2c_bus *bus = nvkm_i2c_bus_find(i2c, i2c_index); 59 if (bus) { 60 return nvkm_i2c_bus_probe(bus, "TV encoder", 61 nv04_tv_encoder_info, 62 NULL, NULL); 63 } 64 return -ENODEV; 65 } 66 67 68 #define PLLSEL_TV_CRTC1_MASK \ 69 (NV_PRAMDAC_PLL_COEFF_SELECT_TV_VSCLK1 \ 70 | NV_PRAMDAC_PLL_COEFF_SELECT_TV_PCLK1) 71 #define PLLSEL_TV_CRTC2_MASK \ 72 (NV_PRAMDAC_PLL_COEFF_SELECT_TV_VSCLK2 \ 73 | NV_PRAMDAC_PLL_COEFF_SELECT_TV_PCLK2) 74 75 static void nv04_tv_dpms(struct drm_encoder *encoder, int mode) 76 { 77 struct drm_device *dev = encoder->dev; 78 struct nouveau_drm *drm = nouveau_drm(dev); 79 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 80 struct nv04_mode_state *state = &nv04_display(dev)->mode_reg; 81 uint8_t crtc1A; 82 83 NV_DEBUG(drm, "Setting dpms mode %d on TV encoder (output %d)\n", 84 mode, nv_encoder->dcb->index); 85 86 state->pllsel &= ~(PLLSEL_TV_CRTC1_MASK | PLLSEL_TV_CRTC2_MASK); 87 88 if (mode == DRM_MODE_DPMS_ON) { 89 int head = nouveau_crtc(encoder->crtc)->index; 90 crtc1A = NVReadVgaCrtc(dev, head, NV_CIO_CRE_RPC1_INDEX); 91 92 state->pllsel |= head ? PLLSEL_TV_CRTC2_MASK : 93 PLLSEL_TV_CRTC1_MASK; 94 95 /* Inhibit hsync */ 96 crtc1A |= 0x80; 97 98 NVWriteVgaCrtc(dev, head, NV_CIO_CRE_RPC1_INDEX, crtc1A); 99 } 100 101 NVWriteRAMDAC(dev, 0, NV_PRAMDAC_PLL_COEFF_SELECT, state->pllsel); 102 103 get_slave_funcs(encoder)->dpms(encoder, mode); 104 } 105 106 static void nv04_tv_bind(struct drm_device *dev, int head, bool bind) 107 { 108 struct nv04_crtc_reg *state = &nv04_display(dev)->mode_reg.crtc_reg[head]; 109 110 state->tv_setup = 0; 111 112 if (bind) 113 state->CRTC[NV_CIO_CRE_49] |= 0x10; 114 else 115 state->CRTC[NV_CIO_CRE_49] &= ~0x10; 116 117 NVWriteVgaCrtc(dev, head, NV_CIO_CRE_LCD__INDEX, 118 state->CRTC[NV_CIO_CRE_LCD__INDEX]); 119 NVWriteVgaCrtc(dev, head, NV_CIO_CRE_49, 120 state->CRTC[NV_CIO_CRE_49]); 121 NVWriteRAMDAC(dev, head, NV_PRAMDAC_TV_SETUP, 122 state->tv_setup); 123 } 124 125 static void nv04_tv_prepare(struct drm_encoder *encoder) 126 { 127 struct drm_device *dev = encoder->dev; 128 int head = nouveau_crtc(encoder->crtc)->index; 129 const struct drm_encoder_helper_funcs *helper = encoder->helper_private; 130 131 helper->dpms(encoder, DRM_MODE_DPMS_OFF); 132 133 nv04_dfp_disable(dev, head); 134 135 if (nv_two_heads(dev)) 136 nv04_tv_bind(dev, head ^ 1, false); 137 138 nv04_tv_bind(dev, head, true); 139 } 140 141 static void nv04_tv_mode_set(struct drm_encoder *encoder, 142 struct drm_display_mode *mode, 143 struct drm_display_mode *adjusted_mode) 144 { 145 struct drm_device *dev = encoder->dev; 146 struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc); 147 struct nv04_crtc_reg *regp = &nv04_display(dev)->mode_reg.crtc_reg[nv_crtc->index]; 148 149 regp->tv_htotal = adjusted_mode->htotal; 150 regp->tv_vtotal = adjusted_mode->vtotal; 151 152 /* These delay the TV signals with respect to the VGA port, 153 * they might be useful if we ever allow a CRTC to drive 154 * multiple outputs. 155 */ 156 regp->tv_hskew = 1; 157 regp->tv_hsync_delay = 1; 158 regp->tv_hsync_delay2 = 64; 159 regp->tv_vskew = 1; 160 regp->tv_vsync_delay = 1; 161 162 get_slave_funcs(encoder)->mode_set(encoder, mode, adjusted_mode); 163 } 164 165 static void nv04_tv_commit(struct drm_encoder *encoder) 166 { 167 struct nouveau_encoder *nv_encoder = nouveau_encoder(encoder); 168 struct drm_device *dev = encoder->dev; 169 struct nouveau_drm *drm = nouveau_drm(dev); 170 struct nouveau_crtc *nv_crtc = nouveau_crtc(encoder->crtc); 171 const struct drm_encoder_helper_funcs *helper = encoder->helper_private; 172 173 helper->dpms(encoder, DRM_MODE_DPMS_ON); 174 175 NV_DEBUG(drm, "Output %s is running on CRTC %d using output %c\n", 176 nouveau_encoder_connector_get(nv_encoder)->base.name, 177 nv_crtc->index, '@' + ffs(nv_encoder->dcb->or)); 178 } 179 180 static void nv04_tv_destroy(struct drm_encoder *encoder) 181 { 182 get_slave_funcs(encoder)->destroy(encoder); 183 drm_encoder_cleanup(encoder); 184 185 kfree(encoder->helper_private); 186 kfree(nouveau_encoder(encoder)); 187 } 188 189 static const struct drm_encoder_funcs nv04_tv_funcs = { 190 .destroy = nv04_tv_destroy, 191 }; 192 193 static const struct drm_encoder_helper_funcs nv04_tv_helper_funcs = { 194 .dpms = nv04_tv_dpms, 195 .mode_fixup = drm_i2c_encoder_mode_fixup, 196 .prepare = nv04_tv_prepare, 197 .commit = nv04_tv_commit, 198 .mode_set = nv04_tv_mode_set, 199 .detect = drm_i2c_encoder_detect, 200 }; 201 202 int 203 nv04_tv_create(struct drm_connector *connector, struct dcb_output *entry) 204 { 205 struct nouveau_encoder *nv_encoder; 206 struct drm_encoder *encoder; 207 struct drm_device *dev = connector->dev; 208 struct nouveau_drm *drm = nouveau_drm(dev); 209 struct nvkm_i2c *i2c = nvxx_i2c(&drm->device); 210 struct nvkm_i2c_bus *bus = nvkm_i2c_bus_find(i2c, entry->i2c_index); 211 int type, ret; 212 213 /* Ensure that we can talk to this encoder */ 214 type = nv04_tv_identify(dev, entry->i2c_index); 215 if (type < 0) 216 return type; 217 218 /* Allocate the necessary memory */ 219 nv_encoder = kzalloc(sizeof(*nv_encoder), GFP_KERNEL); 220 if (!nv_encoder) 221 return -ENOMEM; 222 223 /* Initialize the common members */ 224 encoder = to_drm_encoder(nv_encoder); 225 226 drm_encoder_init(dev, encoder, &nv04_tv_funcs, DRM_MODE_ENCODER_TVDAC, 227 NULL); 228 drm_encoder_helper_add(encoder, &nv04_tv_helper_funcs); 229 230 nv_encoder->enc_save = drm_i2c_encoder_save; 231 nv_encoder->enc_restore = drm_i2c_encoder_restore; 232 233 encoder->possible_crtcs = entry->heads; 234 encoder->possible_clones = 0; 235 nv_encoder->dcb = entry; 236 nv_encoder->or = ffs(entry->or) - 1; 237 238 /* Run the slave-specific initialization */ 239 ret = drm_i2c_encoder_init(dev, to_encoder_slave(encoder), 240 &bus->i2c, 241 &nv04_tv_encoder_info[type].dev); 242 if (ret < 0) 243 goto fail_cleanup; 244 245 /* Attach it to the specified connector. */ 246 get_slave_funcs(encoder)->create_resources(encoder, connector); 247 drm_mode_connector_attach_encoder(connector, encoder); 248 249 return 0; 250 251 fail_cleanup: 252 drm_encoder_cleanup(encoder); 253 kfree(nv_encoder); 254 return ret; 255 } 256