From: Sean Paul <seanp...@chromium.org>

Instead of rolling our own implementation for tracking when PSR should
be [in]active, use the PSR helpers to do the heavy lifting.

Cc: Zain Wang <w...@rock-chips.com>
Cc: Tomasz Figa <tf...@chromium.org>
Signed-off-by: Sean Paul <seanp...@chromium.org>
---
 .../drm/bridge/analogix/analogix_dp_core.c    | 205 ++++++++-----
 .../drm/bridge/analogix/analogix_dp_core.h    |   1 -
 drivers/gpu/drm/rockchip/Makefile             |   3 +-
 .../gpu/drm/rockchip/analogix_dp-rockchip.c   |  70 ++---
 drivers/gpu/drm/rockchip/rockchip_drm_drv.c   |  12 +-
 drivers/gpu/drm/rockchip/rockchip_drm_fb.c    |  16 -
 drivers/gpu/drm/rockchip/rockchip_drm_psr.c   | 290 ------------------
 drivers/gpu/drm/rockchip/rockchip_drm_psr.h   |  30 --
 drivers/gpu/drm/rockchip/rockchip_drm_vop.c   |  21 +-
 include/drm/bridge/analogix_dp.h              |   4 +-
 10 files changed, 177 insertions(+), 475 deletions(-)
 delete mode 100644 drivers/gpu/drm/rockchip/rockchip_drm_psr.c
 delete mode 100644 drivers/gpu/drm/rockchip/rockchip_drm_psr.h

diff --git a/drivers/gpu/drm/bridge/analogix/analogix_dp_core.c 
b/drivers/gpu/drm/bridge/analogix/analogix_dp_core.c
index af34554a5a02..de98cb3570be 100644
--- a/drivers/gpu/drm/bridge/analogix/analogix_dp_core.c
+++ b/drivers/gpu/drm/bridge/analogix/analogix_dp_core.c
@@ -28,6 +28,7 @@
 #include <drm/drm_crtc.h>
 #include <drm/drm_panel.h>
 #include <drm/drm_probe_helper.h>
+#include <drm/drm_psr_helper.h>
 
 #include <drm/bridge/analogix_dp.h>
 
@@ -106,63 +107,19 @@ static int analogix_dp_detect_hpd(struct 
analogix_dp_device *dp)
        return 0;
 }
 
-int analogix_dp_psr_enabled(struct analogix_dp_device *dp)
+bool analogix_dp_in_psr_transition(struct analogix_dp_device *dp)
 {
+       struct drm_mode_config *config = &dp->drm_dev->mode_config;
 
-       return dp->psr_enable;
-}
-EXPORT_SYMBOL_GPL(analogix_dp_psr_enabled);
+       /* This should only be called from the encoder enable/disable */
+       if (WARN_ON(!drm_modeset_is_locked(&config->connection_mutex)))
+               return false;
 
-int analogix_dp_enable_psr(struct analogix_dp_device *dp)
-{
-       struct edp_vsc_psr psr_vsc;
-
-       if (!dp->psr_enable)
-               return 0;
-
-       /* Prepare VSC packet as per EDP 1.4 spec, Table 6.9 */
-       memset(&psr_vsc, 0, sizeof(psr_vsc));
-       psr_vsc.sdp_header.HB0 = 0;
-       psr_vsc.sdp_header.HB1 = 0x7;
-       psr_vsc.sdp_header.HB2 = 0x2;
-       psr_vsc.sdp_header.HB3 = 0x8;
-
-       psr_vsc.DB0 = 0;
-       psr_vsc.DB1 = EDP_VSC_PSR_STATE_ACTIVE | EDP_VSC_PSR_CRC_VALUES_VALID;
-
-       return analogix_dp_send_psr_spd(dp, &psr_vsc, true);
+       return dp->connector.state->psr_transition;
 }
-EXPORT_SYMBOL_GPL(analogix_dp_enable_psr);
+EXPORT_SYMBOL_GPL(analogix_dp_in_psr_transition);
 
-int analogix_dp_disable_psr(struct analogix_dp_device *dp)
-{
-       struct edp_vsc_psr psr_vsc;
-       int ret;
-
-       if (!dp->psr_enable)
-               return 0;
-
-       /* Prepare VSC packet as per EDP 1.4 spec, Table 6.9 */
-       memset(&psr_vsc, 0, sizeof(psr_vsc));
-       psr_vsc.sdp_header.HB0 = 0;
-       psr_vsc.sdp_header.HB1 = 0x7;
-       psr_vsc.sdp_header.HB2 = 0x2;
-       psr_vsc.sdp_header.HB3 = 0x8;
-
-       psr_vsc.DB0 = 0;
-       psr_vsc.DB1 = 0;
-
-       ret = drm_dp_dpcd_writeb(&dp->aux, DP_SET_POWER, DP_SET_POWER_D0);
-       if (ret != 1) {
-               dev_err(dp->dev, "Failed to set DP Power0 %d\n", ret);
-               return ret;
-       }
-
-       return analogix_dp_send_psr_spd(dp, &psr_vsc, false);
-}
-EXPORT_SYMBOL_GPL(analogix_dp_disable_psr);
-
-static int analogix_dp_detect_sink_psr(struct analogix_dp_device *dp)
+static bool analogix_dp_detect_sink_psr(struct analogix_dp_device *dp)
 {
        unsigned char psr_version;
        int ret;
@@ -170,14 +127,11 @@ static int analogix_dp_detect_sink_psr(struct 
analogix_dp_device *dp)
        ret = drm_dp_dpcd_readb(&dp->aux, DP_PSR_SUPPORT, &psr_version);
        if (ret != 1) {
                dev_err(dp->dev, "failed to get PSR version, disable it\n");
-               return ret;
+               return false;
        }
 
        dev_dbg(dp->dev, "Panel PSR version : %x\n", psr_version);
-
-       dp->psr_enable = (psr_version & DP_PSR_IS_SUPPORTED) ? true : false;
-
-       return 0;
+       return psr_version & DP_PSR_IS_SUPPORTED;
 }
 
 static int analogix_dp_enable_sink_psr(struct analogix_dp_device *dp)
