Commit 434e1a0e authored by Thomas Richard (TI.com)'s avatar Thomas Richard (TI.com) Committed by Vinod Koul
Browse files

phy: cadence-torrent: restore parent clock for refclk during resume 



While suspend and resume, parent clock config for refclk was getting lost.
So save and restore it in suspend and resume operations.

Reviewed-by: default avatarNeil Armstrong <neil.armstrong@linaro.org>
Signed-off-by: default avatarThomas Richard (TI.com) <thomas.richard@bootlin.com>
Link: https://patch.msgid.link/20251216-phy-cadence-torrent-resume-restore-refclk-parent-v3-1-8a7ed84b47e3@bootlin.com


Signed-off-by: default avatarVinod Koul <vkoul@kernel.org>
parent 53f6240e

drivers/phy/cadence/phy-cadence-torrent.c

+23 −0
Original line number Diff line number Diff line
@@ -397,6 +397,7 @@ struct cdns_torrent_refclk_driver { 
	struct clk_hw		hw;

	struct regmap_field	*cmn_fields[REFCLK_OUT_NUM_CMN_CONFIG];

	struct clk_init_data	clk_data;

	u8 parent_index;

};



#define to_cdns_torrent_refclk_driver(_hw)	\
@@ -3326,11 +3327,29 @@ static const struct cdns_torrent_vals sgmii_qsgmii_xcvr_diag_ln_vals = { 
	.num_regs = ARRAY_SIZE(sgmii_qsgmii_xcvr_diag_ln_regs),

};



static void cdns_torrent_refclk_driver_suspend(struct cdns_torrent_phy *cdns_phy)

{

	struct clk_hw *hw = cdns_phy->clk_hw_data->hws[CDNS_TORRENT_REFCLK_DRIVER];

	struct cdns_torrent_refclk_driver *refclk_driver = to_cdns_torrent_refclk_driver(hw);



	refclk_driver->parent_index = cdns_torrent_refclk_driver_get_parent(hw);

}



static int cdns_torrent_refclk_driver_resume(struct cdns_torrent_phy *cdns_phy)

{

	struct clk_hw *hw = cdns_phy->clk_hw_data->hws[CDNS_TORRENT_REFCLK_DRIVER];

	struct cdns_torrent_refclk_driver *refclk_driver = to_cdns_torrent_refclk_driver(hw);



	return cdns_torrent_refclk_driver_set_parent(hw, refclk_driver->parent_index);

}



static int cdns_torrent_phy_suspend_noirq(struct device *dev)

{

	struct cdns_torrent_phy *cdns_phy = dev_get_drvdata(dev);

	int i;



	cdns_torrent_refclk_driver_suspend(cdns_phy);



	reset_control_assert(cdns_phy->phy_rst);

	reset_control_assert(cdns_phy->apb_rst);

	for (i = 0; i < cdns_phy->nsubnodes; i++)
@@ -3352,6 +3371,10 @@ static int cdns_torrent_phy_resume_noirq(struct device *dev) 
	int node = cdns_phy->nsubnodes;

	int ret, i;



	ret = cdns_torrent_refclk_driver_resume(cdns_phy);

	if (ret)

		return ret;



	ret = cdns_torrent_clk(cdns_phy);

	if (ret)

		return ret;