|
@@ -17,6 +17,7 @@
|
|
|
#include <linux/kernel.h>
|
|
|
#include <linux/mfd/syscon.h>
|
|
|
#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
|
|
|
+#include <linux/mfd/syscon/imx7-iomuxc-gpr.h>
|
|
|
#include <linux/module.h>
|
|
|
#include <linux/of_gpio.h>
|
|
|
#include <linux/of_device.h>
|
|
@@ -27,6 +28,7 @@
|
|
|
#include <linux/signal.h>
|
|
|
#include <linux/types.h>
|
|
|
#include <linux/interrupt.h>
|
|
|
+#include <linux/reset.h>
|
|
|
|
|
|
#include "pcie-designware.h"
|
|
|
|
|
@@ -36,6 +38,7 @@ enum imx6_pcie_variants {
|
|
|
IMX6Q,
|
|
|
IMX6SX,
|
|
|
IMX6QP,
|
|
|
+ IMX7D,
|
|
|
};
|
|
|
|
|
|
struct imx6_pcie {
|
|
@@ -47,6 +50,8 @@ struct imx6_pcie {
|
|
|
struct clk *pcie_inbound_axi;
|
|
|
struct clk *pcie;
|
|
|
struct regmap *iomuxc_gpr;
|
|
|
+ struct reset_control *pciephy_reset;
|
|
|
+ struct reset_control *apps_reset;
|
|
|
enum imx6_pcie_variants variant;
|
|
|
u32 tx_deemph_gen1;
|
|
|
u32 tx_deemph_gen2_3p5db;
|
|
@@ -56,6 +61,11 @@ struct imx6_pcie {
|
|
|
int link_gen;
|
|
|
};
|
|
|
|
|
|
+/* Parameters for the waiting for PCIe PHY PLL to lock on i.MX7 */
|
|
|
+#define PHY_PLL_LOCK_WAIT_MAX_RETRIES 2000
|
|
|
+#define PHY_PLL_LOCK_WAIT_USLEEP_MIN 50
|
|
|
+#define PHY_PLL_LOCK_WAIT_USLEEP_MAX 200
|
|
|
+
|
|
|
/* PCIe Root Complex registers (memory-mapped) */
|
|
|
#define PCIE_RC_LCR 0x7c
|
|
|
#define PCIE_RC_LCR_MAX_LINK_SPEEDS_GEN1 0x1
|
|
@@ -248,6 +258,10 @@ static int imx6q_pcie_abort_handler(unsigned long addr,
|
|
|
static void imx6_pcie_assert_core_reset(struct imx6_pcie *imx6_pcie)
|
|
|
{
|
|
|
switch (imx6_pcie->variant) {
|
|
|
+ case IMX7D:
|
|
|
+ reset_control_assert(imx6_pcie->pciephy_reset);
|
|
|
+ reset_control_assert(imx6_pcie->apps_reset);
|
|
|
+ break;
|
|
|
case IMX6SX:
|
|
|
regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
IMX6SX_GPR12_PCIE_TEST_POWERDOWN,
|
|
@@ -303,11 +317,32 @@ static int imx6_pcie_enable_ref_clk(struct imx6_pcie *imx6_pcie)
|
|
|
regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR1,
|
|
|
IMX6Q_GPR1_PCIE_REF_CLK_EN, 1 << 16);
|
|
|
break;
|
|
|
+ case IMX7D:
|
|
|
+ break;
|
|
|
}
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
+static void imx7d_pcie_wait_for_phy_pll_lock(struct imx6_pcie *imx6_pcie)
|
|
|
+{
|
|
|
+ u32 val;
|
|
|
+ unsigned int retries;
|
|
|
+ struct device *dev = imx6_pcie->pci->dev;
|
|
|
+
|
|
|
+ for (retries = 0; retries < PHY_PLL_LOCK_WAIT_MAX_RETRIES; retries++) {
|
|
|
+ regmap_read(imx6_pcie->iomuxc_gpr, IOMUXC_GPR22, &val);
|
|
|
+
|
|
|
+ if (val & IMX7D_GPR22_PCIE_PHY_PLL_LOCKED)
|
|
|
+ return;
|
|
|
+
|
|
|
+ usleep_range(PHY_PLL_LOCK_WAIT_USLEEP_MIN,
|
|
|
+ PHY_PLL_LOCK_WAIT_USLEEP_MAX);
|
|
|
+ }
|
|
|
+
|
|
|
+ dev_err(dev, "PCIe PLL lock timeout\n");
|
|
|
+}
|
|
|
+
|
|
|
static void imx6_pcie_deassert_core_reset(struct imx6_pcie *imx6_pcie)
|
|
|
{
|
|
|
struct dw_pcie *pci = imx6_pcie->pci;
|
|
@@ -351,6 +386,10 @@ static void imx6_pcie_deassert_core_reset(struct imx6_pcie *imx6_pcie)
|
|
|
}
|
|
|
|
|
|
switch (imx6_pcie->variant) {
|
|
|
+ case IMX7D:
|
|
|
+ reset_control_deassert(imx6_pcie->pciephy_reset);
|
|
|
+ imx7d_pcie_wait_for_phy_pll_lock(imx6_pcie);
|
|
|
+ break;
|
|
|
case IMX6SX:
|
|
|
regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR5,
|
|
|
IMX6SX_GPR5_PCIE_BTNRST_RESET, 0);
|
|
@@ -377,35 +416,44 @@ err_pcie_bus:
|
|
|
|
|
|
static void imx6_pcie_init_phy(struct imx6_pcie *imx6_pcie)
|
|
|
{
|
|
|
- if (imx6_pcie->variant == IMX6SX)
|
|
|
+ switch (imx6_pcie->variant) {
|
|
|
+ case IMX7D:
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
+ IMX7D_GPR12_PCIE_PHY_REFCLK_SEL, 0);
|
|
|
+ break;
|
|
|
+ case IMX6SX:
|
|
|
regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
IMX6SX_GPR12_PCIE_RX_EQ_MASK,
|
|
|
IMX6SX_GPR12_PCIE_RX_EQ_2);
|
|
|
+ /* FALLTHROUGH */
|
|
|
+ default:
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
+ IMX6Q_GPR12_PCIE_CTL_2, 0 << 10);
|
|
|
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
- IMX6Q_GPR12_PCIE_CTL_2, 0 << 10);
|
|
|
+ /* configure constant input signal to the pcie ctrl and phy */
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
+ IMX6Q_GPR12_LOS_LEVEL, 9 << 4);
|
|
|
+
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
+ IMX6Q_GPR8_TX_DEEMPH_GEN1,
|
|
|
+ imx6_pcie->tx_deemph_gen1 << 0);
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
+ IMX6Q_GPR8_TX_DEEMPH_GEN2_3P5DB,
|
|
|
+ imx6_pcie->tx_deemph_gen2_3p5db << 6);
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
+ IMX6Q_GPR8_TX_DEEMPH_GEN2_6DB,
|
|
|
+ imx6_pcie->tx_deemph_gen2_6db << 12);
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
+ IMX6Q_GPR8_TX_SWING_FULL,
|
|
|
+ imx6_pcie->tx_swing_full << 18);
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
+ IMX6Q_GPR8_TX_SWING_LOW,
|
|
|
+ imx6_pcie->tx_swing_low << 25);
|
|
|
+ break;
|
|
|
+ }
|
|
|
|
|
|
- /* configure constant input signal to the pcie ctrl and phy */
|
|
|
regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
IMX6Q_GPR12_DEVICE_TYPE, PCI_EXP_TYPE_ROOT_PORT << 12);
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
- IMX6Q_GPR12_LOS_LEVEL, 9 << 4);
|
|
|
-
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
- IMX6Q_GPR8_TX_DEEMPH_GEN1,
|
|
|
- imx6_pcie->tx_deemph_gen1 << 0);
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
- IMX6Q_GPR8_TX_DEEMPH_GEN2_3P5DB,
|
|
|
- imx6_pcie->tx_deemph_gen2_3p5db << 6);
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
- IMX6Q_GPR8_TX_DEEMPH_GEN2_6DB,
|
|
|
- imx6_pcie->tx_deemph_gen2_6db << 12);
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
- IMX6Q_GPR8_TX_SWING_FULL,
|
|
|
- imx6_pcie->tx_swing_full << 18);
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR8,
|
|
|
- IMX6Q_GPR8_TX_SWING_LOW,
|
|
|
- imx6_pcie->tx_swing_low << 25);
|
|
|
}
|
|
|
|
|
|
static int imx6_pcie_wait_for_link(struct imx6_pcie *imx6_pcie)
|
|
@@ -469,8 +517,11 @@ static int imx6_pcie_establish_link(struct imx6_pcie *imx6_pcie)
|
|
|
dw_pcie_writel_dbi(pci, PCIE_RC_LCR, tmp);
|
|
|
|
|
|
/* Start LTSSM. */
|
|
|
- regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
- IMX6Q_GPR12_PCIE_CTL_2, 1 << 10);
|
|
|
+ if (imx6_pcie->variant == IMX7D)
|
|
|
+ reset_control_deassert(imx6_pcie->apps_reset);
|
|
|
+ else
|
|
|
+ regmap_update_bits(imx6_pcie->iomuxc_gpr, IOMUXC_GPR12,
|
|
|
+ IMX6Q_GPR12_PCIE_CTL_2, 1 << 10);
|
|
|
|
|
|
ret = imx6_pcie_wait_for_link(imx6_pcie);
|
|
|
if (ret)
|
|
@@ -653,13 +704,31 @@ static int __init imx6_pcie_probe(struct platform_device *pdev)
|
|
|
return PTR_ERR(imx6_pcie->pcie);
|
|
|
}
|
|
|
|
|
|
- if (imx6_pcie->variant == IMX6SX) {
|
|
|
+ switch (imx6_pcie->variant) {
|
|
|
+ case IMX6SX:
|
|
|
imx6_pcie->pcie_inbound_axi = devm_clk_get(dev,
|
|
|
"pcie_inbound_axi");
|
|
|
if (IS_ERR(imx6_pcie->pcie_inbound_axi)) {
|
|
|
dev_err(dev, "pcie_inbound_axi clock missing or invalid\n");
|
|
|
return PTR_ERR(imx6_pcie->pcie_inbound_axi);
|
|
|
}
|
|
|
+ break;
|
|
|
+ case IMX7D:
|
|
|
+ imx6_pcie->pciephy_reset = devm_reset_control_get(dev,
|
|
|
+ "pciephy");
|
|
|
+ if (IS_ERR(imx6_pcie->pciephy_reset)) {
|
|
|
+ dev_err(dev, "Failed to get PCIEPHY reset contol\n");
|
|
|
+ return PTR_ERR(imx6_pcie->pciephy_reset);
|
|
|
+ }
|
|
|
+
|
|
|
+ imx6_pcie->apps_reset = devm_reset_control_get(dev, "apps");
|
|
|
+ if (IS_ERR(imx6_pcie->apps_reset)) {
|
|
|
+ dev_err(dev, "Failed to get PCIE APPS reset contol\n");
|
|
|
+ return PTR_ERR(imx6_pcie->apps_reset);
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
}
|
|
|
|
|
|
/* Grab GPR config register range */
|
|
@@ -718,6 +787,7 @@ static const struct of_device_id imx6_pcie_of_match[] = {
|
|
|
{ .compatible = "fsl,imx6q-pcie", .data = (void *)IMX6Q, },
|
|
|
{ .compatible = "fsl,imx6sx-pcie", .data = (void *)IMX6SX, },
|
|
|
{ .compatible = "fsl,imx6qp-pcie", .data = (void *)IMX6QP, },
|
|
|
+ { .compatible = "fsl,imx7d-pcie", .data = (void *)IMX7D, },
|
|
|
{},
|
|
|
};
|
|
|
|