drivers/gpu/drm/meson/meson_encoder_hdmi.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Copyright (C) 2016 BayLibre, SAS
   4  * Author: Neil Armstrong <[email protected]>
   5  * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
   6  */
   7
   8 #include <linux/clk.h>
   9 #include <linux/component.h>
  10 #include <linux/kernel.h>
  11 #include <linux/module.h>
  12 #include <linux/of.h>
  13 #include <linux/of_graph.h>
  14 #include <linux/of_platform.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/regulator/consumer.h>
  17 #include <linux/reset.h>
  18
  19 #include <media/cec-notifier.h>
  20
  21 #include <drm/drm_atomic_helper.h>
  22 #include <drm/drm_bridge.h>
  23 #include <drm/drm_bridge_connector.h>
  24 #include <drm/drm_device.h>
  25 #include <drm/drm_edid.h>
  26 #include <drm/drm_probe_helper.h>
  27 #include <drm/drm_simple_kms_helper.h>
  28
  29 #include <linux/media-bus-format.h>
  30 #include <linux/videodev2.h>
  31
  32 #include "meson_drv.h"
  33 #include "meson_registers.h"
  34 #include "meson_vclk.h"
  35 #include "meson_venc.h"
  36 #include "meson_encoder_hdmi.h"
  37
  38 struct meson_encoder_hdmi {
  39         struct drm_encoder encoder;
  40         struct drm_bridge bridge;
  41         struct drm_bridge *next_bridge;
  42         struct drm_connector *connector;
  43         struct meson_drm *priv;
  44         unsigned long output_bus_fmt;
  45         struct cec_notifier *cec_notifier;
  46 };
  47
  48 #define bridge_to_meson_encoder_hdmi(x) \
  49         container_of(x, struct meson_encoder_hdmi, bridge)
  50
  51 static int meson_encoder_hdmi_attach(struct drm_bridge *bridge,
  52                                      enum drm_bridge_attach_flags flags)
  53 {
  54         struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
  55
  56         return drm_bridge_attach(bridge->encoder, encoder_hdmi->next_bridge,
  57                                  &encoder_hdmi->bridge, flags);
  58 }
  59
  60 static void meson_encoder_hdmi_detach(struct drm_bridge *bridge)
  61 {
  62         struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
  63
  64         cec_notifier_conn_unregister(encoder_hdmi->cec_notifier);
  65         encoder_hdmi->cec_notifier = NULL;
  66 }
  67
  68 static void meson_encoder_hdmi_set_vclk(struct meson_encoder_hdmi *encoder_hdmi,
  69                                         const struct drm_display_mode *mode)
  70 {
  71         struct meson_drm *priv = encoder_hdmi->priv;
  72         int vic = drm_match_cea_mode(mode);
  73         unsigned int phy_freq;
  74         unsigned int vclk_freq;
  75         unsigned int venc_freq;
  76         unsigned int hdmi_freq;
  77
  78         vclk_freq = mode->clock;
  79
  80         /* For 420, pixel clock is half unlike venc clock */
  81         if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
  82                 vclk_freq /= 2;
  83
  84         /* TMDS clock is pixel_clock * 10 */
  85         phy_freq = vclk_freq * 10;
  86
  87         if (!vic) {
  88                 meson_vclk_setup(priv, MESON_VCLK_TARGET_DMT, phy_freq,
  89                                  vclk_freq, vclk_freq, vclk_freq, false);
  90                 return;
  91         }
  92
  93         /* 480i/576i needs global pixel doubling */
  94         if (mode->flags & DRM_MODE_FLAG_DBLCLK)
  95                 vclk_freq *= 2;
  96
  97         venc_freq = vclk_freq;
  98         hdmi_freq = vclk_freq;
  99
 100         /* VENC double pixels for 1080i, 720p and YUV420 modes */
 101         if (meson_venc_hdmi_venc_repeat(vic) ||
 102             encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
 103                 venc_freq *= 2;
 104
 105         vclk_freq = max(venc_freq, hdmi_freq);
 106
 107         if (mode->flags & DRM_MODE_FLAG_DBLCLK)
 108                 venc_freq /= 2;
 109
 110         dev_dbg(priv->dev, "vclk:%d phy=%d venc=%d hdmi=%d enci=%d\n",
 111                 phy_freq, vclk_freq, venc_freq, hdmi_freq,
 112                 priv->venc.hdmi_use_enci);
 113
 114         meson_vclk_setup(priv, MESON_VCLK_TARGET_HDMI, phy_freq, vclk_freq,
 115                          venc_freq, hdmi_freq, priv->venc.hdmi_use_enci);
 116 }
 117
 118 static enum drm_mode_status meson_encoder_hdmi_mode_valid(struct drm_bridge *bridge,
 119                                         const struct drm_display_info *display_info,
 120                                         const struct drm_display_mode *mode)
 121 {
 122         struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
 123         struct meson_drm *priv = encoder_hdmi->priv;
 124         bool is_hdmi2_sink = display_info->hdmi.scdc.supported;
 125         unsigned int phy_freq;
 126         unsigned int vclk_freq;
 127         unsigned int venc_freq;
 128         unsigned int hdmi_freq;
 129         int vic = drm_match_cea_mode(mode);
 130         enum drm_mode_status status;
 131
 132         dev_dbg(priv->dev, "Modeline " DRM_MODE_FMT "\n", DRM_MODE_ARG(mode));
 133
 134         /* If sink does not support 540MHz, reject the non-420 HDMI2 modes */
 135         if (display_info->max_tmds_clock &&
 136             mode->clock > display_info->max_tmds_clock &&
 137             !drm_mode_is_420_only(display_info, mode) &&
 138             !drm_mode_is_420_also(display_info, mode))
 139                 return MODE_BAD;
 140
 141         /* Check against non-VIC supported modes */
 142         if (!vic) {
 143                 status = meson_venc_hdmi_supported_mode(mode);
 144                 if (status != MODE_OK)
 145                         return status;
 146
 147                 return meson_vclk_dmt_supported_freq(priv, mode->clock);
 148         /* Check against supported VIC modes */
 149         } else if (!meson_venc_hdmi_supported_vic(vic))
 150                 return MODE_BAD;
 151
 152         vclk_freq = mode->clock;
 153
 154         /* For 420, pixel clock is half unlike venc clock */
 155         if (drm_mode_is_420_only(display_info, mode) ||
 156             (!is_hdmi2_sink &&
 157              drm_mode_is_420_also(display_info, mode)))
 158                 vclk_freq /= 2;
 159
 160         /* TMDS clock is pixel_clock * 10 */
 161         phy_freq = vclk_freq * 10;
 162
 163         /* 480i/576i needs global pixel doubling */
 164         if (mode->flags & DRM_MODE_FLAG_DBLCLK)
 165                 vclk_freq *= 2;
 166
 167         venc_freq = vclk_freq;
 168         hdmi_freq = vclk_freq;
 169
 170         /* VENC double pixels for 1080i, 720p and YUV420 modes */
 171         if (meson_venc_hdmi_venc_repeat(vic) ||
 172             drm_mode_is_420_only(display_info, mode) ||
 173             (!is_hdmi2_sink &&
 174              drm_mode_is_420_also(display_info, mode)))
 175                 venc_freq *= 2;
 176
 177         vclk_freq = max(venc_freq, hdmi_freq);
 178
 179         if (mode->flags & DRM_MODE_FLAG_DBLCLK)
 180                 venc_freq /= 2;
 181
 182         dev_dbg(priv->dev, "%s: vclk:%d phy=%d venc=%d hdmi=%d\n",
 183                 __func__, phy_freq, vclk_freq, venc_freq, hdmi_freq);
 184
 185         return meson_vclk_vic_supported_freq(priv, phy_freq, vclk_freq);
 186 }
 187
 188 static void meson_encoder_hdmi_atomic_enable(struct drm_bridge *bridge,
 189                                              struct drm_bridge_state *bridge_state)
 190 {
 191         struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
 192         struct drm_atomic_state *state = bridge_state->base.state;
 193         unsigned int ycrcb_map = VPU_HDMI_OUTPUT_CBYCR;
 194         struct meson_drm *priv = encoder_hdmi->priv;
 195         struct drm_connector_state *conn_state;
 196         const struct drm_display_mode *mode;
 197         struct drm_crtc_state *crtc_state;
 198         struct drm_connector *connector;
 199         bool yuv420_mode = false;
 200         int vic;
 201
 202         connector = drm_atomic_get_new_connector_for_encoder(state, bridge->encoder);
 203         if (WARN_ON(!connector))
 204                 return;
 205
 206         conn_state = drm_atomic_get_new_connector_state(state, connector);
 207         if (WARN_ON(!conn_state))
 208                 return;
 209
 210         crtc_state = drm_atomic_get_new_crtc_state(state, conn_state->crtc);
 211         if (WARN_ON(!crtc_state))
 212                 return;
 213
 214         mode = &crtc_state->adjusted_mode;
 215
 216         vic = drm_match_cea_mode(mode);
 217
 218         dev_dbg(priv->dev, "\"%s\" vic %d\n", mode->name, vic);
 219
 220         if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24) {
 221                 ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
 222                 yuv420_mode = true;
 223         } else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
 224                 ycrcb_map = VPU_HDMI_OUTPUT_CRYCB;
 225
 226         /* VENC + VENC-DVI Mode setup */
 227         meson_venc_hdmi_mode_set(priv, vic, ycrcb_map, yuv420_mode, mode);
 228
 229         /* VCLK Set clock */
 230         meson_encoder_hdmi_set_vclk(encoder_hdmi, mode);
 231
 232         if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYYVYY8_0_5X24)
 233                 /* Setup YUV420 to HDMI-TX, no 10bit diphering */
 234                 writel_relaxed(2 | (2 << 2),
 235                                priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
 236         else if (encoder_hdmi->output_bus_fmt == MEDIA_BUS_FMT_UYVY8_1X16)
 237                 /* Setup YUV422 to HDMI-TX, no 10bit diphering */
 238                 writel_relaxed(1 | (2 << 2),
 239                                 priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
 240         else
 241                 /* Setup YUV444 to HDMI-TX, no 10bit diphering */
 242                 writel_relaxed(0, priv->io_base + _REG(VPU_HDMI_FMT_CTRL));
 243
 244         dev_dbg(priv->dev, "%s\n", priv->venc.hdmi_use_enci ? "VENCI" : "VENCP");
 245
 246         if (priv->venc.hdmi_use_enci)
 247                 writel_relaxed(1, priv->io_base + _REG(ENCI_VIDEO_EN));
 248         else
 249                 writel_relaxed(1, priv->io_base + _REG(ENCP_VIDEO_EN));
 250 }
 251
 252 static void meson_encoder_hdmi_atomic_disable(struct drm_bridge *bridge,
 253                                              struct drm_bridge_state *bridge_state)
 254 {
 255         struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
 256         struct meson_drm *priv = encoder_hdmi->priv;
 257
 258         writel_bits_relaxed(0x3, 0,
 259                             priv->io_base + _REG(VPU_HDMI_SETTING));
 260
 261         writel_relaxed(0, priv->io_base + _REG(ENCI_VIDEO_EN));
 262         writel_relaxed(0, priv->io_base + _REG(ENCP_VIDEO_EN));
 263 }
 264
 265 static const u32 meson_encoder_hdmi_out_bus_fmts[] = {
 266         MEDIA_BUS_FMT_YUV8_1X24,
 267         MEDIA_BUS_FMT_UYVY8_1X16,
 268         MEDIA_BUS_FMT_UYYVYY8_0_5X24,
 269 };
 270
 271 static u32 *
 272 meson_encoder_hdmi_get_inp_bus_fmts(struct drm_bridge *bridge,
 273                                         struct drm_bridge_state *bridge_state,
 274                                         struct drm_crtc_state *crtc_state,
 275                                         struct drm_connector_state *conn_state,
 276                                         u32 output_fmt,
 277                                         unsigned int *num_input_fmts)
 278 {
 279         u32 *input_fmts = NULL;
 280         int i;
 281
 282         *num_input_fmts = 0;
 283
 284         for (i = 0 ; i < ARRAY_SIZE(meson_encoder_hdmi_out_bus_fmts) ; ++i) {
 285                 if (output_fmt == meson_encoder_hdmi_out_bus_fmts[i]) {
 286                         *num_input_fmts = 1;
 287                         input_fmts = kcalloc(*num_input_fmts,
 288                                              sizeof(*input_fmts),
 289                                              GFP_KERNEL);
 290                         if (!input_fmts)
 291                                 return NULL;
 292
 293                         input_fmts[0] = output_fmt;
 294
 295                         break;
 296                 }
 297         }
 298
 299         return input_fmts;
 300 }
 301
 302 static int meson_encoder_hdmi_atomic_check(struct drm_bridge *bridge,
 303                                         struct drm_bridge_state *bridge_state,
 304                                         struct drm_crtc_state *crtc_state,
 305                                         struct drm_connector_state *conn_state)
 306 {
 307         struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
 308         struct drm_connector_state *old_conn_state =
 309                 drm_atomic_get_old_connector_state(conn_state->state, conn_state->connector);
 310         struct meson_drm *priv = encoder_hdmi->priv;
 311
 312         encoder_hdmi->output_bus_fmt = bridge_state->output_bus_cfg.format;
 313
 314         dev_dbg(priv->dev, "output_bus_fmt %lx\n", encoder_hdmi->output_bus_fmt);
 315
 316         if (!drm_connector_atomic_hdr_metadata_equal(old_conn_state, conn_state))
 317                 crtc_state->mode_changed = true;
 318
 319         return 0;
 320 }
 321
 322 static void meson_encoder_hdmi_hpd_notify(struct drm_bridge *bridge,
 323                                           enum drm_connector_status status)
 324 {
 325         struct meson_encoder_hdmi *encoder_hdmi = bridge_to_meson_encoder_hdmi(bridge);
 326
 327         if (!encoder_hdmi->cec_notifier)
 328                 return;
 329
 330         if (status == connector_status_connected) {
 331                 const struct drm_edid *drm_edid;
 332                 const struct edid *edid;
 333
 334                 drm_edid = drm_bridge_edid_read(encoder_hdmi->next_bridge,
 335                                                 encoder_hdmi->connector);
 336                 if (!drm_edid)
 337                         return;
 338
 339                 /*
 340                  * FIXME: The CEC physical address should be set using
 341                  * cec_notifier_set_phys_addr(encoder_hdmi->cec_notifier,
 342                  * connector->display_info.source_physical_address) from a path
 343                  * that has read the EDID and called
 344                  * drm_edid_connector_update().
 345                  */
 346                 edid = drm_edid_raw(drm_edid);
 347
 348                 cec_notifier_set_phys_addr_from_edid(encoder_hdmi->cec_notifier, edid);
 349
 350                 drm_edid_free(drm_edid);
 351         } else
 352                 cec_notifier_phys_addr_invalidate(encoder_hdmi->cec_notifier);
 353 }
 354
 355 static const struct drm_bridge_funcs meson_encoder_hdmi_bridge_funcs = {
 356         .attach = meson_encoder_hdmi_attach,
 357         .detach = meson_encoder_hdmi_detach,
 358         .mode_valid = meson_encoder_hdmi_mode_valid,
 359         .hpd_notify = meson_encoder_hdmi_hpd_notify,
 360         .atomic_enable = meson_encoder_hdmi_atomic_enable,
 361         .atomic_disable = meson_encoder_hdmi_atomic_disable,
 362         .atomic_get_input_bus_fmts = meson_encoder_hdmi_get_inp_bus_fmts,
 363         .atomic_check = meson_encoder_hdmi_atomic_check,
 364         .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
 365         .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
 366         .atomic_reset = drm_atomic_helper_bridge_reset,
 367 };
 368
 369 int meson_encoder_hdmi_probe(struct meson_drm *priv)
 370 {
 371         struct meson_encoder_hdmi *meson_encoder_hdmi;
 372         struct platform_device *pdev;
 373         struct device_node *remote;
 374         int ret;
 375
 376         meson_encoder_hdmi = devm_kzalloc(priv->dev, sizeof(*meson_encoder_hdmi), GFP_KERNEL);
 377         if (!meson_encoder_hdmi)
 378                 return -ENOMEM;
 379
 380         /* HDMI Transceiver Bridge */
 381         remote = of_graph_get_remote_node(priv->dev->of_node, 1, 0);
 382         if (!remote) {
 383                 dev_err(priv->dev, "HDMI transceiver device is disabled");
 384                 return 0;
 385         }
 386
 387         meson_encoder_hdmi->next_bridge = of_drm_find_bridge(remote);
 388         if (!meson_encoder_hdmi->next_bridge) {
 389                 ret = dev_err_probe(priv->dev, -EPROBE_DEFER,
 390                                     "Failed to find HDMI transceiver bridge\n");
 391                 goto err_put_node;
 392         }
 393
 394         /* HDMI Encoder Bridge */
 395         meson_encoder_hdmi->bridge.funcs = &meson_encoder_hdmi_bridge_funcs;
 396         meson_encoder_hdmi->bridge.of_node = priv->dev->of_node;
 397         meson_encoder_hdmi->bridge.type = DRM_MODE_CONNECTOR_HDMIA;
 398         meson_encoder_hdmi->bridge.interlace_allowed = true;
 399
 400         drm_bridge_add(&meson_encoder_hdmi->bridge);
 401
 402         meson_encoder_hdmi->priv = priv;
 403
 404         /* Encoder */
 405         ret = drm_simple_encoder_init(priv->drm, &meson_encoder_hdmi->encoder,
 406                                       DRM_MODE_ENCODER_TMDS);
 407         if (ret) {
 408                 dev_err_probe(priv->dev, ret, "Failed to init HDMI encoder\n");
 409                 goto err_put_node;
 410         }
 411
 412         meson_encoder_hdmi->encoder.possible_crtcs = BIT(0);
 413
 414         /* Attach HDMI Encoder Bridge to Encoder */
 415         ret = drm_bridge_attach(&meson_encoder_hdmi->encoder, &meson_encoder_hdmi->bridge, NULL,
 416                                 DRM_BRIDGE_ATTACH_NO_CONNECTOR);
 417         if (ret) {
 418                 dev_err_probe(priv->dev, ret, "Failed to attach bridge\n");
 419                 goto err_put_node;
 420         }
 421
 422         /* Initialize & attach Bridge Connector */
 423         meson_encoder_hdmi->connector = drm_bridge_connector_init(priv->drm,
 424                                                         &meson_encoder_hdmi->encoder);
 425         if (IS_ERR(meson_encoder_hdmi->connector)) {
 426                 ret = dev_err_probe(priv->dev,
 427                                     PTR_ERR(meson_encoder_hdmi->connector),
 428                                     "Unable to create HDMI bridge connector\n");
 429                 goto err_put_node;
 430         }
 431         drm_connector_attach_encoder(meson_encoder_hdmi->connector,
 432                                      &meson_encoder_hdmi->encoder);
 433
 434         /*
 435          * We should have now in place:
 436          * encoder->[hdmi encoder bridge]->[dw-hdmi bridge]->[display connector bridge]->[display connector]
 437          */
 438
 439         /*
 440          * drm_connector_attach_max_bpc_property() requires the
 441          * connector to have a state.
 442          */
 443         drm_atomic_helper_connector_reset(meson_encoder_hdmi->connector);
 444
 445         if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXL) ||
 446             meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXM) ||
 447             meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A))
 448                 drm_connector_attach_hdr_output_metadata_property(meson_encoder_hdmi->connector);
 449
 450         drm_connector_attach_max_bpc_property(meson_encoder_hdmi->connector, 8, 8);
 451
 452         /* Handle this here until handled by drm_bridge_connector_init() */
 453         meson_encoder_hdmi->connector->ycbcr_420_allowed = true;
 454
 455         pdev = of_find_device_by_node(remote);
 456         of_node_put(remote);
 457         if (pdev) {
 458                 struct cec_connector_info conn_info;
 459                 struct cec_notifier *notifier;
 460
 461                 cec_fill_conn_info_from_drm(&conn_info, meson_encoder_hdmi->connector);
 462
 463                 notifier = cec_notifier_conn_register(&pdev->dev, NULL, &conn_info);
 464                 if (!notifier) {
 465                         put_device(&pdev->dev);
 466                         return -ENOMEM;
 467                 }
 468
 469                 meson_encoder_hdmi->cec_notifier = notifier;
 470         }
 471
 472         priv->encoders[MESON_ENC_HDMI] = meson_encoder_hdmi;
 473
 474         dev_dbg(priv->dev, "HDMI encoder initialized\n");
 475
 476         return 0;
 477
 478 err_put_node:
 479         of_node_put(remote);
 480         return ret;
 481 }
 482
 483 void meson_encoder_hdmi_remove(struct meson_drm *priv)
 484 {
 485         struct meson_encoder_hdmi *meson_encoder_hdmi;
 486
 487         if (priv->encoders[MESON_ENC_HDMI]) {
 488                 meson_encoder_hdmi = priv->encoders[MESON_ENC_HDMI];
 489                 drm_bridge_remove(&meson_encoder_hdmi->bridge);
 490         }
 491 }