Split dpu_plane_atomic_check() function into two pieces:

dpu_plane_atomic_check_nopipe() performing generic checks on the pstate,
without touching the associated pipe,

and

dpu_plane_atomic_check_pipes(), which takes into account used pipes.

Signed-off-by: Dmitry Baryshkov <dmitry.barysh...@linaro.org>
---
 drivers/gpu/drm/msm/disp/dpu1/dpu_plane.c | 178 +++++++++++++++++++-----------
 1 file changed, 112 insertions(+), 66 deletions(-)

diff --git a/drivers/gpu/drm/msm/disp/dpu1/dpu_plane.c 
b/drivers/gpu/drm/msm/disp/dpu1/dpu_plane.c
index 115c1bd77bdd..9b9fe28052ad 100644
--- a/drivers/gpu/drm/msm/disp/dpu1/dpu_plane.c
+++ b/drivers/gpu/drm/msm/disp/dpu1/dpu_plane.c
@@ -788,49 +788,22 @@ static int dpu_plane_atomic_check_pipe(struct dpu_plane 
*pdpu,
 #define MAX_UPSCALE_RATIO      20
 #define MAX_DOWNSCALE_RATIO    4
 
-static int dpu_plane_atomic_check(struct drm_plane *plane,
-                                 struct drm_atomic_state *state)
+static int dpu_plane_atomic_check_nopipe(struct drm_plane *plane,
+                                        struct drm_plane_state 
*new_plane_state,
+                                        const struct drm_crtc_state 
*crtc_state)
 {
-       struct drm_plane_state *new_plane_state = 
drm_atomic_get_new_plane_state(state,
-                                                                               
 plane);
        int ret = 0, min_scale, max_scale;
        struct dpu_plane *pdpu = to_dpu_plane(plane);
        struct dpu_kms *kms = _dpu_plane_get_kms(&pdpu->base);
        u64 max_mdp_clk_rate = kms->perf.max_core_clk_rate;
        struct dpu_plane_state *pstate = to_dpu_plane_state(new_plane_state);
-       struct dpu_sw_pipe *pipe = &pstate->pipe;
-       struct dpu_sw_pipe *r_pipe = &pstate->r_pipe;
-       const struct drm_crtc_state *crtc_state = NULL;
-       const struct msm_format *fmt;
        struct dpu_sw_pipe_cfg *pipe_cfg = &pstate->pipe_cfg;
        struct dpu_sw_pipe_cfg *r_pipe_cfg = &pstate->r_pipe_cfg;
        struct drm_rect fb_rect = { 0 };
        uint32_t max_linewidth;
-       unsigned int rotation;
-       uint32_t supported_rotations;
-       const struct dpu_sspp_cfg *pipe_hw_caps;
-       const struct dpu_sspp_sub_blks *sblk;
-
-       if (new_plane_state->crtc)
-               crtc_state = drm_atomic_get_new_crtc_state(state,
-                                                          
new_plane_state->crtc);
-
-       pipe->sspp = dpu_rm_get_sspp(&kms->rm, pdpu->pipe);
-       r_pipe->sspp = NULL;
 
-       if (!pipe->sspp)
-               return -EINVAL;
-
-       pipe_hw_caps = pipe->sspp->cap;
-       sblk = pipe->sspp->cap->sblk;
-
-       if (sblk->scaler_blk.len) {
-               min_scale = FRAC_16_16(1, MAX_UPSCALE_RATIO);
-               max_scale = MAX_DOWNSCALE_RATIO << 16;
-       } else {
-               min_scale = DRM_PLANE_NO_SCALING;
-               max_scale = DRM_PLANE_NO_SCALING;
-       }
+       min_scale = FRAC_16_16(1, MAX_UPSCALE_RATIO);
+       max_scale = MAX_DOWNSCALE_RATIO << 16;
 
        ret = drm_atomic_helper_check_plane_state(new_plane_state, crtc_state,
                                                  min_scale,
@@ -843,11 +816,6 @@ static int dpu_plane_atomic_check(struct drm_plane *plane,
        if (!new_plane_state->visible)
                return 0;
 
-       pipe->multirect_index = DPU_SSPP_RECT_SOLO;
-       pipe->multirect_mode = DPU_SSPP_MULTIRECT_NONE;
-       r_pipe->multirect_index = DPU_SSPP_RECT_SOLO;
-       r_pipe->multirect_mode = DPU_SSPP_MULTIRECT_NONE;
-
        pstate->stage = DPU_STAGE_0 + pstate->base.normalized_zpos;
        if (pstate->stage >= pdpu->catalog->caps->max_mixer_blendstages) {
                DPU_ERROR("> %d plane stages assigned\n",
@@ -871,8 +839,6 @@ static int dpu_plane_atomic_check(struct drm_plane *plane,
                return -E2BIG;
        }
 
-       fmt = msm_framebuffer_format(new_plane_state->fb);
-
        max_linewidth = pdpu->catalog->caps->max_linewidth;
 
        drm_rect_rotate(&pipe_cfg->src_rect,
@@ -881,6 +847,78 @@ static int dpu_plane_atomic_check(struct drm_plane *plane,
 
        if ((drm_rect_width(&pipe_cfg->src_rect) > max_linewidth) ||
             _dpu_plane_calc_clk(&crtc_state->adjusted_mode, pipe_cfg) > 
max_mdp_clk_rate) {
+               if (drm_rect_width(&pipe_cfg->src_rect) > 2 * max_linewidth) {
+                       DPU_DEBUG_PLANE(pdpu, "invalid src " DRM_RECT_FMT " 
line:%u\n",
+                                       DRM_RECT_ARG(&pipe_cfg->src_rect), 
max_linewidth);
+                       return -E2BIG;
+               }
+
+               *r_pipe_cfg = *pipe_cfg;
+               pipe_cfg->src_rect.x2 = (pipe_cfg->src_rect.x1 + 
pipe_cfg->src_rect.x2) >> 1;
+               pipe_cfg->dst_rect.x2 = (pipe_cfg->dst_rect.x1 + 
pipe_cfg->dst_rect.x2) >> 1;
+               r_pipe_cfg->src_rect.x1 = pipe_cfg->src_rect.x2;
+               r_pipe_cfg->dst_rect.x1 = pipe_cfg->dst_rect.x2;
+       } else {
+               memset(r_pipe_cfg, 0, sizeof(*r_pipe_cfg));
+       }
+
+       drm_rect_rotate_inv(&pipe_cfg->src_rect,
+                           new_plane_state->fb->width, 
new_plane_state->fb->height,
+                           new_plane_state->rotation);
+       if (r_pipe_cfg->src_rect.x1 != 0)
+               drm_rect_rotate_inv(&r_pipe_cfg->src_rect,
+                                   new_plane_state->fb->width, 
new_plane_state->fb->height,
+                                   new_plane_state->rotation);
+
+       pstate->needs_qos_remap = drm_atomic_crtc_needs_modeset(crtc_state);
+
+       return 0;
+}
+
+static int dpu_plane_atomic_check_pipes(struct drm_plane *plane,
+                                       struct drm_atomic_state *state,
+                                       const struct drm_crtc_state *crtc_state)
+{
+       struct drm_plane_state *new_plane_state =
+               drm_atomic_get_new_plane_state(state, plane);
+       struct dpu_plane *pdpu = to_dpu_plane(plane);
+       struct dpu_plane_state *pstate = to_dpu_plane_state(new_plane_state);
+       struct dpu_sw_pipe *pipe = &pstate->pipe;
+       struct dpu_sw_pipe *r_pipe = &pstate->r_pipe;
+       const struct msm_format *fmt;
+       struct dpu_sw_pipe_cfg *pipe_cfg = &pstate->pipe_cfg;
+       struct dpu_sw_pipe_cfg *r_pipe_cfg = &pstate->r_pipe_cfg;
+       uint32_t max_linewidth;
+       unsigned int rotation;
+       uint32_t supported_rotations;
+       const struct dpu_sspp_cfg *pipe_hw_caps;
+       const struct dpu_sspp_sub_blks *sblk;
+       int ret = 0;
+
+       pipe_hw_caps = pipe->sspp->cap;
+       sblk = pipe->sspp->cap->sblk;
+
+       /*
+        * We already have verified scaling against platform limitations.
+        * Now check if the SSPP supports scaling at all.
+        */
+       if (!sblk->scaler_blk.len &&
+           ((drm_rect_width(&new_plane_state->src) >> 16 !=
+             drm_rect_width(&new_plane_state->dst)) ||
+            (drm_rect_height(&new_plane_state->src) >> 16 !=
+             drm_rect_height(&new_plane_state->dst))))
+               return -ERANGE;
+
+       fmt = msm_framebuffer_format(new_plane_state->fb);
+
+       max_linewidth = pdpu->catalog->caps->max_linewidth;
+
+       ret = dpu_plane_atomic_check_pipe(pdpu, pipe, pipe_cfg, fmt,
+                                         &crtc_state->adjusted_mode);
+       if (ret)
+               return ret;
+
+       if (drm_rect_width(&r_pipe_cfg->src_rect) != 0) {
                /*
                 * In parallel multirect case only the half of the usual width
                 * is supported for tiled formats. If we are here, we know that
@@ -894,12 +932,6 @@ static int dpu_plane_atomic_check(struct drm_plane *plane,
                        return -E2BIG;
                }
 
-               if (drm_rect_width(&pipe_cfg->src_rect) > 2 * max_linewidth) {
-                       DPU_DEBUG_PLANE(pdpu, "invalid src " DRM_RECT_FMT " 
line:%u\n",
-                                       DRM_RECT_ARG(&pipe_cfg->src_rect), 
max_linewidth);
-                       return -E2BIG;
-               }
-
                if (drm_rect_width(&pipe_cfg->src_rect) != 
drm_rect_width(&pipe_cfg->dst_rect) ||
                    drm_rect_height(&pipe_cfg->src_rect) != 
drm_rect_height(&pipe_cfg->dst_rect) ||
                    (!test_bit(DPU_SSPP_SMART_DMA_V1, 
&pipe->sspp->cap->features) &&
@@ -921,26 +953,6 @@ static int dpu_plane_atomic_check(struct drm_plane *plane,
                r_pipe->multirect_index = DPU_SSPP_RECT_1;
                r_pipe->multirect_mode = DPU_SSPP_MULTIRECT_PARALLEL;
 
-               *r_pipe_cfg = *pipe_cfg;
-               pipe_cfg->src_rect.x2 = (pipe_cfg->src_rect.x1 + 
pipe_cfg->src_rect.x2) >> 1;
-               pipe_cfg->dst_rect.x2 = (pipe_cfg->dst_rect.x1 + 
pipe_cfg->dst_rect.x2) >> 1;
-               r_pipe_cfg->src_rect.x1 = pipe_cfg->src_rect.x2;
-               r_pipe_cfg->dst_rect.x1 = pipe_cfg->dst_rect.x2;
-       }
-
-       drm_rect_rotate_inv(&pipe_cfg->src_rect,
-                           new_plane_state->fb->width, 
new_plane_state->fb->height,
-                           new_plane_state->rotation);
-       if (r_pipe->sspp)
-               drm_rect_rotate_inv(&r_pipe_cfg->src_rect,
-                                   new_plane_state->fb->width, 
new_plane_state->fb->height,
-                                   new_plane_state->rotation);
-
-       ret = dpu_plane_atomic_check_pipe(pdpu, pipe, pipe_cfg, fmt, 
&crtc_state->adjusted_mode);
-       if (ret)
-               return ret;
-
-       if (r_pipe->sspp) {
                ret = dpu_plane_atomic_check_pipe(pdpu, r_pipe, r_pipe_cfg, fmt,
                                                  &crtc_state->adjusted_mode);
                if (ret)
@@ -963,11 +975,45 @@ static int dpu_plane_atomic_check(struct drm_plane *plane,
        }
 
        pstate->rotation = rotation;
-       pstate->needs_qos_remap = drm_atomic_crtc_needs_modeset(crtc_state);
 
        return 0;
 }
 
+static int dpu_plane_atomic_check(struct drm_plane *plane,
+                                 struct drm_atomic_state *state)
+{
+       struct drm_plane_state *new_plane_state = 
drm_atomic_get_new_plane_state(state,
+                                                                               
 plane);
+       int ret = 0;
+       struct dpu_plane *pdpu = to_dpu_plane(plane);
+       struct dpu_plane_state *pstate = to_dpu_plane_state(new_plane_state);
+       struct dpu_kms *dpu_kms = _dpu_plane_get_kms(plane);
+       struct dpu_sw_pipe *pipe = &pstate->pipe;
+       struct dpu_sw_pipe *r_pipe = &pstate->r_pipe;
+       const struct drm_crtc_state *crtc_state = NULL;
+
+       if (new_plane_state->crtc)
+               crtc_state = drm_atomic_get_new_crtc_state(state,
+                                                          
new_plane_state->crtc);
+
+       pipe->sspp = dpu_rm_get_sspp(&dpu_kms->rm, pdpu->pipe);
+       r_pipe->sspp = NULL;
+
+       ret = dpu_plane_atomic_check_nopipe(plane, new_plane_state, crtc_state);
+       if (ret)
+               return ret;
+
+       if (!new_plane_state->visible)
+               return 0;
+
+       pipe->multirect_index = DPU_SSPP_RECT_SOLO;
+       pipe->multirect_mode = DPU_SSPP_MULTIRECT_NONE;
+       r_pipe->multirect_index = DPU_SSPP_RECT_SOLO;
+       r_pipe->multirect_mode = DPU_SSPP_MULTIRECT_NONE;
+
+       return dpu_plane_atomic_check_pipes(plane, state, crtc_state);
+}
+
 static void dpu_plane_flush_csc(struct dpu_plane *pdpu, struct dpu_sw_pipe 
*pipe)
 {
        const struct msm_format *format =

-- 
2.39.2

Reply via email to