@@ -200,7 +154,7 @@ static int analogix_dp_enable_sink_psr(struct 
analogix_dp_device *dp)
        }
 
        /* Main-Link transmitter remains active during PSR active states */
-       psr_en = DP_PSR_MAIN_LINK_ACTIVE | DP_PSR_CRC_VERIFICATION;
+       psr_en = DP_PSR_CRC_VERIFICATION;
        ret = drm_dp_dpcd_writeb(&dp->aux, DP_PSR_EN_CFG, psr_en);
        if (ret != 1) {
                dev_err(dp->dev, "failed to set panel psr\n");
@@ -208,8 +162,7 @@ static int analogix_dp_enable_sink_psr(struct 
analogix_dp_device *dp)
        }
 
        /* Enable psr function */
-       psr_en = DP_PSR_ENABLE | DP_PSR_MAIN_LINK_ACTIVE |
-                DP_PSR_CRC_VERIFICATION;
+       psr_en = DP_PSR_ENABLE | DP_PSR_CRC_VERIFICATION;
        ret = drm_dp_dpcd_writeb(&dp->aux, DP_PSR_EN_CFG, psr_en);
        if (ret != 1) {
                dev_err(dp->dev, "failed to set panel psr\n");
@@ -221,7 +174,6 @@ static int analogix_dp_enable_sink_psr(struct 
analogix_dp_device *dp)
        return 0;
 end:
        dev_err(dp->dev, "enable psr fail, force to disable psr\n");
-       dp->psr_enable = false;
 
        return ret;
 }
@@ -1036,25 +988,94 @@ static int analogix_dp_commit(struct analogix_dp_device 
*dp)
                }
        }
 
-       ret = analogix_dp_detect_sink_psr(dp);
-       if (ret)
-               return ret;
-
        /* Check whether panel supports fast training */
        ret = analogix_dp_fast_link_train_detection(dp);
        if (ret)
-               dp->psr_enable = false;
+               return ret;
 
-       if (dp->psr_enable) {
+       if (analogix_dp_detect_sink_psr(dp)) {
                ret = analogix_dp_enable_sink_psr(dp);
                if (ret)
                        return ret;
+
+               ret = drm_psr_helper_register(&dp->connector);
+               if (ret)
+                       return ret;
        }
 
+       return ret;
+}
+
+static int analogix_dp_enable_psr(struct analogix_dp_device *dp)
+{
+       struct edp_vsc_psr psr_vsc;
+       int ret;
+       u8 sink;
+
+       ret = drm_dp_dpcd_readb(&dp->aux, DP_PSR_STATUS, &sink);
+       if (ret != 1)
+               DRM_DEV_ERROR(dp->dev, "Failed to read psr status %d\n", ret);
+       else if (sink == DP_PSR_SINK_ACTIVE_RFB)
+               return 0;
+
+       /* Prepare VSC packet as per EDP 1.4 spec, Table 6.9 */
+       memset(&psr_vsc, 0, sizeof(psr_vsc));
+       psr_vsc.sdp_header.HB0 = 0;
+       psr_vsc.sdp_header.HB1 = 0x7;
+       psr_vsc.sdp_header.HB2 = 0x2;
+       psr_vsc.sdp_header.HB3 = 0x8;
+       psr_vsc.DB0 = 0;
+       psr_vsc.DB1 = EDP_VSC_PSR_STATE_ACTIVE | EDP_VSC_PSR_CRC_VALUES_VALID;
+
+       ret = analogix_dp_send_psr_spd(dp, &psr_vsc, true);
+       if (!ret)
+               analogix_dp_set_analog_power_down(dp, POWER_ALL, true);
 
        return ret;
 }
 
