Modified the hard-coded hdmi connector/encoder implementations in msm drm
driver to support both edp and hdmi.

Signed-off-by: Hai Li <hali at codeaurora.org>
---
 drivers/gpu/drm/msm/mdp/mdp5/mdp5_encoder.c | 38 +++++++++++++++++++++--
 drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.c     | 47 ++++++++++++++++++++---------
 drivers/gpu/drm/msm/msm_drv.c               |  2 ++
 drivers/gpu/drm/msm/msm_drv.h               |  7 +++++
 4 files changed, 77 insertions(+), 17 deletions(-)

diff --git a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_encoder.c 
b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_encoder.c
index 25c2fcb..f4159c2 100644
--- a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_encoder.c
+++ b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_encoder.c
@@ -1,4 +1,5 @@
 /*
+ * Copyright (c) 2014, The Linux Foundation. All rights reserved.
  * Copyright (C) 2013 Red Hat
  * Author: Rob Clark <robdclark at gmail.com>
  *
@@ -151,11 +152,13 @@ static void mdp5_encoder_mode_set(struct drm_encoder 
*encoder,
 {
        struct mdp5_encoder *mdp5_encoder = to_mdp5_encoder(encoder);
        struct mdp5_kms *mdp5_kms = get_kms(encoder);
+       struct drm_device *dev = encoder->dev;
+       struct drm_connector *connector;
        int intf = mdp5_encoder->intf;
        uint32_t dtv_hsync_skew, vsync_period, vsync_len, ctrl_pol;
        uint32_t display_v_start, display_v_end;
        uint32_t hsync_start_x, hsync_end_x;
-       uint32_t format;
+       uint32_t format = 0x2100;
        unsigned long flags;

        mode = adjusted_mode;
@@ -177,7 +180,28 @@ static void mdp5_encoder_mode_set(struct drm_encoder 
*encoder,
        /* probably need to get DATA_EN polarity from panel.. */

        dtv_hsync_skew = 0;  /* get this from panel? */
-       format = 0x213f;     /* get this from panel? */
+
+       /* Get color format from panel, default is 8bpc */
+       list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
+               if (connector->encoder == encoder) {
+                       switch (connector->display_info.bpc) {
+                       case 4:
+                               format |= 0;
+                               break;
+                       case 5:
+                               format |= 0x15;
+                               break;
+                       case 6:
+                               format |= 0x2A;
+                               break;
+                       case 8:
+                       default:
+                               format |= 0x3F;
+                               break;
+                       }
+                       break;
+               }
+       }

        hsync_start_x = (mode->htotal - mode->hsync_start);
        hsync_end_x = mode->htotal - (mode->hsync_start - mode->hdisplay) - 1;
@@ -187,6 +211,16 @@ static void mdp5_encoder_mode_set(struct drm_encoder 
*encoder,
        display_v_start = (mode->vtotal - mode->vsync_start) * mode->htotal + 
dtv_hsync_skew;
        display_v_end = vsync_period - ((mode->vsync_start - mode->vdisplay) * 
mode->htotal) + dtv_hsync_skew - 1;

+       /*
+        * For edp only:
+        * DISPLAY_V_START = (VBP * HCYCLE) + HBP
+        * DISPLAY_V_END = (VBP + VACTIVE) * HCYCLE - 1 - HFP
+        */
+       if (mdp5_encoder->intf_id == INTF_eDP) {
+               display_v_start += (mode->htotal - mode->hsync_start);
+               display_v_end -= (mode->hsync_start - mode->hdisplay);
+       }
+
        spin_lock_irqsave(&mdp5_encoder->intf_lock, flags);

        mdp5_write(mdp5_kms, REG_MDP5_INTF_HSYNC_CTL(intf),
diff --git a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.c 
b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.c
index ab5f8d2..9d891e2 100644
--- a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.c
+++ b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.c
@@ -157,7 +157,7 @@ static int modeset_init(struct mdp5_kms *mdp5_kms)
        };
        struct drm_device *dev = mdp5_kms->dev;
        struct msm_drm_private *priv = dev->dev_private;
-       struct drm_encoder *encoder;
+       struct drm_encoder *edp_encoder = NULL, *hdmi_encoder = NULL;
        const struct mdp5_cfg_hw *hw_cfg;
        int i, ret;

@@ -208,14 +208,6 @@ static int modeset_init(struct mdp5_kms *mdp5_kms)
                }
        }

