PCIe EP compliance expect PTM capabilities (ROOT_CAPABLE, RES_CAPABLE,
CLK_GRAN) to be disabled.

Signed-off-by: Om Prakash Singh <o...@nvidia.com>
---
 drivers/pci/controller/dwc/pcie-tegra194.c | 17 ++++++++++++++++-
 include/uapi/linux/pci_regs.h              |  1 +
 2 files changed, 17 insertions(+), 1 deletion(-)

diff --git a/drivers/pci/controller/dwc/pcie-tegra194.c 
b/drivers/pci/controller/dwc/pcie-tegra194.c
index 6fa216e..a588312 100644
--- a/drivers/pci/controller/dwc/pcie-tegra194.c
+++ b/drivers/pci/controller/dwc/pcie-tegra194.c
@@ -1639,7 +1639,7 @@ static void pex_ep_event_pex_rst_deassert(struct 
tegra_pcie_dw *pcie)
        struct dw_pcie *pci = &pcie->pci;
        struct dw_pcie_ep *ep = &pci->ep;
        struct device *dev = pcie->dev;
-       u32 val;
+       u32 val, ptm_cap_base = 0;
        int ret;
 
        if (pcie->ep_state == EP_STATE_ENABLED)
@@ -1760,6 +1760,21 @@ static void pex_ep_event_pex_rst_deassert(struct 
tegra_pcie_dw *pcie)
                                                      PCI_CAP_ID_EXP);
        clk_set_rate(pcie->core_clk, GEN4_CORE_CLK_FREQ);
 
+       /* Disable PTM root and responder capability */
+       ptm_cap_base = dw_pcie_find_ext_capability(&pcie->pci,
+                                                  PCI_EXT_CAP_ID_PTM);
+       if (ptm_cap_base) {
+               dw_pcie_dbi_ro_wr_en(pci);
+               val = dw_pcie_readl_dbi(pci, ptm_cap_base + PCI_PTM_CAP);
+               val &= ~PCI_PTM_CAP_ROOT;
+               dw_pcie_writel_dbi(pci, ptm_cap_base + PCI_PTM_CAP, val);
+
+               val = dw_pcie_readl_dbi(pci, ptm_cap_base + PCI_PTM_CAP);
+               val &= ~(PCI_PTM_CAP_RES | PCI_PTM_GRANULARITY_MASK);
+               dw_pcie_writel_dbi(pci, ptm_cap_base + PCI_PTM_CAP, val);
+               dw_pcie_dbi_ro_wr_dis(pci);
+       }
+
        val = (ep->msi_mem_phys & MSIX_ADDR_MATCH_LOW_OFF_MASK);
        val |= MSIX_ADDR_MATCH_LOW_OFF_EN;
        dw_pcie_writel_dbi(pci, MSIX_ADDR_MATCH_LOW_OFF, val);
diff --git a/include/uapi/linux/pci_regs.h b/include/uapi/linux/pci_regs.h
index e709ae8..9dd6f8d 100644
--- a/include/uapi/linux/pci_regs.h
+++ b/include/uapi/linux/pci_regs.h
@@ -1050,6 +1050,7 @@
 /* Precision Time Measurement */
 #define PCI_PTM_CAP                    0x04        /* PTM Capability */
 #define  PCI_PTM_CAP_REQ               0x00000001  /* Requester capable */
+#define  PCI_PTM_CAP_RES               0x00000002  /* Responder capable */
 #define  PCI_PTM_CAP_ROOT              0x00000004  /* Root capable */
 #define  PCI_PTM_GRANULARITY_MASK      0x0000FF00  /* Clock granularity */
 #define PCI_PTM_CTRL                   0x08        /* PTM Control */
-- 
2.7.4

Reply via email to