From: Paulo Zanoni <[email protected]>

Both the control and data registers are completely different now.

Signed-off-by: Paulo Zanoni <[email protected]>
---
 drivers/gpu/drm/i915/i915_reg.h   |    4 +++
 drivers/gpu/drm/i915/intel_hdmi.c |   68 +++++++++++++++++++++++++++++++++----
 2 files changed, 66 insertions(+), 6 deletions(-)

Things are simpler and easier now.

diff --git a/drivers/gpu/drm/i915/i915_reg.h b/drivers/gpu/drm/i915/i915_reg.h
index fb76b19..2d49b95 100644
--- a/drivers/gpu/drm/i915/i915_reg.h
+++ b/drivers/gpu/drm/i915/i915_reg.h
@@ -1697,6 +1697,7 @@
 /* Video Data Island Packet control */
 #define VIDEO_DIP_DATA         0x61178
 #define VIDEO_DIP_CTL          0x61170
+/* Pre HSW: */
 #define   VIDEO_DIP_ENABLE             (1 << 31)
 #define   VIDEO_DIP_PORT_B             (1 << 29)
 #define   VIDEO_DIP_PORT_C             (2 << 29)
@@ -1713,6 +1714,9 @@
 #define   VIDEO_DIP_FREQ_VSYNC         (1 << 16)
 #define   VIDEO_DIP_FREQ_2VSYNC                (2 << 16)
 #define   VIDEO_DIP_FREQ_MASK          (3 << 16)
+/* HSW and later: */
+#define   VIDEO_DIP_ENABLE_AVI_HSW     (1 << 12)
+#define   VIDEO_DIP_ENABLE_SPD_HSW     (1 << 0)
 
 /* Panel power sequencing */
 #define PP_STATUS      0x61200
diff --git a/drivers/gpu/drm/i915/intel_hdmi.c 
b/drivers/gpu/drm/i915/intel_hdmi.c
index 03b3524..ed91db0 100644
--- a/drivers/gpu/drm/i915/intel_hdmi.c
+++ b/drivers/gpu/drm/i915/intel_hdmi.c
@@ -101,6 +101,44 @@ static u32 g4x_infoframe_enable(struct dip_infoframe 
*frame)
        return flags;
 }
 
+static u32 hsw_infoframe_enable(struct dip_infoframe *frame)
+{
+       u32 flags = 0;
+
+       switch (frame->type) {
+       case DIP_TYPE_AVI:
+               flags |= VIDEO_DIP_ENABLE_AVI_HSW;
+               break;
+       case DIP_TYPE_SPD:
+               flags |= VIDEO_DIP_ENABLE_SPD_HSW;
+               break;
+       default:
+               DRM_DEBUG_DRIVER("unknown info frame type %d\n", frame->type);
+               break;
+       }
+
+       return flags;
+}
+
+static u32 hsw_infoframe_data_reg(struct dip_infoframe *frame, enum pipe pipe)
+{
+       u32 reg = 0;
+
+       switch (frame->type) {
+       case DIP_TYPE_AVI:
+               reg = HSW_TVIDEO_DIP_AVI_DATA(pipe);
+               break;
+       case DIP_TYPE_SPD:
+               reg = HSW_TVIDEO_DIP_SPD_DATA(pipe);
+               break;
+       default:
+               DRM_DEBUG_DRIVER("unknown info frame type %d\n", frame->type);
+               break;
+       }
+
+       return reg;
+}
+
 static void g4x_write_infoframe(struct drm_encoder *encoder,
                                struct dip_infoframe *frame)
 {
@@ -266,15 +304,33 @@ static void vlv_write_infoframe(struct drm_encoder 
*encoder,
 }
 
 static void hsw_write_infoframe(struct drm_encoder *encoder,
-                                    struct dip_infoframe *frame)
+                               struct dip_infoframe *frame)
 {
-       /* Not implemented yet, so avoid doing anything at all.
-        * This is the placeholder for Paulo Zanoni's infoframe writing patch
-        */
-       DRM_DEBUG_DRIVER("Attempting to write infoframe on Haswell, this is not 
implemented yet.\n");
+       uint32_t *data = (uint32_t *)frame;
+       struct drm_device *dev = encoder->dev;
+       struct drm_i915_private *dev_priv = dev->dev_private;
+       struct drm_crtc *crtc = encoder->crtc;
+       struct intel_crtc *intel_crtc = to_intel_crtc(crtc);
+       u32 ctl_reg = HSW_TVIDEO_DIP_CTL(intel_crtc->pipe);
+       u32 data_reg = hsw_infoframe_data_reg(frame, intel_crtc->pipe);
+       unsigned int i, len = DIP_HEADER_SIZE + frame->len;
+       u32 val = I915_READ(ctl_reg);
 
-       return;
+       if (data_reg == 0)
+               return;
+
+       intel_wait_for_vblank(dev, intel_crtc->pipe);
+
+       val &= ~hsw_infoframe_enable(frame);
+       I915_WRITE(ctl_reg, val);
+
+       for (i = 0; i < len; i += 4) {
+               I915_WRITE(data_reg + i, *data);
+               data++;
+       }
 
+       val |= hsw_infoframe_enable(frame);
+       I915_WRITE(ctl_reg, val);
 }
 
 static void intel_set_infoframe(struct drm_encoder *encoder,
-- 
1.7.10

_______________________________________________
Intel-gfx mailing list
[email protected]
http://lists.freedesktop.org/mailman/listinfo/intel-gfx

Reply via email to