-       /* Construct encoder for HDMI: */
-       encoder = mdp5_encoder_init(dev, 3, INTF_HDMI);
-       if (IS_ERR(encoder)) {
-               dev_err(dev->dev, "failed to construct encoder\n");
-               ret = PTR_ERR(encoder);
-               goto fail;
-       }
-
        /* NOTE: the vsync and error irq's are actually associated with
         * the INTF/encoder.. the easiest way to deal with this (ie. what
         * we do now) is assume a fixed relationship between crtc's and
@@ -224,20 +216,45 @@ static int modeset_init(struct mdp5_kms *mdp5_kms)
         * care of error and vblank irq's that the crtc has registered,
         * and also update user-requested vblank_mask.
         */
-       encoder->possible_crtcs = BIT(0);
-       mdp5_crtc_set_intf(priv->crtcs[0], 3, INTF_HDMI);
+       if (priv->hdmi) {
+               /* Construct encoder for HDMI: */
+               hdmi_encoder = mdp5_encoder_init(dev, 3, INTF_HDMI);
+               if (IS_ERR(hdmi_encoder)) {
+                       dev_err(dev->dev, "failed to construct encoder\n");
+                       ret = PTR_ERR(hdmi_encoder);
+                       goto fail;
+               }

-       priv->encoders[priv->num_encoders++] = encoder;
+               hdmi_encoder->possible_crtcs = (1 << priv->num_crtcs) - 1;
+               priv->encoders[priv->num_encoders++] = hdmi_encoder;

-       /* Construct bridge/connector for HDMI: */
-       if (priv->hdmi) {
-               ret = hdmi_modeset_init(priv->hdmi, dev, encoder);
+               ret = hdmi_modeset_init(priv->hdmi, dev, hdmi_encoder);
                if (ret) {
                        dev_err(dev->dev, "failed to initialize HDMI: %d\n", 
ret);
                        goto fail;
                }
        }

+       if (priv->edp) {
+               /* Construct encoder for eDP: */
+               edp_encoder = mdp5_encoder_init(dev, 0, INTF_eDP);
+               if (IS_ERR(edp_encoder)) {
+                       dev_err(dev->dev, "failed to construct eDP encoder\n");
+                       ret = PTR_ERR(edp_encoder);
+                       goto fail;
+               }
+
+               edp_encoder->possible_crtcs = (1 << priv->num_crtcs) - 1;
+               priv->encoders[priv->num_encoders++] = edp_encoder;
+
+               ret = msm_edp_modeset_init(priv->edp, dev, edp_encoder);
+               if (ret) {
+                       dev_err(dev->dev, "failed to initialize eDP: %d\n",
+                                                                       ret);
+                       goto fail;
+               }
+       }
+
        return 0;

 fail:
diff --git a/drivers/gpu/drm/msm/msm_drv.c b/drivers/gpu/drm/msm/msm_drv.c
index d3b791b..e007a7a 100644
--- a/drivers/gpu/drm/msm/msm_drv.c
+++ b/drivers/gpu/drm/msm/msm_drv.c
@@ -1023,6 +1023,7 @@ static struct platform_driver msm_platform_driver = {
 static int __init msm_drm_register(void)
 {
        DBG("init");
+       msm_edp_register();
        hdmi_register();
        adreno_register();
        return platform_driver_register(&msm_platform_driver);
@@ -1034,6 +1035,7 @@ static void __exit msm_drm_unregister(void)
        platform_driver_unregister(&msm_platform_driver);
        hdmi_unregister();
        adreno_unregister();
+       msm_edp_unregister();
 }

 module_init(msm_drm_register);
diff --git a/drivers/gpu/drm/msm/msm_drv.h b/drivers/gpu/drm/msm/msm_drv.h
index 3b25dd8..1cd0e0c 100644
--- a/drivers/gpu/drm/msm/msm_drv.h
+++ b/drivers/gpu/drm/msm/msm_drv.h
@@ -224,6 +224,13 @@ int hdmi_modeset_init(struct hdmi *hdmi, struct drm_device 
*dev,
 void __init hdmi_register(void);
 void __exit hdmi_unregister(void);

+struct msm_edp;
+void __init msm_edp_register(void);
+void __exit msm_edp_unregister(void);
+int msm_edp_modeset_init(struct msm_edp *edp, struct drm_device *dev,
+               struct drm_encoder *encoder);
+
+
 #ifdef CONFIG_DEBUG_FS
 void msm_gem_describe(struct drm_gem_object *obj, struct seq_file *m);
 void msm_gem_describe_objects(struct list_head *list, struct seq_file *m);
-- 
The Qualcomm Innovation Center, Inc. is a member of the Code Aurora Forum,
hosted by The Linux Foundation

Reply via email to