Am Freitag, dem 01.07.2022 um 11:25 +0800 schrieb Richard Zhu:
> Create imx6_pcie_stop_link() and imx6_pcie_host_exit() functions.
> Encapsulate clocks, regulators disables and PHY uninitialization into
> imx6_pcie_host_exit().
> To keep suspend/resume symmetric as much as possible, invoke these two
> new created functions in suspend callback.
>
> To be symmetric with imx6_pcie_host_exit(), move imx6_pcie_clk_enable()
> to imx6_pcie_host_init() from imx6_pcie_deassert_core_reset().
>
> Signed-off-by: Richard Zhu <hongxing.zhu@xxxxxxx>
Reviewed-by: Lucas Stach <l.stach@xxxxxxxxxxxxxx>
> ---
> drivers/pci/controller/dwc/pci-imx6.c | 60 ++++++++++++++++-----------
> 1 file changed, 36 insertions(+), 24 deletions(-)
>
> diff --git a/drivers/pci/controller/dwc/pci-imx6.c b/drivers/pci/controller/dwc/pci-imx6.c
> index 1cf8bf9035f2..bf8992a6c238 100644
> --- a/drivers/pci/controller/dwc/pci-imx6.c
> +++ b/drivers/pci/controller/dwc/pci-imx6.c
> @@ -703,13 +703,6 @@ static int imx6_pcie_deassert_core_reset(struct imx6_pcie *imx6_pcie)
> {
> struct dw_pcie *pci = imx6_pcie->pci;
> struct device *dev = pci->dev;
> - int ret;
> -
> - ret = imx6_pcie_clk_enable(imx6_pcie);
> - if (ret) {
> - dev_err(dev, "unable to enable pcie clocks: %d\n", ret);
> - return ret;
> - }
>
> switch (imx6_pcie->drvdata->variant) {
> case IMX8MQ:
> @@ -905,6 +898,14 @@ static int imx6_pcie_start_link(struct dw_pcie *pci)
> return 0;
> }
>
> +static void imx6_pcie_stop_link(struct dw_pcie *pci)
> +{
> + struct device *dev = pci->dev;
> +
> + /* Turn off PCIe LTSSM */
> + imx6_pcie_ltssm_disable(dev);
> +}
> +
> static int imx6_pcie_host_init(struct pcie_port *pp)
> {
> struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
> @@ -922,11 +923,17 @@ static int imx6_pcie_host_init(struct pcie_port *pp)
> return ret;
> }
> }
> + ret = imx6_pcie_clk_enable(imx6_pcie);
> + if (ret) {
> + dev_err(dev, "unable to enable pcie clocks: %d\n", ret);
> + goto err_reg_disable;
> + }
> +
> if (imx6_pcie->phy) {
> ret = phy_power_on(imx6_pcie->phy);
> if (ret) {
> dev_err(dev, "pcie phy power up failed.\n");
> - goto err_reg_disable;
> + goto err_clk_disable;
> }
> }
>
> @@ -947,17 +954,33 @@ static int imx6_pcie_host_init(struct pcie_port *pp)
>
> return 0;
>
> -err_clk_disable:
> - imx6_pcie_clk_disable(imx6_pcie);
> err_phy_off:
> if (imx6_pcie->phy)
> phy_power_off(imx6_pcie->phy);
> +err_clk_disable:
> + imx6_pcie_clk_disable(imx6_pcie);
> err_reg_disable:
> if (imx6_pcie->vpcie)
> regulator_disable(imx6_pcie->vpcie);
> return ret;
> }
>
> +static void imx6_pcie_host_exit(struct pcie_port *pp)
> +{
> + struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
> + struct imx6_pcie *imx6_pcie = to_imx6_pcie(pci);
> +
> + if (imx6_pcie->phy) {
> + if (phy_power_off(imx6_pcie->phy))
> + dev_err(pci->dev, "unable to power off PHY\n");
> + phy_exit(imx6_pcie->phy);
> + }
> + imx6_pcie_clk_disable(imx6_pcie);
> +
> + if (imx6_pcie->vpcie)
> + regulator_disable(imx6_pcie->vpcie);
> +}
> +
> static const struct dw_pcie_host_ops imx6_pcie_host_ops = {
> .host_init = imx6_pcie_host_init,
> };
> @@ -1007,25 +1030,14 @@ static void imx6_pcie_pm_turnoff(struct imx6_pcie *imx6_pcie)
> static int imx6_pcie_suspend_noirq(struct device *dev)
> {
> struct imx6_pcie *imx6_pcie = dev_get_drvdata(dev);
> + struct pcie_port *pp = &imx6_pcie->pci->pp;
>
> if (!(imx6_pcie->drvdata->flags & IMX6_PCIE_FLAG_SUPPORTS_SUSPEND))
> return 0;
>
> imx6_pcie_pm_turnoff(imx6_pcie);
> - imx6_pcie_ltssm_disable(dev);
> - imx6_pcie_clk_disable(imx6_pcie);
> - switch (imx6_pcie->drvdata->variant) {
> - case IMX8MM:
> - if (phy_power_off(imx6_pcie->phy))
> - dev_err(dev, "unable to power off PHY\n");
> - phy_exit(imx6_pcie->phy);
> - break;
> - default:
> - break;
> - }
> -
> - if (imx6_pcie->vpcie)
> - regulator_disable(imx6_pcie->vpcie);
> + imx6_pcie_stop_link(imx6_pcie->pci);
> + imx6_pcie_host_exit(pp);
>
> return 0;
> }
