sys/dev/drm/i915/intel_dp_mst.c

   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 }