diff --git a/XilinxProcessorIPLib/drivers/dptx/src/xdptx_mst.c b/XilinxProcessorIPLib/drivers/dptx/src/xdptx_mst.c
index cf88ea6c..3a522737 100644
--- a/XilinxProcessorIPLib/drivers/dptx/src/xdptx_mst.c
+++ b/XilinxProcessorIPLib/drivers/dptx/src/xdptx_mst.c
@@ -349,6 +349,8 @@ u32 XDptx_MstEnable(XDptx *InstancePtr)
 	XDptx_WriteReg(InstancePtr->Config.BaseAddr, XDPTX_TX_MST_CONFIG,
 					XDPTX_TX_MST_CONFIG_MST_EN_MASK);
 
+	XDptx_MstCfgModeEnable(InstancePtr);
+
 	return XST_SUCCESS;
 }
 
@@ -389,6 +391,8 @@ u32 XDptx_MstDisable(XDptx *InstancePtr)
 	/* Disable MST mode in the DisplayPort TX. */
 	XDptx_WriteReg(InstancePtr->Config.BaseAddr, XDPTX_TX_MST_CONFIG, 0x0);
 
+	XDptx_MstCfgModeDisable(InstancePtr);
+
 	return XST_SUCCESS;
 }