1 /* 2 * Copyright © 2008 Intel Corporation 3 * 2014 Red Hat Inc. 4 * 5 * Permission is hereby granted, free of charge, to any person obtaining a 6 * copy of this software and associated documentation files (the "Software"), 7 * to deal in the Software without restriction, including without limitation 8 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 9 * and/or sell copies of the Software, and to permit persons to whom the 10 * Software is furnished to do so, subject to the following conditions: 11 * 12 * The above copyright notice and this permission notice (including the next 13 * paragraph) shall be included in all copies or substantial portions of the 14 * Software. 15 * 16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING 21 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS 22 * IN THE SOFTWARE. 23 * 24 */ 25 26 #include <drm/drmP.h> 27 #include "i915_drv.h" 28 #include "intel_drv.h" 29 #include <drm/drm_crtc_helper.h> 30 #include <drm/drm_edid.h> 31 32 #if 0 33 static bool intel_dp_mst_compute_config(struct intel_encoder *encoder, 34 struct intel_crtc_config *pipe_config) 35 { 36 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(&encoder->base); 37 struct intel_digital_port *intel_dig_port = intel_mst->primary; 38 struct intel_dp *intel_dp = &intel_dig_port->dp; 39 struct drm_device *dev = encoder->base.dev; 40 int bpp; 41 int lane_count, slots; 42 struct drm_display_mode *adjusted_mode = &pipe_config->adjusted_mode; 43 struct intel_connector *found = NULL, *intel_connector; 44 int mst_pbn; 45 46 pipe_config->dp_encoder_is_mst = true; 47 pipe_config->has_pch_encoder = false; 48 pipe_config->has_dp_encoder = true; 49 bpp = 24; 50 /* 51 * for MST we always configure max link bw - the spec doesn't 52 * seem to suggest we should do otherwise. 53 */ 54 lane_count = drm_dp_max_lane_count(intel_dp->dpcd); 55 intel_dp->link_bw = intel_dp_max_link_bw(intel_dp); 56 intel_dp->lane_count = lane_count; 57 58 pipe_config->pipe_bpp = 24; 59 pipe_config->port_clock = drm_dp_bw_code_to_link_rate(intel_dp->link_bw); 60 61 list_for_each_entry(intel_connector, &dev->mode_config.connector_list, base.head) { 62 if (intel_connector->new_encoder == encoder) { 63 found = intel_connector; 64 break; 65 } 66 } 67 68 if (!found) { 69 DRM_ERROR("can't find connector\n"); 70 return false; 71 } 72 73 mst_pbn = drm_dp_calc_pbn_mode(adjusted_mode->clock, bpp); 74 75 pipe_config->pbn = mst_pbn; 76 slots = drm_dp_find_vcpi_slots(&intel_dp->mst_mgr, mst_pbn); 77 78 intel_link_compute_m_n(bpp, lane_count, 79 adjusted_mode->crtc_clock, 80 pipe_config->port_clock, 81 &pipe_config->dp_m_n); 82 83 pipe_config->dp_m_n.tu = slots; 84 return true; 85 86 } 87 88 static void intel_mst_disable_dp(struct intel_encoder *encoder) 89 { 90 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(&encoder->base); 91 struct intel_digital_port *intel_dig_port = intel_mst->primary; 92 struct intel_dp *intel_dp = &intel_dig_port->dp; 93 int ret; 94 95 DRM_DEBUG_KMS("%d\n", intel_dp->active_mst_links); 96 97 drm_dp_mst_reset_vcpi_slots(&intel_dp->mst_mgr, intel_mst->port); 98 99 ret = drm_dp_update_payload_part1(&intel_dp->mst_mgr); 100 if (ret) { 101 DRM_ERROR("failed to update payload %d\n", ret); 102 } 103 } 104 105 static void intel_mst_post_disable_dp(struct intel_encoder *encoder) 106 { 107 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(&encoder->base); 108 struct intel_digital_port *intel_dig_port = intel_mst->primary; 109 struct intel_dp *intel_dp = &intel_dig_port->dp; 110 111 DRM_DEBUG_KMS("%d\n", intel_dp->active_mst_links); 112 113 /* this can fail */ 114 drm_dp_check_act_status(&intel_dp->mst_mgr); 115 /* and this can also fail */ 116 drm_dp_update_payload_part2(&intel_dp->mst_mgr); 117 118 drm_dp_mst_deallocate_vcpi(&intel_dp->mst_mgr, intel_mst->port); 119 120 intel_dp->active_mst_links--; 121 intel_mst->port = NULL; 122 if (intel_dp->active_mst_links == 0) { 123 intel_dig_port->base.post_disable(&intel_dig_port->base); 124 intel_dp_sink_dpms(intel_dp, DRM_MODE_DPMS_OFF); 125 } 126 } 127 128 static void intel_mst_pre_enable_dp(struct intel_encoder *encoder) 129 { 130 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(&encoder->base); 131 struct intel_digital_port *intel_dig_port = intel_mst->primary; 132 struct intel_dp *intel_dp = &intel_dig_port->dp; 133 struct drm_device *dev = encoder->base.dev; 134 struct drm_i915_private *dev_priv = dev->dev_private; 135 enum port port = intel_dig_port->port; 136 int ret; 137 uint32_t temp; 138 struct intel_connector *found = NULL, *intel_connector; 139 int slots; 140 struct drm_crtc *crtc = encoder->base.crtc; 141 struct intel_crtc *intel_crtc = to_intel_crtc(crtc); 142 143 list_for_each_entry(intel_connector, &dev->mode_config.connector_list, base.head) { 144 if (intel_connector->new_encoder == encoder) { 145 found = intel_connector; 146 break; 147 } 148 } 149 150 if (!found) { 151 DRM_ERROR("can't find connector\n"); 152 return; 153 } 154 155 DRM_DEBUG_KMS("%d\n", intel_dp->active_mst_links); 156 intel_mst->port = found->port; 157 158 if (intel_dp->active_mst_links == 0) { 159 enum port port = intel_ddi_get_encoder_port(encoder); 160 161 I915_WRITE(PORT_CLK_SEL(port), intel_crtc->config.ddi_pll_sel); 162 163 intel_ddi_init_dp_buf_reg(&intel_dig_port->base); 164 165 intel_dp_sink_dpms(intel_dp, DRM_MODE_DPMS_ON); 166 167 168 intel_dp_start_link_train(intel_dp); 169 intel_dp_complete_link_train(intel_dp); 170 intel_dp_stop_link_train(intel_dp); 171 } 172 173 ret = drm_dp_mst_allocate_vcpi(&intel_dp->mst_mgr, 174 intel_mst->port, intel_crtc->config.pbn, &slots); 175 if (ret == false) { 176 DRM_ERROR("failed to allocate vcpi\n"); 177 return; 178 } 179 180 181 intel_dp->active_mst_links++; 182 temp = I915_READ(DP_TP_STATUS(port)); 183 I915_WRITE(DP_TP_STATUS(port), temp); 184 185 ret = drm_dp_update_payload_part1(&intel_dp->mst_mgr); 186 } 187 188 static void intel_mst_enable_dp(struct intel_encoder *encoder) 189 { 190 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(&encoder->base); 191 struct intel_digital_port *intel_dig_port = intel_mst->primary; 192 struct intel_dp *intel_dp = &intel_dig_port->dp; 193 struct drm_device *dev = intel_dig_port->base.base.dev; 194 struct drm_i915_private *dev_priv = dev->dev_private; 195 enum port port = intel_dig_port->port; 196 int ret; 197 198 DRM_DEBUG_KMS("%d\n", intel_dp->active_mst_links); 199 200 if (wait_for((I915_READ(DP_TP_STATUS(port)) & DP_TP_STATUS_ACT_SENT), 201 1)) 202 DRM_ERROR("Timed out waiting for ACT sent\n"); 203 204 ret = drm_dp_check_act_status(&intel_dp->mst_mgr); 205 206 ret = drm_dp_update_payload_part2(&intel_dp->mst_mgr); 207 } 208 209 static bool intel_dp_mst_enc_get_hw_state(struct intel_encoder *encoder, 210 enum pipe *pipe) 211 { 212 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(&encoder->base); 213 *pipe = intel_mst->pipe; 214 if (intel_mst->port) 215 return true; 216 return false; 217 } 218 219 static void intel_dp_mst_enc_get_config(struct intel_encoder *encoder, 220 struct intel_crtc_config *pipe_config) 221 { 222 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(&encoder->base); 223 struct intel_digital_port *intel_dig_port = intel_mst->primary; 224 struct intel_crtc *crtc = to_intel_crtc(encoder->base.crtc); 225 struct drm_device *dev = encoder->base.dev; 226 struct drm_i915_private *dev_priv = dev->dev_private; 227 enum transcoder cpu_transcoder = crtc->config.cpu_transcoder; 228 u32 temp, flags = 0; 229 230 pipe_config->has_dp_encoder = true; 231 232 temp = I915_READ(TRANS_DDI_FUNC_CTL(cpu_transcoder)); 233 if (temp & TRANS_DDI_PHSYNC) 234 flags |= DRM_MODE_FLAG_PHSYNC; 235 else 236 flags |= DRM_MODE_FLAG_NHSYNC; 237 if (temp & TRANS_DDI_PVSYNC) 238 flags |= DRM_MODE_FLAG_PVSYNC; 239 else 240 flags |= DRM_MODE_FLAG_NVSYNC; 241 242 switch (temp & TRANS_DDI_BPC_MASK) { 243 case TRANS_DDI_BPC_6: 244 pipe_config->pipe_bpp = 18; 245 break; 246 case TRANS_DDI_BPC_8: 247 pipe_config->pipe_bpp = 24; 248 break; 249 case TRANS_DDI_BPC_10: 250 pipe_config->pipe_bpp = 30; 251 break; 252 case TRANS_DDI_BPC_12: 253 pipe_config->pipe_bpp = 36; 254 break; 255 default: 256 break; 257 } 258 pipe_config->adjusted_mode.flags |= flags; 259 intel_dp_get_m_n(crtc, pipe_config); 260 261 intel_ddi_clock_get(&intel_dig_port->base, pipe_config); 262 } 263 264 static int intel_dp_mst_get_ddc_modes(struct drm_connector *connector) 265 { 266 struct intel_connector *intel_connector = to_intel_connector(connector); 267 struct intel_dp *intel_dp = intel_connector->mst_port; 268 struct edid *edid; 269 int ret; 270 271 edid = drm_dp_mst_get_edid(connector, &intel_dp->mst_mgr, intel_connector->port); 272 if (!edid) 273 return 0; 274 275 ret = intel_connector_update_modes(connector, edid); 276 kfree(edid); 277 278 return ret; 279 } 280 281 static enum drm_connector_status 282 intel_mst_port_dp_detect(struct drm_connector *connector) 283 { 284 struct intel_connector *intel_connector = to_intel_connector(connector); 285 struct intel_dp *intel_dp = intel_connector->mst_port; 286 287 return drm_dp_mst_detect_port(&intel_dp->mst_mgr, intel_connector->port); 288 } 289 290 static enum drm_connector_status 291 intel_dp_mst_detect(struct drm_connector *connector, bool force) 292 { 293 enum drm_connector_status status; 294 status = intel_mst_port_dp_detect(connector); 295 return status; 296 } 297 298 static int 299 intel_dp_mst_set_property(struct drm_connector *connector, 300 struct drm_property *property, 301 uint64_t val) 302 { 303 return 0; 304 } 305 306 static void 307 intel_dp_mst_connector_destroy(struct drm_connector *connector) 308 { 309 struct intel_connector *intel_connector = to_intel_connector(connector); 310 311 if (!IS_ERR_OR_NULL(intel_connector->edid)) 312 kfree(intel_connector->edid); 313 314 drm_connector_cleanup(connector); 315 kfree(connector); 316 } 317 318 static const struct drm_connector_funcs intel_dp_mst_connector_funcs = { 319 .dpms = intel_connector_dpms, 320 .detect = intel_dp_mst_detect, 321 .fill_modes = drm_helper_probe_single_connector_modes, 322 .set_property = intel_dp_mst_set_property, 323 .destroy = intel_dp_mst_connector_destroy, 324 }; 325 326 static int intel_dp_mst_get_modes(struct drm_connector *connector) 327 { 328 return intel_dp_mst_get_ddc_modes(connector); 329 } 330 331 static enum drm_mode_status 332 intel_dp_mst_mode_valid(struct drm_connector *connector, 333 struct drm_display_mode *mode) 334 { 335 /* TODO - validate mode against available PBN for link */ 336 if (mode->clock < 10000) 337 return MODE_CLOCK_LOW; 338 339 if (mode->flags & DRM_MODE_FLAG_DBLCLK) 340 return MODE_H_ILLEGAL; 341 342 return MODE_OK; 343 } 344 345 static struct drm_encoder *intel_mst_best_encoder(struct drm_connector *connector) 346 { 347 struct intel_connector *intel_connector = to_intel_connector(connector); 348 struct intel_dp *intel_dp = intel_connector->mst_port; 349 return &intel_dp->mst_encoders[0]->base.base; 350 } 351 352 static const struct drm_connector_helper_funcs intel_dp_mst_connector_helper_funcs = { 353 .get_modes = intel_dp_mst_get_modes, 354 .mode_valid = intel_dp_mst_mode_valid, 355 .best_encoder = intel_mst_best_encoder, 356 }; 357 #endif 358 359 static void intel_dp_mst_encoder_destroy(struct drm_encoder *encoder) 360 { 361 struct intel_dp_mst_encoder *intel_mst = enc_to_mst(encoder); 362 363 drm_encoder_cleanup(encoder); 364 kfree(intel_mst); 365 } 366 367 static const struct drm_encoder_funcs intel_dp_mst_enc_funcs = { 368 .destroy = intel_dp_mst_encoder_destroy, 369 }; 370 371 #if 0 372 static bool intel_dp_mst_get_hw_state(struct intel_connector *connector) 373 { 374 if (connector->encoder) { 375 enum pipe pipe; 376 if (!connector->encoder->get_hw_state(connector->encoder, &pipe)) 377 return false; 378 return true; 379 } 380 return false; 381 } 382 383 static void intel_connector_add_to_fbdev(struct intel_connector *connector) 384 { 385 #ifdef CONFIG_DRM_I915_FBDEV 386 struct drm_i915_private *dev_priv = to_i915(connector->base.dev); 387 drm_fb_helper_add_one_connector(&dev_priv->fbdev->helper, &connector->base); 388 #endif 389 } 390 391 static void intel_connector_remove_from_fbdev(struct intel_connector *connector) 392 { 393 #ifdef CONFIG_DRM_I915_FBDEV 394 struct drm_i915_private *dev_priv = to_i915(connector->base.dev); 395 drm_fb_helper_remove_one_connector(&dev_priv->fbdev->helper, &connector->base); 396 #endif 397 } 398 399 static struct drm_connector *intel_dp_add_mst_connector(struct drm_dp_mst_topology_mgr *mgr, struct drm_dp_mst_port *port, char *pathprop) 400 { 401 struct intel_dp *intel_dp = container_of(mgr, struct intel_dp, mst_mgr); 402 struct intel_digital_port *intel_dig_port = dp_to_dig_port(intel_dp); 403 struct drm_device *dev = intel_dig_port->base.base.dev; 404 struct intel_connector *intel_connector; 405 struct drm_connector *connector; 406 int i; 407 408 intel_connector = kzalloc(sizeof(*intel_connector), GFP_KERNEL); 409 if (!intel_connector) 410 return NULL; 411 412 connector = &intel_connector->base; 413 drm_connector_init(dev, connector, &intel_dp_mst_connector_funcs, DRM_MODE_CONNECTOR_DisplayPort); 414 drm_connector_helper_add(connector, &intel_dp_mst_connector_helper_funcs); 415 416 intel_connector->unregister = intel_connector_unregister; 417 intel_connector->get_hw_state = intel_dp_mst_get_hw_state; 418 intel_connector->mst_port = intel_dp; 419 intel_connector->port = port; 420 421 for (i = PIPE_A; i <= PIPE_C; i++) { 422 drm_mode_connector_attach_encoder(&intel_connector->base, 423 &intel_dp->mst_encoders[i]->base.base); 424 } 425 intel_dp_add_properties(intel_dp, connector); 426 427 drm_object_attach_property(&connector->base, dev->mode_config.path_property, 0); 428 drm_mode_connector_set_path_property(connector, pathprop); 429 drm_reinit_primary_mode_group(dev); 430 mutex_lock(&dev->mode_config.mutex); 431 intel_connector_add_to_fbdev(intel_connector); 432 mutex_unlock(&dev->mode_config.mutex); 433 drm_connector_register(&intel_connector->base); 434 return connector; 435 } 436 437 static void intel_dp_destroy_mst_connector(struct drm_dp_mst_topology_mgr *mgr, 438 struct drm_connector *connector) 439 { 440 struct intel_connector *intel_connector = to_intel_connector(connector); 441 struct drm_device *dev = connector->dev; 442 /* need to nuke the connector */ 443 mutex_lock(&dev->mode_config.mutex); 444 intel_connector_dpms(connector, DRM_MODE_DPMS_OFF); 445 mutex_unlock(&dev->mode_config.mutex); 446 447 intel_connector->unregister(intel_connector); 448 449 mutex_lock(&dev->mode_config.mutex); 450 intel_connector_remove_from_fbdev(intel_connector); 451 drm_connector_cleanup(connector); 452 mutex_unlock(&dev->mode_config.mutex); 453 454 drm_reinit_primary_mode_group(dev); 455 456 kfree(intel_connector); 457 DRM_DEBUG_KMS("\n"); 458 } 459 460 static void intel_dp_mst_hotplug(struct drm_dp_mst_topology_mgr *mgr) 461 { 462 struct intel_dp *intel_dp = container_of(mgr, struct intel_dp, mst_mgr); 463 struct intel_digital_port *intel_dig_port = dp_to_dig_port(intel_dp); 464 struct drm_device *dev = intel_dig_port->base.base.dev; 465 466 drm_kms_helper_hotplug_event(dev); 467 } 468 469 static struct drm_dp_mst_topology_cbs mst_cbs = { 470 .add_connector = intel_dp_add_mst_connector, 471 .destroy_connector = intel_dp_destroy_mst_connector, 472 .hotplug = intel_dp_mst_hotplug, 473 }; 474 475 static struct intel_dp_mst_encoder * 476 intel_dp_create_fake_mst_encoder(struct intel_digital_port *intel_dig_port, enum pipe pipe) 477 { 478 struct intel_dp_mst_encoder *intel_mst; 479 struct intel_encoder *intel_encoder; 480 struct drm_device *dev = intel_dig_port->base.base.dev; 481 482 intel_mst = kzalloc(sizeof(*intel_mst), GFP_KERNEL); 483 484 if (!intel_mst) 485 return NULL; 486 487 intel_mst->pipe = pipe; 488 intel_encoder = &intel_mst->base; 489 intel_mst->primary = intel_dig_port; 490 491 drm_encoder_init(dev, &intel_encoder->base, &intel_dp_mst_enc_funcs, 492 DRM_MODE_ENCODER_DPMST); 493 494 intel_encoder->type = INTEL_OUTPUT_DP_MST; 495 intel_encoder->crtc_mask = 0x7; 496 intel_encoder->cloneable = 0; 497 498 intel_encoder->compute_config = intel_dp_mst_compute_config; 499 intel_encoder->disable = intel_mst_disable_dp; 500 intel_encoder->post_disable = intel_mst_post_disable_dp; 501 intel_encoder->pre_enable = intel_mst_pre_enable_dp; 502 intel_encoder->enable = intel_mst_enable_dp; 503 intel_encoder->get_hw_state = intel_dp_mst_enc_get_hw_state; 504 intel_encoder->get_config = intel_dp_mst_enc_get_config; 505 506 return intel_mst; 507 508 } 509 510 static bool 511 intel_dp_create_fake_mst_encoders(struct intel_digital_port *intel_dig_port) 512 { 513 int i; 514 struct intel_dp *intel_dp = &intel_dig_port->dp; 515 516 for (i = PIPE_A; i <= PIPE_C; i++) 517 intel_dp->mst_encoders[i] = intel_dp_create_fake_mst_encoder(intel_dig_port, i); 518 return true; 519 } 520 #endif 521 522 int 523 intel_dp_mst_encoder_init(struct intel_digital_port *intel_dig_port, int conn_base_id) 524 { 525 struct intel_dp *intel_dp = &intel_dig_port->dp; 526 #if 0 527 struct drm_device *dev = intel_dig_port->base.base.dev; 528 int ret; 529 530 intel_dp->can_mst = true; 531 intel_dp->mst_mgr.cbs = &mst_cbs; 532 533 /* create encoders */ 534 intel_dp_create_fake_mst_encoders(intel_dig_port); 535 ret = drm_dp_mst_topology_mgr_init(&intel_dp->mst_mgr, dev->dev, &intel_dp->aux, 16, 3, conn_base_id); 536 if (ret) { 537 intel_dp->can_mst = false; 538 return ret; 539 } 540 #endif 541 intel_dp->can_mst = false; 542 return 0; 543 } 544 545 void 546 intel_dp_mst_encoder_cleanup(struct intel_digital_port *intel_dig_port) 547 { 548 struct intel_dp *intel_dp = &intel_dig_port->dp; 549 550 if (!intel_dp->can_mst) 551 return; 552 553 #if 0 554 drm_dp_mst_topology_mgr_destroy(&intel_dp->mst_mgr); 555 #endif 556 /* encoders will get killed by normal cleanup */ 557 } 558