diff --git a/msm/dp/dp_display.c b/msm/dp/dp_display.c index 74fcc82c09..079434b66a 100644 --- a/msm/dp/dp_display.c +++ b/msm/dp/dp_display.c @@ -2494,6 +2494,28 @@ static int dp_display_get_mst_caps(struct dp_display *dp_display, return rc; } +static void dp_display_wakeup_phy_layer(struct dp_display *dp_display, + bool wakeup) +{ + struct dp_display_private *dp; + struct dp_hpd *hpd; + + if (!dp_display) { + pr_err("invalid input\n"); + return; + } + + dp = container_of(dp_display, struct dp_display_private, dp_display); + if (!dp->mst.drm_registered) { + pr_debug("drm mst not registered\n"); + return; + } + + hpd = dp->hpd; + if (hpd && hpd->wakeup_phy) + hpd->wakeup_phy(hpd, wakeup); +} + static int dp_display_probe(struct platform_device *pdev) { int rc = 0; @@ -2566,6 +2588,8 @@ static int dp_display_probe(struct platform_device *pdev) dp_display_mst_get_connector_info; g_dp_display->mst_get_fixed_topology_port = dp_display_mst_get_fixed_topology_port; + g_dp_display->wakeup_phy_layer = + dp_display_wakeup_phy_layer; rc = component_add(&pdev->dev, &dp_display_comp_ops); if (rc) { diff --git a/msm/dp/dp_display.h b/msm/dp/dp_display.h index fe332aff47..2597aaf59d 100644 --- a/msm/dp/dp_display.h +++ b/msm/dp/dp_display.h @@ -117,6 +117,8 @@ struct dp_display { struct dp_display_mode *dp_mode); int (*update_pps)(struct dp_display *dp_display, struct drm_connector *connector, char *pps_cmd); + void (*wakeup_phy_layer)(struct dp_display *dp_display, + bool wakeup); }; #ifdef CONFIG_DRM_MSM_DP diff --git a/msm/dp/dp_hpd.h b/msm/dp/dp_hpd.h index bdc551262a..7fb5725485 100644 --- a/msm/dp/dp_hpd.h +++ b/msm/dp/dp_hpd.h @@ -54,6 +54,7 @@ struct dp_hpd_cb { * @host_deinit: source or host side de-initializations * @simulate_connect: simulate disconnect or connect for debug mode * @simulate_attention: simulate attention messages for debug mode + * @wakeup_phy: wakeup USBPD phy layer */ struct dp_hpd { enum dp_hpd_type type; @@ -69,6 +70,7 @@ struct dp_hpd { void (*host_deinit)(struct dp_hpd *hpd, struct dp_catalog_hpd *catalog); int (*simulate_connect)(struct dp_hpd *dp_hpd, bool hpd); int (*simulate_attention)(struct dp_hpd *dp_hpd, int vdo); + void (*wakeup_phy)(struct dp_hpd *dp_hpd, bool wakeup); }; /** diff --git a/msm/dp/dp_mst_drm.c b/msm/dp/dp_mst_drm.c index d4f67c26fd..4f1cfda737 100644 --- a/msm/dp/dp_mst_drm.c +++ b/msm/dp/dp_mst_drm.c @@ -608,6 +608,9 @@ static void _dp_mst_bridge_pre_enable_part1(struct dp_mst_bridge *dp_bridge) /* skip mst specific disable operations during suspend */ if (mst->state == PM_SUSPEND) { + dp_display->wakeup_phy_layer(dp_display, true); + drm_dp_send_power_updown_phy(&mst->mst_mgr, port, true); + dp_display->wakeup_phy_layer(dp_display, false); _dp_mst_update_single_timeslot(mst, dp_bridge); return; } @@ -691,8 +694,12 @@ static void _dp_mst_bridge_pre_disable_part2(struct dp_mst_bridge *dp_bridge) DP_MST_DEBUG("enter\n"); /* skip mst specific disable operations during suspend */ - if (mst->state == PM_SUSPEND) + if (mst->state == PM_SUSPEND) { + dp_display->wakeup_phy_layer(dp_display, true); + drm_dp_send_power_updown_phy(&mst->mst_mgr, port, false); + dp_display->wakeup_phy_layer(dp_display, false); return; + } mst->mst_fw_cbs->check_act_status(&mst->mst_mgr); diff --git a/msm/dp/dp_usbpd.c b/msm/dp/dp_usbpd.c index 7b5a48048e..cfb9592254 100644 --- a/msm/dp/dp_usbpd.c +++ b/msm/dp/dp_usbpd.c @@ -497,6 +497,22 @@ int dp_usbpd_register(struct dp_hpd *dp_hpd) return rc; } +static void dp_usbpd_wakeup_phy(struct dp_hpd *dp_hpd, bool wakeup) +{ + struct dp_usbpd *dp_usbpd; + struct dp_usbpd_private *usbpd; + + dp_usbpd = container_of(dp_hpd, struct dp_usbpd, base); + usbpd = container_of(dp_usbpd, struct dp_usbpd_private, dp_usbpd); + + if (!usbpd->pd) { + pr_err("usbpd pointer invalid"); + return; + } + + usbpd_vdm_in_suspend(usbpd->pd, wakeup); +} + struct dp_hpd *dp_usbpd_get(struct device *dev, struct dp_hpd_cb *cb) { int rc = 0; @@ -540,6 +556,7 @@ struct dp_hpd *dp_usbpd_get(struct device *dev, struct dp_hpd_cb *cb) dp_usbpd->base.simulate_connect = dp_usbpd_simulate_connect; dp_usbpd->base.simulate_attention = dp_usbpd_simulate_attention; dp_usbpd->base.register_hpd = dp_usbpd_register; + dp_usbpd->base.wakeup_phy = dp_usbpd_wakeup_phy; return &dp_usbpd->base; error: