drivers/gpu/drm/msm/hdmi/hdmi_bridge.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2013 Red Hat
   4  * Author: Rob Clark <[email protected]>
   5  */
   6
   7 #include <linux/delay.h>
   8 #include <drm/drm_bridge_connector.h>
   9 #include <drm/drm_edid.h>
  10
  11 #include "msm_kms.h"
  12 #include "hdmi.h"
  13
  14 static void msm_hdmi_power_on(struct drm_bridge *bridge)
  15 {
  16         struct drm_device *dev = bridge->dev;
  17         struct hdmi_bridge *hdmi_bridge = to_hdmi_bridge(bridge);
  18         struct hdmi *hdmi = hdmi_bridge->hdmi;
  19         const struct hdmi_platform_config *config = hdmi->config;
  20         int i, ret;
  21
  22         pm_runtime_get_sync(&hdmi->pdev->dev);
  23
  24         ret = regulator_bulk_enable(config->pwr_reg_cnt, hdmi->pwr_regs);
  25         if (ret)
  26                 DRM_DEV_ERROR(dev->dev, "failed to enable pwr regulator: %d\n", ret);
  27
  28         if (config->pwr_clk_cnt > 0) {
  29                 DBG("pixclock: %lu", hdmi->pixclock);
  30                 ret = clk_set_rate(hdmi->pwr_clks[0], hdmi->pixclock);
  31                 if (ret) {
  32                         DRM_DEV_ERROR(dev->dev, "failed to set pixel clk: %s (%d)\n",
  33                                         config->pwr_clk_names[0], ret);
  34                 }
  35         }
  36
  37         for (i = 0; i < config->pwr_clk_cnt; i++) {
  38                 ret = clk_prepare_enable(hdmi->pwr_clks[i]);
  39                 if (ret) {
  40                         DRM_DEV_ERROR(dev->dev, "failed to enable pwr clk: %s (%d)\n",
  41                                         config->pwr_clk_names[i], ret);
  42                 }
  43         }
  44 }
  45
  46 static void power_off(struct drm_bridge *bridge)
  47 {
  48         struct drm_device *dev = bridge->dev;
  49         struct hdmi_bridge *hdmi_bridge = to_hdmi_bridge(bridge);
  50         struct hdmi *hdmi = hdmi_bridge->hdmi;
  51         const struct hdmi_platform_config *config = hdmi->config;
  52         int i, ret;
  53
  54         /* TODO do we need to wait for final vblank somewhere before
  55          * cutting the clocks?
  56          */
  57         mdelay(16 + 4);
  58
  59         for (i = 0; i < config->pwr_clk_cnt; i++)
  60                 clk_disable_unprepare(hdmi->pwr_clks[i]);
  61
  62         ret = regulator_bulk_disable(config->pwr_reg_cnt, hdmi->pwr_regs);
  63         if (ret)
  64                 DRM_DEV_ERROR(dev->dev, "failed to disable pwr regulator: %d\n", ret);
  65
  66         pm_runtime_put(&hdmi->pdev->dev);
  67 }
  68
  69 #define AVI_IFRAME_LINE_NUMBER 1
  70
  71 static void msm_hdmi_config_avi_infoframe(struct hdmi *hdmi)
  72 {
  73         struct drm_crtc *crtc = hdmi->encoder->crtc;
  74         const struct drm_display_mode *mode = &crtc->state->adjusted_mode;
  75         union hdmi_infoframe frame;
  76         u8 buffer[HDMI_INFOFRAME_SIZE(AVI)];
  77         u32 val;
  78         int len;
  79
  80         drm_hdmi_avi_infoframe_from_display_mode(&frame.avi,
  81                                                  hdmi->connector, mode);
  82
  83         len = hdmi_infoframe_pack(&frame, buffer, sizeof(buffer));
  84         if (len < 0) {
  85                 DRM_DEV_ERROR(&hdmi->pdev->dev,
  86                         "failed to configure avi infoframe\n");
  87                 return;
  88         }
  89
  90         /*
  91          * the AVI_INFOx registers don't map exactly to how the AVI infoframes
  92          * are packed according to the spec. The checksum from the header is
  93          * written to the LSB byte of AVI_INFO0 and the version is written to
  94          * the third byte from the LSB of AVI_INFO3
  95          */
  96         hdmi_write(hdmi, REG_HDMI_AVI_INFO(0),
  97                    buffer[3] |
  98                    buffer[4] << 8 |
  99                    buffer[5] << 16 |
 100                    buffer[6] << 24);
 101
 102         hdmi_write(hdmi, REG_HDMI_AVI_INFO(1),
 103                    buffer[7] |
 104                    buffer[8] << 8 |
 105                    buffer[9] << 16 |
 106                    buffer[10] << 24);
 107
 108         hdmi_write(hdmi, REG_HDMI_AVI_INFO(2),
 109                    buffer[11] |
 110                    buffer[12] << 8 |
 111                    buffer[13] << 16 |
 112                    buffer[14] << 24);
 113
 114         hdmi_write(hdmi, REG_HDMI_AVI_INFO(3),
 115                    buffer[15] |
 116                    buffer[16] << 8 |
 117                    buffer[1] << 24);
 118
 119         hdmi_write(hdmi, REG_HDMI_INFOFRAME_CTRL0,
 120                    HDMI_INFOFRAME_CTRL0_AVI_SEND |
 121                    HDMI_INFOFRAME_CTRL0_AVI_CONT);
 122
 123         val = hdmi_read(hdmi, REG_HDMI_INFOFRAME_CTRL1);
 124         val &= ~HDMI_INFOFRAME_CTRL1_AVI_INFO_LINE__MASK;
 125         val |= HDMI_INFOFRAME_CTRL1_AVI_INFO_LINE(AVI_IFRAME_LINE_NUMBER);
 126         hdmi_write(hdmi, REG_HDMI_INFOFRAME_CTRL1, val);
 127 }
 128
 129 static void msm_hdmi_bridge_pre_enable(struct drm_bridge *bridge)
 130 {
 131         struct hdmi_bridge *hdmi_bridge = to_hdmi_bridge(bridge);
 132         struct hdmi *hdmi = hdmi_bridge->hdmi;
 133         struct hdmi_phy *phy = hdmi->phy;
 134
 135         DBG("power up");
 136
 137         if (!hdmi->power_on) {
 138                 msm_hdmi_phy_resource_enable(phy);
 139                 msm_hdmi_power_on(bridge);
 140                 hdmi->power_on = true;
 141                 if (hdmi->hdmi_mode) {
 142                         msm_hdmi_config_avi_infoframe(hdmi);
 143                         msm_hdmi_audio_update(hdmi);
 144                 }
 145         }
 146
 147         msm_hdmi_phy_powerup(phy, hdmi->pixclock);
 148
 149         msm_hdmi_set_mode(hdmi, true);
 150
 151         if (hdmi->hdcp_ctrl)
 152                 msm_hdmi_hdcp_on(hdmi->hdcp_ctrl);
 153 }
 154
 155 static void msm_hdmi_bridge_post_disable(struct drm_bridge *bridge)
 156 {
 157         struct hdmi_bridge *hdmi_bridge = to_hdmi_bridge(bridge);
 158         struct hdmi *hdmi = hdmi_bridge->hdmi;
 159         struct hdmi_phy *phy = hdmi->phy;
 160
 161         if (hdmi->hdcp_ctrl)
 162                 msm_hdmi_hdcp_off(hdmi->hdcp_ctrl);
 163
 164         DBG("power down");
 165         msm_hdmi_set_mode(hdmi, false);
 166
 167         msm_hdmi_phy_powerdown(phy);
 168
 169         if (hdmi->power_on) {
 170                 power_off(bridge);
 171                 hdmi->power_on = false;
 172                 if (hdmi->hdmi_mode)
 173                         msm_hdmi_audio_update(hdmi);
 174                 msm_hdmi_phy_resource_disable(phy);
 175         }
 176 }
 177
 178 static void msm_hdmi_bridge_mode_set(struct drm_bridge *bridge,
 179                  const struct drm_display_mode *mode,
 180                  const struct drm_display_mode *adjusted_mode)
 181 {
 182         struct hdmi_bridge *hdmi_bridge = to_hdmi_bridge(bridge);
 183         struct hdmi *hdmi = hdmi_bridge->hdmi;
 184         int hstart, hend, vstart, vend;
 185         uint32_t frame_ctrl;
 186
 187         mode = adjusted_mode;
 188
 189         hdmi->pixclock = mode->clock * 1000;
 190
 191         hstart = mode->htotal - mode->hsync_start;
 192         hend   = mode->htotal - mode->hsync_start + mode->hdisplay;
 193
 194         vstart = mode->vtotal - mode->vsync_start - 1;
 195         vend   = mode->vtotal - mode->vsync_start + mode->vdisplay - 1;
 196
 197         DBG("htotal=%d, vtotal=%d, hstart=%d, hend=%d, vstart=%d, vend=%d",
 198                         mode->htotal, mode->vtotal, hstart, hend, vstart, vend);
 199
 200         hdmi_write(hdmi, REG_HDMI_TOTAL,
 201                         HDMI_TOTAL_H_TOTAL(mode->htotal - 1) |
 202                         HDMI_TOTAL_V_TOTAL(mode->vtotal - 1));
 203
 204         hdmi_write(hdmi, REG_HDMI_ACTIVE_HSYNC,
 205                         HDMI_ACTIVE_HSYNC_START(hstart) |
 206                         HDMI_ACTIVE_HSYNC_END(hend));
 207         hdmi_write(hdmi, REG_HDMI_ACTIVE_VSYNC,
 208                         HDMI_ACTIVE_VSYNC_START(vstart) |
 209                         HDMI_ACTIVE_VSYNC_END(vend));
 210
 211         if (mode->flags & DRM_MODE_FLAG_INTERLACE) {
 212                 hdmi_write(hdmi, REG_HDMI_VSYNC_TOTAL_F2,
 213                                 HDMI_VSYNC_TOTAL_F2_V_TOTAL(mode->vtotal));
 214                 hdmi_write(hdmi, REG_HDMI_VSYNC_ACTIVE_F2,
 215                                 HDMI_VSYNC_ACTIVE_F2_START(vstart + 1) |
 216                                 HDMI_VSYNC_ACTIVE_F2_END(vend + 1));
 217         } else {
 218                 hdmi_write(hdmi, REG_HDMI_VSYNC_TOTAL_F2,
 219                                 HDMI_VSYNC_TOTAL_F2_V_TOTAL(0));
 220                 hdmi_write(hdmi, REG_HDMI_VSYNC_ACTIVE_F2,
 221                                 HDMI_VSYNC_ACTIVE_F2_START(0) |
 222                                 HDMI_VSYNC_ACTIVE_F2_END(0));
 223         }
 224
 225         frame_ctrl = 0;
 226         if (mode->flags & DRM_MODE_FLAG_NHSYNC)
 227                 frame_ctrl |= HDMI_FRAME_CTRL_HSYNC_LOW;
 228         if (mode->flags & DRM_MODE_FLAG_NVSYNC)
 229                 frame_ctrl |= HDMI_FRAME_CTRL_VSYNC_LOW;
 230         if (mode->flags & DRM_MODE_FLAG_INTERLACE)
 231                 frame_ctrl |= HDMI_FRAME_CTRL_INTERLACED_EN;
 232         DBG("frame_ctrl=%08x", frame_ctrl);
 233         hdmi_write(hdmi, REG_HDMI_FRAME_CTRL, frame_ctrl);
 234
 235         if (hdmi->hdmi_mode)
 236                 msm_hdmi_audio_update(hdmi);
 237 }
 238
 239 static struct edid *msm_hdmi_bridge_get_edid(struct drm_bridge *bridge,
 240                 struct drm_connector *connector)
 241 {
 242         struct hdmi_bridge *hdmi_bridge = to_hdmi_bridge(bridge);
 243         struct hdmi *hdmi = hdmi_bridge->hdmi;
 244         struct edid *edid;
 245         uint32_t hdmi_ctrl;
 246
 247         hdmi_ctrl = hdmi_read(hdmi, REG_HDMI_CTRL);
 248         hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl | HDMI_CTRL_ENABLE);
 249
 250         edid = drm_get_edid(connector, hdmi->i2c);
 251
 252         hdmi_write(hdmi, REG_HDMI_CTRL, hdmi_ctrl);
 253
 254         hdmi->hdmi_mode = drm_detect_hdmi_monitor(edid);
 255
 256         return edid;
 257 }
 258
 259 static enum drm_mode_status msm_hdmi_bridge_mode_valid(struct drm_bridge *bridge,
 260                 const struct drm_display_info *info,
 261                 const struct drm_display_mode *mode)
 262 {
 263         struct hdmi_bridge *hdmi_bridge = to_hdmi_bridge(bridge);
 264         struct hdmi *hdmi = hdmi_bridge->hdmi;
 265         const struct hdmi_platform_config *config = hdmi->config;
 266         struct msm_drm_private *priv = bridge->dev->dev_private;
 267         struct msm_kms *kms = priv->kms;
 268         long actual, requested;
 269
 270         requested = 1000 * mode->clock;
 271
 272         /* for mdp5/apq8074, we manage our own pixel clk (as opposed to
 273          * mdp4/dtv stuff where pixel clk is assigned to mdp/encoder
 274          * instead):
 275          */
 276         if (kms->funcs->round_pixclk)
 277                 actual = kms->funcs->round_pixclk(kms,
 278                         requested, hdmi_bridge->hdmi->encoder);
 279         else if (config->pwr_clk_cnt > 0)
 280                 actual = clk_round_rate(hdmi->pwr_clks[0], requested);
 281         else
 282                 actual = requested;
 283
 284         DBG("requested=%ld, actual=%ld", requested, actual);
 285
 286         if (actual != requested)
 287                 return MODE_CLOCK_RANGE;
 288
 289         return 0;
 290 }
 291
 292 static const struct drm_bridge_funcs msm_hdmi_bridge_funcs = {
 293                 .pre_enable = msm_hdmi_bridge_pre_enable,
 294                 .post_disable = msm_hdmi_bridge_post_disable,
 295                 .mode_set = msm_hdmi_bridge_mode_set,
 296                 .mode_valid = msm_hdmi_bridge_mode_valid,
 297                 .get_edid = msm_hdmi_bridge_get_edid,
 298                 .detect = msm_hdmi_bridge_detect,
 299 };
 300
 301 static void
 302 msm_hdmi_hotplug_work(struct work_struct *work)
 303 {
 304         struct hdmi_bridge *hdmi_bridge =
 305                 container_of(work, struct hdmi_bridge, hpd_work);
 306         struct drm_bridge *bridge = &hdmi_bridge->base;
 307
 308         drm_bridge_hpd_notify(bridge, drm_bridge_detect(bridge));
 309 }
 310
 311 /* initialize bridge */
 312 int msm_hdmi_bridge_init(struct hdmi *hdmi)
 313 {
 314         struct drm_bridge *bridge = NULL;
 315         struct hdmi_bridge *hdmi_bridge;
 316         int ret;
 317
 318         hdmi_bridge = devm_kzalloc(hdmi->dev->dev,
 319                         sizeof(*hdmi_bridge), GFP_KERNEL);
 320         if (!hdmi_bridge)
 321                 return -ENOMEM;
 322
 323         hdmi_bridge->hdmi = hdmi;
 324         INIT_WORK(&hdmi_bridge->hpd_work, msm_hdmi_hotplug_work);
 325
 326         bridge = &hdmi_bridge->base;
 327         bridge->funcs = &msm_hdmi_bridge_funcs;
 328         bridge->ddc = hdmi->i2c;
 329         bridge->type = DRM_MODE_CONNECTOR_HDMIA;
 330         bridge->ops = DRM_BRIDGE_OP_HPD |
 331                 DRM_BRIDGE_OP_DETECT |
 332                 DRM_BRIDGE_OP_EDID;
 333
 334         ret = devm_drm_bridge_add(hdmi->dev->dev, bridge);
 335         if (ret)
 336                 return ret;
 337
 338         ret = drm_bridge_attach(hdmi->encoder, bridge, NULL, DRM_BRIDGE_ATTACH_NO_CONNECTOR);
 339         if (ret)
 340                 return ret;
 341
 342         hdmi->bridge = bridge;
 343
 344         return 0;
 345 }