drm/msm/mdp5: Configure 'right' hwpipe

Now that we have a right hwpipe in mdp5_plane_state, configure it
mdp5_plane_mode_set(). The only parameters that vary between the
left and right hwpipes are the src_w, src_img_w, src_x and crtc_x
as we just even chop the fb into left and right halves.

Add a mdp5_plane_right_pipe() which will be used by the crtc code
to set up LM stages.

Signed-off-by: Archit Taneja <architt@codeaurora.org>
Signed-off-by: Rob Clark <robdclark@gmail.com>

2 files changed, 46 insertions, 1 deletions

diff --git a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.h b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.h
index 5653917bcc9d..8bdb7ee4983b 100644
--- a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.h
+++ b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_kms.h
@@ -275,6 +275,7 @@ void mdp5_irq_domain_fini(struct mdp5_kms *mdp5_kms);
 
 uint32_t mdp5_plane_get_flush(struct drm_plane *plane);
 enum mdp5_pipe mdp5_plane_pipe(struct drm_plane *plane);
+enum mdp5_pipe mdp5_plane_right_pipe(struct drm_plane *plane);
 struct drm_plane *mdp5_plane_init(struct drm_device *dev,
                                   enum drm_plane_type type);
 
diff --git a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_plane.c b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_plane.c
index caedb9faeae2..a38c5fe6cc19 100644
--- a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_plane.c
+++ b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_plane.c
@@ -881,6 +881,7 @@ static int mdp5_plane_mode_set(struct drm_plane *plane,
         struct mdp5_hw_pipe *hwpipe = to_mdp5_plane_state(pstate)->hwpipe;
         struct mdp5_kms *mdp5_kms = get_kms(plane);
         enum mdp5_pipe pipe = hwpipe->pipe;
+        struct mdp5_hw_pipe *right_hwpipe;
         const struct mdp_format *format;
         uint32_t nplanes, config = 0;
         struct phase_step step = { 0 };
@@ -894,6 +895,8 @@ static int mdp5_plane_mode_set(struct drm_plane *plane,
         uint32_t src_x, src_y;
         uint32_t src_w, src_h;
         uint32_t src_img_w, src_img_h;
+        uint32_t src_x_r;
+        int crtc_x_r;
         unsigned long flags;
         int ret;
 
@@ -929,6 +932,21 @@ static int mdp5_plane_mode_set(struct drm_plane *plane,
                         fb->base.id, src_x, src_y, src_w, src_h,
                         crtc->base.id, crtc_x, crtc_y, crtc_w, crtc_h);
 
+        right_hwpipe = to_mdp5_plane_state(pstate)->r_hwpipe;
+        if (right_hwpipe) {
+                /*
+                 * if the plane comprises of 2 hw pipes, assume that the width
+                 * is split equally across them. The only parameters that varies
+                 * between the 2 pipes are src_x and crtc_x
+                 */
+                crtc_w /= 2;
+                src_w /= 2;
+                src_img_w /= 2;
+
+                crtc_x_r = crtc_x + crtc_w;
+                src_x_r = src_x + src_w;
+        }
+
         ret = calc_scalex_steps(plane, pix_format, src_w, crtc_w, step.x);
         if (ret)
                 return ret;
@@ -965,6 +983,12 @@ static int mdp5_plane_mode_set(struct drm_plane *plane,
                              crtc_x, crtc_y, crtc_w, crtc_h,
                              src_img_w, src_img_h,
                              src_x, src_y, src_w, src_h);
+        if (right_hwpipe)
+                mdp5_hwpipe_mode_set(mdp5_kms, right_hwpipe, fb, &step, &pe,
+                                     config, hdecm, vdecm, hflip, vflip,
+                                     crtc_x_r, crtc_y, crtc_w, crtc_h,
+                                     src_img_w, src_img_h,
+                                     src_x_r, src_y, src_w, src_h);
 
         spin_unlock_irqrestore(&mdp5_plane->pipe_lock, flags);
 
@@ -1051,6 +1075,10 @@ slow:
                                               src_x, src_y, src_w, src_h, ctx);
 }
 
+/*
+ * Use this func and the one below only after the atomic state has been
+ * successfully swapped
+ */
 enum mdp5_pipe mdp5_plane_pipe(struct drm_plane *plane)
 {
         struct mdp5_plane_state *pstate = to_mdp5_plane_state(plane->state);
@@ -1061,14 +1089,30 @@ enum mdp5_pipe mdp5_plane_pipe(struct drm_plane *plane)
         return pstate->hwpipe->pipe;
 }
 
+enum mdp5_pipe mdp5_plane_right_pipe(struct drm_plane *plane)
+{
+        struct mdp5_plane_state *pstate = to_mdp5_plane_state(plane->state);
+
+        if (!pstate->r_hwpipe)
+                return SSPP_NONE;
+
+        return pstate->r_hwpipe->pipe;
+}
+
 uint32_t mdp5_plane_get_flush(struct drm_plane *plane)
 {
         struct mdp5_plane_state *pstate = to_mdp5_plane_state(plane->state);
+        u32 mask;
 
         if (WARN_ON(!pstate->hwpipe))
                 return 0;
 
-        return pstate->hwpipe->flush_mask;
+        mask = pstate->hwpipe->flush_mask;
+
+        if (pstate->r_hwpipe)
+                mask |= pstate->r_hwpipe->flush_mask;
+
+        return mask;
 }
 
 /* initialize plane */