drm/msm/mdp5: mdp5_crtc: Restore cursor state only if LM cursors are enabled

MDP5 on newer SoCs support cursor planes (i.e, cursor SSPPs). They are a
separate entity unlike the cursors within LM.

Do not try to restore the MDP5 LM cursor registers, or the corresponding
CTL bits if we are not using LM cursors.

Also, since we've introduced a new variable 'lm_cursor_enabled', we can
now use it to avoid creating a different sets of crtc_funcs for CRTCs
with LM cursors and CRTCs with cursor planes.

Fixes: "drm/msm/mdp5: restore cursor state when enabling crtc"
Signed-off-by: Archit Taneja <architt@codeaurora.org>
Signed-off-by: Rob Clark <robdclark@gmail.com>

1 files changed, 37 insertions, 29 deletions

diff --git a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_crtc.c b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_crtc.c
index 95ba9edebf04..6f84796c5abc 100644
--- a/drivers/gpu/drm/msm/mdp/mdp5/mdp5_crtc.c
+++ b/drivers/gpu/drm/msm/mdp/mdp5/mdp5_crtc.c
@@ -55,6 +55,8 @@ struct mdp5_crtc {
 
         struct completion pp_completion;
 
+        bool lm_cursor_enabled;
+
         struct {
                 /* protect REG_MDP5_LM_CURSOR* registers and cursor scanout_bo*/
                 spinlock_t lock;
@@ -457,19 +459,24 @@ static void mdp5_crtc_atomic_enable(struct drm_crtc *crtc,
 
         pm_runtime_get_sync(dev);
 
-        /* Restore cursor state, as it might have been lost with suspend: */
-        if (mdp5_crtc->cursor.iova) {
-                unsigned long flags;
-
-                spin_lock_irqsave(&mdp5_crtc->cursor.lock, flags);
-                mdp5_crtc_restore_cursor(crtc);
-                spin_unlock_irqrestore(&mdp5_crtc->cursor.lock, flags);
-
-                mdp5_ctl_set_cursor(mdp5_cstate->ctl,
-                        &mdp5_cstate->pipeline, 0, true);
-        } else {
-                mdp5_ctl_set_cursor(mdp5_cstate->ctl,
-                        &mdp5_cstate->pipeline, 0, false);
+        if (mdp5_crtc->lm_cursor_enabled) {
+                /*
+                 * Restore LM cursor state, as it might have been lost
+                 * with suspend:
+                 */
+                if (mdp5_crtc->cursor.iova) {
+                        unsigned long flags;
+
+                        spin_lock_irqsave(&mdp5_crtc->cursor.lock, flags);
+                        mdp5_crtc_restore_cursor(crtc);
+                        spin_unlock_irqrestore(&mdp5_crtc->cursor.lock, flags);
+
+                        mdp5_ctl_set_cursor(mdp5_cstate->ctl,
+                                            &mdp5_cstate->pipeline, 0, true);
+                } else {
+                        mdp5_ctl_set_cursor(mdp5_cstate->ctl,
+                                            &mdp5_cstate->pipeline, 0, false);
+                }
         }
 
         /* Restore vblank irq handling after power is enabled */
@@ -817,6 +824,12 @@ static int mdp5_crtc_cursor_set(struct drm_crtc *crtc,
         bool cursor_enable = true;
         unsigned long flags;
 
+        if (!mdp5_crtc->lm_cursor_enabled) {
+                dev_warn(dev->dev,
+                         "cursor_set is deprecated with cursor planes\n");
+                return -EINVAL;
+        }
+
         if ((width > CURSOR_WIDTH) || (height > CURSOR_HEIGHT)) {
                 dev_err(dev->dev, "bad cursor size: %dx%d\n", width, height);
                 return -EINVAL;
@@ -888,10 +901,17 @@ static int mdp5_crtc_cursor_move(struct drm_crtc *crtc, int x, int y)
         struct mdp5_crtc *mdp5_crtc = to_mdp5_crtc(crtc);
         struct mdp5_crtc_state *mdp5_cstate = to_mdp5_crtc_state(crtc->state);
         uint32_t flush_mask = mdp_ctl_flush_mask_cursor(0);
+        struct drm_device *dev = crtc->dev;
         uint32_t roi_w;
         uint32_t roi_h;
         unsigned long flags;
 
+        if (!mdp5_crtc->lm_cursor_enabled) {
+                dev_warn(dev->dev,
+                         "cursor_move is deprecated with cursor planes\n");
+                return -EINVAL;
+        }
+
         /* don't support LM cursors when we we have source split enabled */
         if (mdp5_cstate->pipeline.r_mixer)
                 return -EINVAL;
@@ -993,16 +1013,6 @@ static const struct drm_crtc_funcs mdp5_crtc_funcs = {
         .atomic_print_state = mdp5_crtc_atomic_print_state,
 };
 
-static const struct drm_crtc_funcs mdp5_crtc_no_lm_cursor_funcs = {
-        .set_config = drm_atomic_helper_set_config,
-        .destroy = mdp5_crtc_destroy,
-        .page_flip = drm_atomic_helper_page_flip,
-        .reset = mdp5_crtc_reset,
-        .atomic_duplicate_state = mdp5_crtc_duplicate_state,
-        .atomic_destroy_state = mdp5_crtc_destroy_state,
-        .atomic_print_state = mdp5_crtc_atomic_print_state,
-};
-
 static const struct drm_crtc_helper_funcs mdp5_crtc_helper_funcs = {
         .mode_set_nofb = mdp5_crtc_mode_set_nofb,
         .atomic_check = mdp5_crtc_atomic_check,
@@ -1171,12 +1181,10 @@ struct drm_crtc *mdp5_crtc_init(struct drm_device *dev,
         mdp5_crtc->err.irq = mdp5_crtc_err_irq;
         mdp5_crtc->pp_done.irq = mdp5_crtc_pp_done_irq;
 
-        if (cursor_plane)
-                drm_crtc_init_with_planes(dev, crtc, plane, cursor_plane,
-                                          &mdp5_crtc_no_lm_cursor_funcs, NULL);
-        else
-                drm_crtc_init_with_planes(dev, crtc, plane, NULL,
-                                          &mdp5_crtc_funcs, NULL);
+        mdp5_crtc->lm_cursor_enabled = cursor_plane ? false : true;
+
+        drm_crtc_init_with_planes(dev, crtc, plane, cursor_plane,
+                                  &mdp5_crtc_funcs, NULL);
 
         drm_flip_work_init(&mdp5_crtc->unref_cursor_work,
                         "unref cursor", unref_cursor_worker);