+static int analogix_dp_disable_psr(struct analogix_dp_device *dp)
+{
+       struct edp_vsc_psr psr_vsc;
+       int ret;
+       u8 sink;
+
+       analogix_dp_set_analog_power_down(dp, POWER_ALL, false);
+
+       ret = drm_dp_dpcd_writeb(&dp->aux, DP_SET_POWER, DP_SET_POWER_D0);
+       if (ret != 1) {
+               DRM_DEV_ERROR(dp->dev, "Failed to set DP Power0 %d\n", ret);
+               return ret;
+       }
+
+       ret = drm_dp_dpcd_readb(&dp->aux, DP_PSR_STATUS, &sink);
+       if (ret != 1) {
+               DRM_DEV_ERROR(dp->dev, "Failed to read psr status %d\n", ret);
+               return ret;
+       } else if (sink == DP_PSR_SINK_INACTIVE) {
+               DRM_DEV_ERROR(dp->dev, "sink inactive, skip disable psr");
+               return 0;
+       }
+
+       ret = analogix_dp_train_link(dp);
+       if (ret) {
+               DRM_DEV_ERROR(dp->dev, "Failed to train the link %d\n", ret);
+               return ret;
+       }
+
+       /* Prepare VSC packet as per EDP 1.4 spec, Table 6.9 */
+       memset(&psr_vsc, 0, sizeof(psr_vsc));
+       psr_vsc.sdp_header.HB0 = 0;
+       psr_vsc.sdp_header.HB1 = 0x7;
+       psr_vsc.sdp_header.HB2 = 0x2;
+       psr_vsc.sdp_header.HB3 = 0x8;
+
+       psr_vsc.DB0 = 0;
+       psr_vsc.DB1 = 0;
+
+       return analogix_dp_send_psr_spd(dp, &psr_vsc, true);
+}
+
 /*
  * This function is a bit of a catch-all for panel preparation, hopefully
  * simplifying the logic of functions that need to prepare/unprepare the panel
@@ -1244,6 +1265,10 @@ static void analogix_dp_bridge_pre_enable(struct 
drm_bridge *bridge)
        struct analogix_dp_device *dp = bridge->driver_private;
        int ret;
 
+       /* Don't touch the panel if we're coming back from PSR */
+       if (dp->connector.state->psr_transition)
+               return;
+
        ret = analogix_dp_prepare_panel(dp, true, true);
        if (ret)
                DRM_ERROR("failed to setup the panel ret = %d\n", ret);
@@ -1309,6 +1334,14 @@ static void analogix_dp_bridge_enable(struct drm_bridge 
*bridge)
        struct analogix_dp_device *dp = bridge->driver_private;
        int timeout_loop = 0;
 
+       /* Not a full enable, just disable PSR and continue */
+       if (dp->connector.state->psr_transition) {
+               int ret = analogix_dp_disable_psr(dp);
+               if (ret)
+                       DRM_ERROR("Failed to disable psr %d\n", ret);
+               return;
+       }
+
        if (dp->dpms_mode == DRM_MODE_DPMS_ON)
                return;
 
@@ -1356,11 +1389,38 @@ static void analogix_dp_bridge_disable(struct 
drm_bridge *bridge)
        if (ret)
                DRM_ERROR("failed to setup the panel ret = %d\n", ret);
 
-       dp->psr_enable = false;
+       drm_psr_helper_unregister(&dp->connector);
+
        dp->fast_train_enable = false;
        dp->dpms_mode = DRM_MODE_DPMS_OFF;
 }
 
+static void analogix_dp_bridge_atomic_disable(struct drm_bridge *bridge)
+{
+       struct analogix_dp_device *dp = bridge->driver_private;
+       struct drm_connector_state *conn_state = dp->connector.state;
+
+       /* Don't do a full disable on PSR transitions */
+       if (conn_state->psr_transition)
+               return;
+
+       analogix_dp_bridge_disable(bridge);
+}
+
+static void analogix_dp_bridge_post_disable(struct drm_bridge *bridge)
+{
+       struct analogix_dp_device *dp = bridge->driver_private;
+       struct drm_connector_state *conn_state = dp->connector.state;
+       int ret;
+
+       if (conn_state->psr_transition) {
+               ret = analogix_dp_enable_psr(dp);
+               if (ret)
+                       DRM_ERROR("Failed to enable psr (%d)\n", ret);
+               return;
+       }
+}
+
 static void analogix_dp_bridge_mode_set(struct drm_bridge *bridge,
                                const struct drm_display_mode *orig_mode,
                                const struct drm_display_mode *mode)
@@ -1440,16 +1500,11 @@ static void analogix_dp_bridge_mode_set(struct 
drm_bridge *bridge,
                video->interlaced = true;
 }
 
-static void analogix_dp_bridge_nop(struct drm_bridge *bridge)
-{
-       /* do nothing */
-}
-
 static const struct drm_bridge_funcs analogix_dp_bridge_funcs = {
        .pre_enable = analogix_dp_bridge_pre_enable,
        .enable = analogix_dp_bridge_enable,
-       .disable = analogix_dp_bridge_disable,
-       .post_disable = analogix_dp_bridge_nop,
+       .disable = analogix_dp_bridge_atomic_disable,
+       .post_disable = analogix_dp_bridge_post_disable,
        .mode_set = analogix_dp_bridge_mode_set,
        .attach = analogix_dp_bridge_attach,
 };
