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