Add support for runtime PM to the Rockchip RK3576/3588 Synopsys DesignWare DisplayPort driver.
Signed-off-by: Sebastian Reichel <[email protected]> --- drivers/gpu/drm/rockchip/dw_dp-rockchip.c | 65 +++++++++++++++++++++++++++++-- 1 file changed, 62 insertions(+), 3 deletions(-) diff --git a/drivers/gpu/drm/rockchip/dw_dp-rockchip.c b/drivers/gpu/drm/rockchip/dw_dp-rockchip.c index 0ecbad24dd4e..b1a69d8821a2 100644 --- a/drivers/gpu/drm/rockchip/dw_dp-rockchip.c +++ b/drivers/gpu/drm/rockchip/dw_dp-rockchip.c @@ -12,6 +12,7 @@ #include <linux/mfd/syscon.h> #include <linux/of_device.h> #include <linux/platform_device.h> +#include <linux/pm_runtime.h> #include <linux/regmap.h> #include <linux/videodev2.h> @@ -54,9 +55,15 @@ static void dw_dp_rockchip_hpd_sw_sel(void *data, bool force_hpd_from_sw) { struct rockchip_dw_dp *dp = data; u32 hpd_reg = dp->pdata->hpd_reg[dp->id]; + int ret; dp->hpd_sel = force_hpd_from_sw; + PM_RUNTIME_ACQUIRE_IF_ENABLED_AUTOSUSPEND(dp->dev, pm); + ret = PM_RUNTIME_ACQUIRE_ERR(&pm); + if (ret) + return; + regmap_write(dp->vo_grf, hpd_reg, FIELD_PREP_WM16(ROCKCHIP_VO_GRF_DP_SINK_HPD_SEL, dp->hpd_sel)); } @@ -65,11 +72,17 @@ static void dw_dp_rockchip_hpd_sw_cfg(void *data, bool hpd) { struct rockchip_dw_dp *dp = data; u32 hpd_reg = dp->pdata->hpd_reg[dp->id]; + int ret; dev_dbg(dp->dev, "Force HPD connected=%s\n", str_yes_no(hpd)); dp->hpd_cfg = hpd; + PM_RUNTIME_ACQUIRE_IF_ENABLED_AUTOSUSPEND(dp->dev, pm); + ret = PM_RUNTIME_ACQUIRE_ERR(&pm); + if (ret) + return; + regmap_write(dp->vo_grf, hpd_reg, FIELD_PREP_WM16(ROCKCHIP_VO_GRF_DP_SINK_HPD_CFG, dp->hpd_cfg)); } @@ -165,18 +178,32 @@ static int dw_dp_rockchip_bind(struct device *dev, struct device *master, void * return ret; drm_encoder_helper_add(encoder, &dw_dp_encoder_helper_funcs); + pm_runtime_use_autosuspend(dev); + pm_runtime_set_autosuspend_delay(dev, 500); + pm_runtime_set_active(dev); + pm_runtime_enable(dev); + ret = dw_dp_bind(dp->base, encoder); if (ret) return ret; connector = drm_bridge_connector_init(drm_dev, encoder); if (IS_ERR(connector)) { - dw_dp_unbind(dp->base); - return dev_err_probe(dev, PTR_ERR(connector), - "Failed to init bridge connector\n"); + ret = PTR_ERR(connector); + dev_err_probe(dev, ret, "Failed to init bridge connector\n"); + goto error; } + pm_request_idle(dev); + return 0; + +error: + pm_runtime_dont_use_autosuspend(dev); + pm_runtime_resume(dev); + pm_runtime_disable(dev); + dw_dp_unbind(dp->base); + return ret; } static void dw_dp_rockchip_unbind(struct device *dev, struct device *master, @@ -185,6 +212,9 @@ static void dw_dp_rockchip_unbind(struct device *dev, struct device *master, struct rockchip_dw_dp *dp = dev_get_drvdata(dev); dw_dp_unbind(dp->base); + pm_runtime_dont_use_autosuspend(dev); + pm_runtime_resume(dev); + pm_runtime_disable(dev); } static const struct component_ops dw_dp_rockchip_component_ops = { @@ -254,6 +284,34 @@ static void dw_dp_rockchip_remove(struct platform_device *pdev) component_del(&pdev->dev, &dw_dp_rockchip_component_ops); } +static int dw_dp_rockchip_runtime_suspend(struct device *dev) +{ + struct rockchip_dw_dp *dp = dev_get_drvdata(dev); + + return dw_dp_runtime_suspend(dp->base); +} + +static int dw_dp_rockchip_runtime_resume(struct device *dev) +{ + struct rockchip_dw_dp *dp = dev_get_drvdata(dev); + u32 hpd_reg = dp->pdata->hpd_reg[dp->id]; + int ret; + + ret = dw_dp_runtime_resume(dp->base); + if (ret) + return ret; + + regmap_write(dp->vo_grf, hpd_reg, + FIELD_PREP_WM16(ROCKCHIP_VO_GRF_DP_SINK_HPD_SEL, dp->hpd_sel) | + FIELD_PREP_WM16(ROCKCHIP_VO_GRF_DP_SINK_HPD_CFG, dp->hpd_cfg)); + + return 0; +} + +static const struct dev_pm_ops dw_dp_pm_ops = { + RUNTIME_PM_OPS(dw_dp_rockchip_runtime_suspend, dw_dp_rockchip_runtime_resume, NULL) +}; + static const struct rockchip_dw_dp_plat_data rk3588_dp_plat_data = { .num_ctrls = 2, .ctrl_ids = {0xfde50000, 0xfde60000}, @@ -288,5 +346,6 @@ struct platform_driver dw_dp_driver = { .driver = { .name = "dw-dp", .of_match_table = dw_dp_of_match, + .pm = pm_ptr(&dw_dp_pm_ops), }, }; -- 2.53.0