diff --git a/drivers/gpu/drm/bridge/analogix/analogix_dp_core.h 
b/drivers/gpu/drm/bridge/analogix/analogix_dp_core.h
index 769255dc6e99..e4cdd69107e3 100644
--- a/drivers/gpu/drm/bridge/analogix/analogix_dp_core.h
+++ b/drivers/gpu/drm/bridge/analogix/analogix_dp_core.h
@@ -173,7 +173,6 @@ struct analogix_dp_device {
        int                     dpms_mode;
        int                     hpd_gpio;
        bool                    force_hpd;
-       bool                    psr_enable;
        bool                    fast_train_enable;
 
        struct mutex            panel_lock;
diff --git a/drivers/gpu/drm/rockchip/Makefile 
b/drivers/gpu/drm/rockchip/Makefile
index f6fc9d5dd0ad..a777726c23cb 100644
--- a/drivers/gpu/drm/rockchip/Makefile
+++ b/drivers/gpu/drm/rockchip/Makefile
@@ -4,8 +4,7 @@
 # Direct Rendering Infrastructure (DRI) in XFree86 4.1.0 and higher.
 
 rockchipdrm-y := rockchip_drm_drv.o rockchip_drm_fb.o \
-               rockchip_drm_gem.o rockchip_drm_psr.o \
-               rockchip_drm_vop.o rockchip_vop_reg.o
+               rockchip_drm_gem.o rockchip_drm_vop.o rockchip_vop_reg.o
 rockchipdrm-$(CONFIG_DRM_FBDEV_EMULATION) += rockchip_drm_fbdev.o
 
 rockchipdrm-$(CONFIG_ROCKCHIP_ANALOGIX_DP) += analogix_dp-rockchip.o
diff --git a/drivers/gpu/drm/rockchip/analogix_dp-rockchip.c 
b/drivers/gpu/drm/rockchip/analogix_dp-rockchip.c
index bc4423624209..26090b4ba4ee 100644
--- a/drivers/gpu/drm/rockchip/analogix_dp-rockchip.c
+++ b/drivers/gpu/drm/rockchip/analogix_dp-rockchip.c
@@ -32,7 +32,6 @@
 #include <drm/bridge/analogix_dp.h>
 
 #include "rockchip_drm_drv.h"
-#include "rockchip_drm_psr.h"
 #include "rockchip_drm_vop.h"
 
 #define RK3288_GRF_SOC_CON6            0x25c
@@ -77,29 +76,6 @@ struct rockchip_dp_device {
        struct analogix_dp_plat_data plat_data;
 };
 
-static int analogix_dp_psr_set(struct drm_encoder *encoder, bool enabled)
-{
-       struct rockchip_dp_device *dp = to_dp(encoder);
-       int ret;
-
-       if (!analogix_dp_psr_enabled(dp->adp))
-               return 0;
-
-       DRM_DEV_DEBUG(dp->dev, "%s PSR...\n", enabled ? "Entry" : "Exit");
-
-       ret = rockchip_drm_wait_vact_end(dp->encoder.crtc,
-                                        PSR_WAIT_LINE_FLAG_TIMEOUT_MS);
-       if (ret) {
-               DRM_DEV_ERROR(dp->dev, "line flag interrupt did not arrive\n");
-               return -ETIMEDOUT;
-       }
-
-       if (enabled)
-               return analogix_dp_enable_psr(dp->adp);
-       else
-               return analogix_dp_disable_psr(dp->adp);
-}
-
 static int rockchip_dp_pre_init(struct rockchip_dp_device *dp)
 {
        reset_control_assert(dp->rst);
@@ -130,21 +106,9 @@ static int rockchip_dp_poweron_start(struct 
analogix_dp_plat_data *plat_data)
        return ret;
 }
 
-static int rockchip_dp_poweron_end(struct analogix_dp_plat_data *plat_data)
-{
-       struct rockchip_dp_device *dp = to_dp(plat_data);
-
-       return rockchip_drm_psr_inhibit_put(&dp->encoder);
-}
-
 static int rockchip_dp_powerdown(struct analogix_dp_plat_data *plat_data)
 {
        struct rockchip_dp_device *dp = to_dp(plat_data);
-       int ret;
-
-       ret = rockchip_drm_psr_inhibit_get(&dp->encoder);
-       if (ret != 0)
-               return ret;
 
        clk_disable_unprepare(dp->pclk);
 
@@ -190,6 +154,9 @@ static void rockchip_dp_drm_encoder_enable(struct 
drm_encoder *encoder)
        int ret;
        u32 val;
 
+       if (analogix_dp_in_psr_transition(dp->adp))
+               return;
+
        ret = drm_of_encoder_active_endpoint_id(dp->dev->of_node, encoder);
        if (ret < 0)
                return;
@@ -214,9 +181,24 @@ static void rockchip_dp_drm_encoder_enable(struct 
drm_encoder *encoder)
        clk_disable_unprepare(dp->grfclk);
 }
 
-static void rockchip_dp_drm_encoder_nop(struct drm_encoder *encoder)
+static void rockchip_dp_drm_encoder_disable(struct drm_encoder *encoder)
 {
-       /* do nothing */
+       struct rockchip_dp_device *dp = to_dp(encoder);
+       struct drm_crtc *crtc;
+       int ret;
+
+       drm_for_each_crtc(crtc, dp->drm_dev) {
+               if (!(crtc->state->encoder_mask & drm_encoder_mask(encoder)))
+                       continue;
+
+               if (!crtc->state->psr_transition)
+                       continue;
+
+               ret = rockchip_drm_wait_vact_end(crtc,
+                                                PSR_WAIT_LINE_FLAG_TIMEOUT_MS);
+               if (ret)
+                       DRM_DEV_ERROR(dp->dev, "line flag irq timed out\n");
+       }
 }
 
 static int
@@ -246,7 +228,7 @@ static struct drm_encoder_helper_funcs 
rockchip_dp_encoder_helper_funcs = {
        .mode_fixup = rockchip_dp_drm_encoder_mode_fixup,
        .mode_set = rockchip_dp_drm_encoder_mode_set,
        .enable = rockchip_dp_drm_encoder_enable,
-       .disable = rockchip_dp_drm_encoder_nop,
+       .disable = rockchip_dp_drm_encoder_disable,
        .atomic_check = rockchip_dp_drm_encoder_atomic_check,
 };
 
@@ -338,23 +320,16 @@ static int rockchip_dp_bind(struct device *dev, struct 
device *master,
 
        dp->plat_data.dev_type = dp->data->chip_type;
        dp->plat_data.power_on_start = rockchip_dp_poweron_start;
-       dp->plat_data.power_on_end = rockchip_dp_poweron_end;
        dp->plat_data.power_off = rockchip_dp_powerdown;
        dp->plat_data.get_modes = rockchip_dp_get_modes;
 
-       ret = rockchip_drm_psr_register(&dp->encoder, analogix_dp_psr_set);
-       if (ret < 0)
-               goto err_cleanup_encoder;
-
        dp->adp = analogix_dp_bind(dev, dp->drm_dev, &dp->plat_data);
        if (IS_ERR(dp->adp)) {
                ret = PTR_ERR(dp->adp);
-               goto err_unreg_psr;
+               goto err_cleanup_encoder;
        }
 
        return 0;
-err_unreg_psr:
-       rockchip_drm_psr_unregister(&dp->encoder);
 err_cleanup_encoder:
        dp->encoder.funcs->destroy(&dp->encoder);
        return ret;
@@ -366,7 +341,6 @@ static void rockchip_dp_unbind(struct device *dev, struct 
device *master,
        struct rockchip_dp_device *dp = dev_get_drvdata(dev);
 
        analogix_dp_unbind(dp->adp);
-       rockchip_drm_psr_unregister(&dp->encoder);
        dp->encoder.funcs->destroy(&dp->encoder);
 
        dp->adp = ERR_PTR(-ENODEV);
diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_drv.c 
b/drivers/gpu/drm/rockchip/rockchip_drm_drv.c
index d7fa17f12769..222258497398 100644
--- a/drivers/gpu/drm/rockchip/rockchip_drm_drv.c
+++ b/drivers/gpu/drm/rockchip/rockchip_drm_drv.c
@@ -19,6 +19,7 @@
 #include <drm/drm_gem_cma_helper.h>
 #include <drm/drm_of.h>
 #include <drm/drm_probe_helper.h>
+#include <drm/drm_psr_helper.h>
 #include <linux/dma-mapping.h>
 #include <linux/dma-iommu.h>
 #include <linux/pm_runtime.h>
@@ -40,6 +41,8 @@
 #define DRIVER_MAJOR   1
 #define DRIVER_MINOR   0
 
+#define ROCKCHIP_DRM_PSR_ENTRY_DELAY_MS 100
+
 static bool is_support_iommu = true;
 static struct drm_driver rockchip_drm_driver;
 
@@ -145,10 +148,14 @@ static int rockchip_drm_bind(struct device *dev)
 
        rockchip_drm_mode_config_init(drm_dev);
 
+       ret = drm_psr_helper_init(drm_dev, ROCKCHIP_DRM_PSR_ENTRY_DELAY_MS);
+       if (ret)
+               goto err_mode_config_cleanup;
+
        /* Try to bind all sub drivers. */
        ret = component_bind_all(dev, drm_dev);
        if (ret)
-               goto err_mode_config_cleanup;
+               goto err_psr_helper_cleanup;
 
        ret = drm_vblank_init(drm_dev, drm_dev->mode_config.num_crtc);
        if (ret)
@@ -179,6 +186,8 @@ static int rockchip_drm_bind(struct device *dev)
        rockchip_drm_fbdev_fini(drm_dev);
 err_unbind_all:
        component_unbind_all(dev, drm_dev);
+err_psr_helper_cleanup:
+       drm_psr_helper_cleanup(drm_dev);
 err_mode_config_cleanup:
        drm_mode_config_cleanup(drm_dev);
        rockchip_iommu_cleanup(drm_dev);
@@ -200,6 +209,7 @@ static void rockchip_drm_unbind(struct device *dev)
 
        drm_atomic_helper_shutdown(drm_dev);
        component_unbind_all(dev, drm_dev);
+       drm_psr_helper_cleanup(drm_dev);
        drm_mode_config_cleanup(drm_dev);
        rockchip_iommu_cleanup(drm_dev);
 
diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_fb.c 
b/drivers/gpu/drm/rockchip/rockchip_drm_fb.c
index 97438bbbe389..7e121875e3c9 100644
--- a/drivers/gpu/drm/rockchip/rockchip_drm_fb.c
+++ b/drivers/gpu/drm/rockchip/rockchip_drm_fb.c
@@ -23,22 +23,10 @@
 #include "rockchip_drm_drv.h"
 #include "rockchip_drm_fb.h"
 #include "rockchip_drm_gem.h"
-#include "rockchip_drm_psr.h"
-
-static int rockchip_drm_fb_dirty(struct drm_framebuffer *fb,
-                                struct drm_file *file,
-                                unsigned int flags, unsigned int color,
-                                struct drm_clip_rect *clips,
-                                unsigned int num_clips)
-{
-       rockchip_drm_psr_flush_all(fb->dev);
-       return 0;
-}
 
 static const struct drm_framebuffer_funcs rockchip_drm_fb_funcs = {
        .destroy       = drm_gem_fb_destroy,
        .create_handle = drm_gem_fb_create_handle,
-       .dirty         = rockchip_drm_fb_dirty,
 };
 
 static struct drm_framebuffer *
@@ -132,8 +120,6 @@ rockchip_atomic_helper_commit_tail_rpm(struct 
drm_atomic_state *old_state)
 {
        struct drm_device *dev = old_state->dev;
 
-       rockchip_drm_psr_inhibit_get_state(old_state);
-
        drm_atomic_helper_commit_modeset_disables(dev, old_state);
 
        drm_atomic_helper_commit_modeset_enables(dev, old_state);
@@ -141,8 +127,6 @@ rockchip_atomic_helper_commit_tail_rpm(struct 
drm_atomic_state *old_state)
        drm_atomic_helper_commit_planes(dev, old_state,
                                        DRM_PLANE_COMMIT_ACTIVE_ONLY);
 
-       rockchip_drm_psr_inhibit_put_state(old_state);
-
        drm_atomic_helper_commit_hw_done(old_state);
 
        drm_atomic_helper_wait_for_vblanks(dev, old_state);
diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_psr.c 
b/drivers/gpu/drm/rockchip/rockchip_drm_psr.c
deleted file mode 100644
index a0c8bd235b67..000000000000
--- a/drivers/gpu/drm/rockchip/rockchip_drm_psr.c
+++ /dev/null
@@ -1,290 +0,0 @@
-/*
- * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
- * Author: Yakir Yang <y...@rock-chips.com>
- *
- * This software is licensed under the terms of the GNU General Public
- * License version 2, as published by the Free Software Foundation, and
- * may be copied, distributed, and modified under those terms.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
- * GNU General Public License for more details.
- */
-
-#include <drm/drmP.h>
-#include <drm/drm_atomic.h>
-#include <drm/drm_probe_helper.h>
-
-#include "rockchip_drm_drv.h"
-#include "rockchip_drm_psr.h"
-
-#define PSR_FLUSH_TIMEOUT_MS   100
-
-struct psr_drv {
-       struct list_head        list;
-       struct drm_encoder      *encoder;
-
-       struct mutex            lock;
-       int                     inhibit_count;
-       bool                    enabled;
-
-       struct delayed_work     flush_work;
-
-       int (*set)(struct drm_encoder *encoder, bool enable);
-};
-
-static struct psr_drv *find_psr_by_encoder(struct drm_encoder *encoder)
-{
-       struct rockchip_drm_private *drm_drv = encoder->dev->dev_private;
-       struct psr_drv *psr;
-
-       mutex_lock(&drm_drv->psr_list_lock);
-       list_for_each_entry(psr, &drm_drv->psr_list, list) {
-               if (psr->encoder == encoder)
-                       goto out;
-       }
-       psr = ERR_PTR(-ENODEV);
-
-out:
-       mutex_unlock(&drm_drv->psr_list_lock);
-       return psr;
-}
-
-static int psr_set_state_locked(struct psr_drv *psr, bool enable)
-{
-       int ret;
-
-       if (psr->inhibit_count > 0)
-               return -EINVAL;
-
-       if (enable == psr->enabled)
-               return 0;
-
-       ret = psr->set(psr->encoder, enable);
-       if (ret)
-               return ret;
-
-       psr->enabled = enable;
-       return 0;
-}
-
-static void psr_flush_handler(struct work_struct *work)
-{
-       struct psr_drv *psr = container_of(to_delayed_work(work),
-                                          struct psr_drv, flush_work);
-
-       mutex_lock(&psr->lock);
-       psr_set_state_locked(psr, true);
-       mutex_unlock(&psr->lock);
-}
-
-/**
- * rockchip_drm_psr_inhibit_put - release PSR inhibit on given encoder
- * @encoder: encoder to obtain the PSR encoder
- *
- * Decrements PSR inhibit count on given encoder. Should be called only
- * for a PSR inhibit count increment done before. If PSR inhibit counter
- * reaches zero, PSR flush work is scheduled to make the hardware enter
- * PSR mode in PSR_FLUSH_TIMEOUT_MS.
- *
- * Returns:
- * Zero on success, negative errno on failure.
- */
-int rockchip_drm_psr_inhibit_put(struct drm_encoder *encoder)
-{
-       struct psr_drv *psr = find_psr_by_encoder(encoder);
-
-       if (IS_ERR(psr))
-               return PTR_ERR(psr);
-
-       mutex_lock(&psr->lock);
-       --psr->inhibit_count;
-       WARN_ON(psr->inhibit_count < 0);
-       if (!psr->inhibit_count)
-               mod_delayed_work(system_wq, &psr->flush_work,
-                                PSR_FLUSH_TIMEOUT_MS);
-       mutex_unlock(&psr->lock);
-
-       return 0;
-}
-EXPORT_SYMBOL(rockchip_drm_psr_inhibit_put);
-
-void rockchip_drm_psr_inhibit_get_state(struct drm_atomic_state *state)
-{
-       struct drm_crtc *crtc;
-       struct drm_crtc_state *crtc_state;
-       struct drm_encoder *encoder;
-       u32 encoder_mask = 0;
-       int i;
-
-       for_each_old_crtc_in_state(state, crtc, crtc_state, i) {
-               encoder_mask |= crtc_state->encoder_mask;
-               encoder_mask |= crtc->state->encoder_mask;
-       }
-
-       drm_for_each_encoder_mask(encoder, state->dev, encoder_mask)
-               rockchip_drm_psr_inhibit_get(encoder);
-}
-EXPORT_SYMBOL(rockchip_drm_psr_inhibit_get_state);
-
-void rockchip_drm_psr_inhibit_put_state(struct drm_atomic_state *state)
-{
-       struct drm_crtc *crtc;
-       struct drm_crtc_state *crtc_state;
-       struct drm_encoder *encoder;
-       u32 encoder_mask = 0;
-       int i;
-
-       for_each_old_crtc_in_state(state, crtc, crtc_state, i) {
-               encoder_mask |= crtc_state->encoder_mask;
-               encoder_mask |= crtc->state->encoder_mask;
-       }
-
-       drm_for_each_encoder_mask(encoder, state->dev, encoder_mask)
-               rockchip_drm_psr_inhibit_put(encoder);
-}
-EXPORT_SYMBOL(rockchip_drm_psr_inhibit_put_state);
-
-/**
- * rockchip_drm_psr_inhibit_get - acquire PSR inhibit on given encoder
- * @encoder: encoder to obtain the PSR encoder
- *
- * Increments PSR inhibit count on given encoder. This function guarantees
- * that after it returns PSR is turned off on given encoder and no PSR-related
- * hardware state change occurs at least until a matching call to
- * rockchip_drm_psr_inhibit_put() is done.
- *
- * Returns:
- * Zero on success, negative errno on failure.
- */
-int rockchip_drm_psr_inhibit_get(struct drm_encoder *encoder)
-{
-       struct psr_drv *psr = find_psr_by_encoder(encoder);
-
-       if (IS_ERR(psr))
-               return PTR_ERR(psr);
-
-       mutex_lock(&psr->lock);
-       psr_set_state_locked(psr, false);
-       ++psr->inhibit_count;
-       mutex_unlock(&psr->lock);
-       cancel_delayed_work_sync(&psr->flush_work);
-
-       return 0;
-}
-EXPORT_SYMBOL(rockchip_drm_psr_inhibit_get);
-
-static void rockchip_drm_do_flush(struct psr_drv *psr)
-{
-       cancel_delayed_work_sync(&psr->flush_work);
-
-       mutex_lock(&psr->lock);
-       if (!psr_set_state_locked(psr, false))
-               mod_delayed_work(system_wq, &psr->flush_work,
-                                PSR_FLUSH_TIMEOUT_MS);
-       mutex_unlock(&psr->lock);
-}
-
-/**
- * rockchip_drm_psr_flush_all - force to flush all registered PSR encoders
- * @dev: drm device
- *
- * Disable the PSR function for all registered encoders, and then enable the
- * PSR function back after PSR_FLUSH_TIMEOUT. If encoder PSR state have been
- * changed during flush time, then keep the state no change after flush
- * timeout.
- *
- * Returns:
- * Zero on success, negative errno on failure.
- */
-void rockchip_drm_psr_flush_all(struct drm_device *dev)
-{
-       struct rockchip_drm_private *drm_drv = dev->dev_private;
-       struct psr_drv *psr;
-
-       mutex_lock(&drm_drv->psr_list_lock);
-       list_for_each_entry(psr, &drm_drv->psr_list, list)
-               rockchip_drm_do_flush(psr);
-       mutex_unlock(&drm_drv->psr_list_lock);
-}
-EXPORT_SYMBOL(rockchip_drm_psr_flush_all);
-
-/**
- * rockchip_drm_psr_register - register encoder to psr driver
- * @encoder: encoder that obtain the PSR function
- * @psr_set: call back to set PSR state
- *
- * The function returns with PSR inhibit counter initialized with one
- * and the caller (typically encoder driver) needs to call
- * rockchip_drm_psr_inhibit_put() when it becomes ready to accept PSR
- * enable request.
- *
- * Returns:
- * Zero on success, negative errno on failure.
- */
-int rockchip_drm_psr_register(struct drm_encoder *encoder,
-                       int (*psr_set)(struct drm_encoder *, bool enable))
-{
-       struct rockchip_drm_private *drm_drv;
-       struct psr_drv *psr;
-
-       if (!encoder || !psr_set)
-               return -EINVAL;
-
-       drm_drv = encoder->dev->dev_private;
-
-       psr = kzalloc(sizeof(struct psr_drv), GFP_KERNEL);
-       if (!psr)
-               return -ENOMEM;
-
-       INIT_DELAYED_WORK(&psr->flush_work, psr_flush_handler);
-       mutex_init(&psr->lock);
-
-       psr->inhibit_count = 1;
-       psr->enabled = false;
-       psr->encoder = encoder;
-       psr->set = psr_set;
-
-       mutex_lock(&drm_drv->psr_list_lock);
-       list_add_tail(&psr->list, &drm_drv->psr_list);
-       mutex_unlock(&drm_drv->psr_list_lock);
-
-       return 0;
-}
-EXPORT_SYMBOL(rockchip_drm_psr_register);
-
-/**
- * rockchip_drm_psr_unregister - unregister encoder to psr driver
- * @encoder: encoder that obtain the PSR function
- * @psr_set: call back to set PSR state
- *
- * It is expected that the PSR inhibit counter is 1 when this function is
- * called, which corresponds to a state when related encoder has been
- * disconnected from any CRTCs and its driver called
- * rockchip_drm_psr_inhibit_get() to stop the PSR logic.
- *
- * Returns:
- * Zero on success, negative errno on failure.
- */
-void rockchip_drm_psr_unregister(struct drm_encoder *encoder)
-{
-       struct rockchip_drm_private *drm_drv = encoder->dev->dev_private;
-       struct psr_drv *psr, *n;
-
-       mutex_lock(&drm_drv->psr_list_lock);
-       list_for_each_entry_safe(psr, n, &drm_drv->psr_list, list) {
-               if (psr->encoder == encoder) {
-                       /*
-                        * Any other value would mean that the encoder
-                        * is still in use.
-                        */
-                       WARN_ON(psr->inhibit_count != 1);
-
-                       list_del(&psr->list);
-                       kfree(psr);
-               }
-       }
-       mutex_unlock(&drm_drv->psr_list_lock);
-}
-EXPORT_SYMBOL(rockchip_drm_psr_unregister);
diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_psr.h 
b/drivers/gpu/drm/rockchip/rockchip_drm_psr.h
deleted file mode 100644
index 25350ba3237b..000000000000
--- a/drivers/gpu/drm/rockchip/rockchip_drm_psr.h
+++ /dev/null
@@ -1,30 +0,0 @@
-/*
- * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
- * Author: Yakir Yang <y...@rock-chips.com>
- *
- * This software is licensed under the terms of the GNU General Public
- * License version 2, as published by the Free Software Foundation, and
- * may be copied, distributed, and modified under those terms.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
- * GNU General Public License for more details.
- */
-
-#ifndef __ROCKCHIP_DRM_PSR___
-#define __ROCKCHIP_DRM_PSR___
-
-void rockchip_drm_psr_flush_all(struct drm_device *dev);
-
-int rockchip_drm_psr_inhibit_put(struct drm_encoder *encoder);
-int rockchip_drm_psr_inhibit_get(struct drm_encoder *encoder);
-
-void rockchip_drm_psr_inhibit_get_state(struct drm_atomic_state *state);
-void rockchip_drm_psr_inhibit_put_state(struct drm_atomic_state *state);
-
-int rockchip_drm_psr_register(struct drm_encoder *encoder,
-                       int (*psr_set)(struct drm_encoder *, bool enable));
-void rockchip_drm_psr_unregister(struct drm_encoder *encoder);
-
-#endif /* __ROCKCHIP_DRM_PSR__ */
diff --git a/drivers/gpu/drm/rockchip/rockchip_drm_vop.c 
b/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
index c7d4c6073ea5..66c99d57e62a 100644
--- a/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
+++ b/drivers/gpu/drm/rockchip/rockchip_drm_vop.c
@@ -42,7 +42,6 @@
 #include "rockchip_drm_drv.h"
 #include "rockchip_drm_gem.h"
 #include "rockchip_drm_fb.h"
-#include "rockchip_drm_psr.h"
 #include "rockchip_drm_vop.h"
 #include "rockchip_rgb.h"
 
@@ -541,7 +540,7 @@ static void vop_core_clks_disable(struct vop *vop)
        clk_disable(vop->hclk);
 }
 
-static int vop_enable(struct drm_crtc *crtc)
+static int vop_enable(struct drm_crtc *crtc, struct drm_crtc_state *old_state)
 {
        struct vop *vop = to_vop(crtc);
        int ret, i;
@@ -581,12 +580,18 @@ static int vop_enable(struct drm_crtc *crtc)
         * We need to make sure that all windows are disabled before we
         * enable the crtc. Otherwise we might try to scan from a destroyed
         * buffer later.
+        *
+        * In the case of enable-after-PSR, we don't need to worry about this
+        * case since the buffer is guaranteed to be valid and disabling the
+        * window will result in screen glitches on PSR exit.
         */
-       for (i = 0; i < vop->data->win_size; i++) {
-               struct vop_win *vop_win = &vop->win[i];
-               const struct vop_win_data *win = vop_win->data;
+       if (!old_state->psr_transition) {
+               for (i = 0; i < vop->data->win_size; i++) {
+                       struct vop_win *vop_win = &vop->win[i];
+                       const struct vop_win_data *win = vop_win->data;
 
-               VOP_WIN_SET(vop, win, enable, 0);
+                       VOP_WIN_SET(vop, win, enable, 0);
+               }
        }
        spin_unlock(&vop->reg_lock);
 
@@ -937,12 +942,10 @@ static void vop_plane_atomic_async_update(struct 
drm_plane *plane,
        }
 
        if (vop->is_enabled) {
-               rockchip_drm_psr_inhibit_get_state(new_state->state);
                vop_plane_atomic_update(plane, plane->state);
                spin_lock(&vop->reg_lock);
                vop_cfg_done(vop);
                spin_unlock(&vop->reg_lock);
-               rockchip_drm_psr_inhibit_put_state(new_state->state);
        }
 
        plane->funcs->atomic_destroy_state(plane, plane_state);
@@ -1035,7 +1038,7 @@ static void vop_crtc_atomic_enable(struct drm_crtc *crtc,
 
        WARN_ON(vop->event);
 
-       ret = vop_enable(crtc);
+       ret = vop_enable(crtc, old_state);
        if (ret) {
                mutex_unlock(&vop->vop_lock);
                DRM_DEV_ERROR(vop->dev, "Failed to enable vop (%d)\n", ret);
diff --git a/include/drm/bridge/analogix_dp.h b/include/drm/bridge/analogix_dp.h
index 475b706b49de..29ce16ef0926 100644
--- a/include/drm/bridge/analogix_dp.h
+++ b/include/drm/bridge/analogix_dp.h
@@ -42,9 +42,7 @@ struct analogix_dp_plat_data {
                         struct drm_connector *);
 };
 
-int analogix_dp_psr_enabled(struct analogix_dp_device *dp);
-int analogix_dp_enable_psr(struct analogix_dp_device *dp);
-int analogix_dp_disable_psr(struct analogix_dp_device *dp);
+bool analogix_dp_in_psr_transition(struct analogix_dp_device *dp);
 
 int analogix_dp_resume(struct analogix_dp_device *dp);
 int analogix_dp_suspend(struct analogix_dp_device *dp);
-- 
Sean Paul, Software Engineer, Google / Chromium OS

_______________________________________________
dri-devel mailing list
dri-devel@lists.freedesktop.org
https://lists.freedesktop.org/mailman/listinfo/dri-devel

Reply via email to