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