Commit ec7bc1b4 authored by Johan Hovold's avatar Johan Hovold Committed by Vinod Koul
Browse files

phy: qcom-qmp-pcie: add register init helper 



Generalise the serdes initialisation helper so that it can be used to
initialise all the PHY registers (e.g. serdes, tx, rx, pcs).

Note that this defers the ungating of the PIPE clock somewhat, which is
fine as it isn't needed until starting the PHY.

Reviewed-by: default avatarDmitry Baryshkov <dmitry.baryshkov@linaro.org>
Signed-off-by: default avatarJohan Hovold <johan+linaro@kernel.org>
Link: https://lore.kernel.org/r/20221105145939.20318-10-johan+linaro@kernel.org


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

drivers/phy/qualcomm/phy-qcom-qmp-pcie.c

+8 −29
Original line number Diff line number Diff line
@@ -1820,27 +1820,22 @@ static void qmp_pcie_configure(void __iomem *base, 
	qmp_pcie_configure_lane(base, tbl, num, 0xff);

}



static void qmp_pcie_serdes_init(struct qmp_pcie *qmp, const struct qmp_phy_cfg_tbls *tbls)

{

	void __iomem *serdes = qmp->serdes;



	if (!tbls)

		return;



	qmp_pcie_configure(serdes, tbls->serdes, tbls->serdes_num);

}



static void qmp_pcie_lanes_init(struct qmp_pcie *qmp, const struct qmp_phy_cfg_tbls *tbls)

static void qmp_pcie_init_registers(struct qmp_pcie *qmp, const struct qmp_phy_cfg_tbls *tbls)

{

	const struct qmp_phy_cfg *cfg = qmp->cfg;

	void __iomem *serdes = qmp->serdes;

	void __iomem *tx = qmp->tx;

	void __iomem *rx = qmp->rx;

	void __iomem *tx2 = qmp->tx2;

	void __iomem *rx2 = qmp->rx2;

	void __iomem *pcs = qmp->pcs;

	void __iomem *pcs_misc = qmp->pcs_misc;



	if (!tbls)

		return;



	qmp_pcie_configure(serdes, tbls->serdes, tbls->serdes_num);



	qmp_pcie_configure_lane(tx, tbls->tx, tbls->tx_num, 1);

	qmp_pcie_configure_lane(rx, tbls->rx, tbls->rx_num, 1);
@@ -1848,15 +1843,6 @@ static void qmp_pcie_lanes_init(struct qmp_pcie *qmp, const struct qmp_phy_cfg_t 
		qmp_pcie_configure_lane(tx2, tbls->tx, tbls->tx_num, 2);

		qmp_pcie_configure_lane(rx2, tbls->rx, tbls->rx_num, 2);

	}

}



static void qmp_pcie_pcs_init(struct qmp_pcie *qmp, const struct qmp_phy_cfg_tbls *tbls)

{

	void __iomem *pcs = qmp->pcs;

	void __iomem *pcs_misc = qmp->pcs_misc;



	if (!tbls)

		return;



	qmp_pcie_configure(pcs, tbls->pcs, tbls->pcs_num);

	qmp_pcie_configure(pcs_misc, tbls->pcs_misc, tbls->pcs_misc_num);
@@ -1932,8 +1918,8 @@ static int qmp_pcie_power_on(struct phy *phy) 
	else

		mode_tbls = cfg->tbls_ep;



	qmp_pcie_serdes_init(qmp, &cfg->tbls);

	qmp_pcie_serdes_init(qmp, mode_tbls);

	qmp_pcie_init_registers(qmp, &cfg->tbls);

	qmp_pcie_init_registers(qmp, mode_tbls);



	ret = clk_prepare_enable(qmp->pipe_clk);

	if (ret) {
@@ -1941,13 +1927,6 @@ static int qmp_pcie_power_on(struct phy *phy) 
		return ret;

	}



	/* Tx, Rx, and PCS configurations */

	qmp_pcie_lanes_init(qmp, &cfg->tbls);

	qmp_pcie_lanes_init(qmp, mode_tbls);



	qmp_pcie_pcs_init(qmp, &cfg->tbls);

	qmp_pcie_pcs_init(qmp, mode_tbls);



	/* Pull PHY out of reset state */

	qphy_clrbits(pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);