Unverified Commit 2fd69eca authored by Frank Li's avatar Frank Li Committed by Peter Chen
Browse files

usb: cdns3: imx: add power lost support for system resume 



imx need special handle when controller lost power

Signed-off-by: default avatarPeter Chen <peter.chen@nxp.com>
Signed-off-by: default avatarFrank Li <frank.li@nxp.com>
Signed-off-by: default avatarPeter Chen <peter.chen@kernel.org>
parent 2cf2581c

drivers/usb/cdns3/cdns3-imx.c

+34 −0
Original line number Diff line number Diff line
@@ -361,6 +361,39 @@ static int cdns_imx_suspend(struct device *dev) 


	return 0;

}





/* Indicate if the controller was power lost before */

static inline bool cdns_imx_is_power_lost(struct cdns_imx *data)

{

	u32 value;



	value = cdns_imx_readl(data, USB3_CORE_CTRL1);

	if ((value & SW_RESET_MASK) == ALL_SW_RESET)

		return true;

	else

		return false;

}



static int cdns_imx_system_resume(struct device *dev)

{

	struct cdns_imx *data = dev_get_drvdata(dev);

	int ret;



	ret = cdns_imx_resume(dev);

	if (ret)

		return ret;



	if (cdns_imx_is_power_lost(data)) {

		dev_dbg(dev, "resume from power lost\n");

		ret = cdns_imx_noncore_init(data);

		if (ret)

			cdns_imx_suspend(dev);

	}



	return ret;

}



#else

static int cdns_imx_platform_suspend(struct device *dev,

	bool suspend, bool wakeup)
@@ -372,6 +405,7 @@ static int cdns_imx_platform_suspend(struct device *dev, 


static const struct dev_pm_ops cdns_imx_pm_ops = {

	SET_RUNTIME_PM_OPS(cdns_imx_suspend, cdns_imx_resume, NULL)

	SET_SYSTEM_SLEEP_PM_OPS(cdns_imx_suspend, cdns_imx_system_resume)

};



static const struct of_device_id cdns_imx_of_match[] = {