|  | // SPDX-License-Identifier: GPL-2.0+ | 
|  | /* | 
|  | * PCIe host controller driver for the following SoCs | 
|  | * Tegra194 | 
|  | * Tegra234 | 
|  | * | 
|  | * Copyright (C) 2019-2022 NVIDIA Corporation. | 
|  | * | 
|  | * Author: Vidya Sagar <vidyas@nvidia.com> | 
|  | */ | 
|  |  | 
|  | #include <linux/bitfield.h> | 
|  | #include <linux/clk.h> | 
|  | #include <linux/debugfs.h> | 
|  | #include <linux/delay.h> | 
|  | #include <linux/gpio.h> | 
|  | #include <linux/gpio/consumer.h> | 
|  | #include <linux/interconnect.h> | 
|  | #include <linux/interrupt.h> | 
|  | #include <linux/iopoll.h> | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/of.h> | 
|  | #include <linux/of_gpio.h> | 
|  | #include <linux/of_pci.h> | 
|  | #include <linux/pci.h> | 
|  | #include <linux/phy/phy.h> | 
|  | #include <linux/pinctrl/consumer.h> | 
|  | #include <linux/platform_device.h> | 
|  | #include <linux/pm_runtime.h> | 
|  | #include <linux/random.h> | 
|  | #include <linux/reset.h> | 
|  | #include <linux/resource.h> | 
|  | #include <linux/types.h> | 
|  | #include "pcie-designware.h" | 
|  | #include <soc/tegra/bpmp.h> | 
|  | #include <soc/tegra/bpmp-abi.h> | 
|  | #include "../../pci.h" | 
|  |  | 
|  | #define TEGRA194_DWC_IP_VER			0x490A | 
|  | #define TEGRA234_DWC_IP_VER			0x562A | 
|  |  | 
|  | #define APPL_PINMUX				0x0 | 
|  | #define APPL_PINMUX_PEX_RST			BIT(0) | 
|  | #define APPL_PINMUX_CLKREQ_OVERRIDE_EN		BIT(2) | 
|  | #define APPL_PINMUX_CLKREQ_OVERRIDE		BIT(3) | 
|  | #define APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN	BIT(4) | 
|  | #define APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE	BIT(5) | 
|  |  | 
|  | #define APPL_CTRL				0x4 | 
|  | #define APPL_CTRL_SYS_PRE_DET_STATE		BIT(6) | 
|  | #define APPL_CTRL_LTSSM_EN			BIT(7) | 
|  | #define APPL_CTRL_HW_HOT_RST_EN			BIT(20) | 
|  | #define APPL_CTRL_HW_HOT_RST_MODE_MASK		GENMASK(1, 0) | 
|  | #define APPL_CTRL_HW_HOT_RST_MODE_SHIFT		22 | 
|  | #define APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST	0x1 | 
|  | #define APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST_LTSSM_EN	0x2 | 
|  |  | 
|  | #define APPL_INTR_EN_L0_0			0x8 | 
|  | #define APPL_INTR_EN_L0_0_LINK_STATE_INT_EN	BIT(0) | 
|  | #define APPL_INTR_EN_L0_0_MSI_RCV_INT_EN	BIT(4) | 
|  | #define APPL_INTR_EN_L0_0_INT_INT_EN		BIT(8) | 
|  | #define APPL_INTR_EN_L0_0_PCI_CMD_EN_INT_EN	BIT(15) | 
|  | #define APPL_INTR_EN_L0_0_CDM_REG_CHK_INT_EN	BIT(19) | 
|  | #define APPL_INTR_EN_L0_0_SYS_INTR_EN		BIT(30) | 
|  | #define APPL_INTR_EN_L0_0_SYS_MSI_INTR_EN	BIT(31) | 
|  |  | 
|  | #define APPL_INTR_STATUS_L0			0xC | 
|  | #define APPL_INTR_STATUS_L0_LINK_STATE_INT	BIT(0) | 
|  | #define APPL_INTR_STATUS_L0_INT_INT		BIT(8) | 
|  | #define APPL_INTR_STATUS_L0_PCI_CMD_EN_INT	BIT(15) | 
|  | #define APPL_INTR_STATUS_L0_PEX_RST_INT		BIT(16) | 
|  | #define APPL_INTR_STATUS_L0_CDM_REG_CHK_INT	BIT(18) | 
|  |  | 
|  | #define APPL_INTR_EN_L1_0_0				0x1C | 
|  | #define APPL_INTR_EN_L1_0_0_LINK_REQ_RST_NOT_INT_EN	BIT(1) | 
|  | #define APPL_INTR_EN_L1_0_0_RDLH_LINK_UP_INT_EN		BIT(3) | 
|  | #define APPL_INTR_EN_L1_0_0_HOT_RESET_DONE_INT_EN	BIT(30) | 
|  |  | 
|  | #define APPL_INTR_STATUS_L1_0_0				0x20 | 
|  | #define APPL_INTR_STATUS_L1_0_0_LINK_REQ_RST_NOT_CHGED	BIT(1) | 
|  | #define APPL_INTR_STATUS_L1_0_0_RDLH_LINK_UP_CHGED	BIT(3) | 
|  | #define APPL_INTR_STATUS_L1_0_0_HOT_RESET_DONE		BIT(30) | 
|  |  | 
|  | #define APPL_INTR_STATUS_L1_1			0x2C | 
|  | #define APPL_INTR_STATUS_L1_2			0x30 | 
|  | #define APPL_INTR_STATUS_L1_3			0x34 | 
|  | #define APPL_INTR_STATUS_L1_6			0x3C | 
|  | #define APPL_INTR_STATUS_L1_7			0x40 | 
|  | #define APPL_INTR_STATUS_L1_15_CFG_BME_CHGED	BIT(1) | 
|  |  | 
|  | #define APPL_INTR_EN_L1_8_0			0x44 | 
|  | #define APPL_INTR_EN_L1_8_BW_MGT_INT_EN		BIT(2) | 
|  | #define APPL_INTR_EN_L1_8_AUTO_BW_INT_EN	BIT(3) | 
|  | #define APPL_INTR_EN_L1_8_INTX_EN		BIT(11) | 
|  | #define APPL_INTR_EN_L1_8_AER_INT_EN		BIT(15) | 
|  |  | 
|  | #define APPL_INTR_STATUS_L1_8_0			0x4C | 
|  | #define APPL_INTR_STATUS_L1_8_0_EDMA_INT_MASK	GENMASK(11, 6) | 
|  | #define APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS	BIT(2) | 
|  | #define APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS	BIT(3) | 
|  |  | 
|  | #define APPL_INTR_STATUS_L1_9			0x54 | 
|  | #define APPL_INTR_STATUS_L1_10			0x58 | 
|  | #define APPL_INTR_STATUS_L1_11			0x64 | 
|  | #define APPL_INTR_STATUS_L1_13			0x74 | 
|  | #define APPL_INTR_STATUS_L1_14			0x78 | 
|  | #define APPL_INTR_STATUS_L1_15			0x7C | 
|  | #define APPL_INTR_STATUS_L1_17			0x88 | 
|  |  | 
|  | #define APPL_INTR_EN_L1_18				0x90 | 
|  | #define APPL_INTR_EN_L1_18_CDM_REG_CHK_CMPLT		BIT(2) | 
|  | #define APPL_INTR_EN_L1_18_CDM_REG_CHK_CMP_ERR		BIT(1) | 
|  | #define APPL_INTR_EN_L1_18_CDM_REG_CHK_LOGIC_ERR	BIT(0) | 
|  |  | 
|  | #define APPL_INTR_STATUS_L1_18				0x94 | 
|  | #define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMPLT	BIT(2) | 
|  | #define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMP_ERR	BIT(1) | 
|  | #define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_LOGIC_ERR	BIT(0) | 
|  |  | 
|  | #define APPL_MSI_CTRL_1				0xAC | 
|  |  | 
|  | #define APPL_MSI_CTRL_2				0xB0 | 
|  |  | 
|  | #define APPL_LEGACY_INTX			0xB8 | 
|  |  | 
|  | #define APPL_LTR_MSG_1				0xC4 | 
|  | #define LTR_MSG_REQ				BIT(15) | 
|  | #define LTR_MST_NO_SNOOP_SHIFT			16 | 
|  |  | 
|  | #define APPL_LTR_MSG_2				0xC8 | 
|  | #define APPL_LTR_MSG_2_LTR_MSG_REQ_STATE	BIT(3) | 
|  |  | 
|  | #define APPL_LINK_STATUS			0xCC | 
|  | #define APPL_LINK_STATUS_RDLH_LINK_UP		BIT(0) | 
|  |  | 
|  | #define APPL_DEBUG				0xD0 | 
|  | #define APPL_DEBUG_PM_LINKST_IN_L2_LAT		BIT(21) | 
|  | #define APPL_DEBUG_PM_LINKST_IN_L0		0x11 | 
|  | #define APPL_DEBUG_LTSSM_STATE_MASK		GENMASK(8, 3) | 
|  | #define APPL_DEBUG_LTSSM_STATE_SHIFT		3 | 
|  | #define LTSSM_STATE_PRE_DETECT			5 | 
|  |  | 
|  | #define APPL_RADM_STATUS			0xE4 | 
|  | #define APPL_PM_XMT_TURNOFF_STATE		BIT(0) | 
|  |  | 
|  | #define APPL_DM_TYPE				0x100 | 
|  | #define APPL_DM_TYPE_MASK			GENMASK(3, 0) | 
|  | #define APPL_DM_TYPE_RP				0x4 | 
|  | #define APPL_DM_TYPE_EP				0x0 | 
|  |  | 
|  | #define APPL_CFG_BASE_ADDR			0x104 | 
|  | #define APPL_CFG_BASE_ADDR_MASK			GENMASK(31, 12) | 
|  |  | 
|  | #define APPL_CFG_IATU_DMA_BASE_ADDR		0x108 | 
|  | #define APPL_CFG_IATU_DMA_BASE_ADDR_MASK	GENMASK(31, 18) | 
|  |  | 
|  | #define APPL_CFG_MISC				0x110 | 
|  | #define APPL_CFG_MISC_SLV_EP_MODE		BIT(14) | 
|  | #define APPL_CFG_MISC_ARCACHE_MASK		GENMASK(13, 10) | 
|  | #define APPL_CFG_MISC_ARCACHE_SHIFT		10 | 
|  | #define APPL_CFG_MISC_ARCACHE_VAL		3 | 
|  |  | 
|  | #define APPL_CFG_SLCG_OVERRIDE			0x114 | 
|  | #define APPL_CFG_SLCG_OVERRIDE_SLCG_EN_MASTER	BIT(0) | 
|  |  | 
|  | #define APPL_CAR_RESET_OVRD				0x12C | 
|  | #define APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N	BIT(0) | 
|  |  | 
|  | #define IO_BASE_IO_DECODE				BIT(0) | 
|  | #define IO_BASE_IO_DECODE_BIT8				BIT(8) | 
|  |  | 
|  | #define CFG_PREF_MEM_LIMIT_BASE_MEM_DECODE		BIT(0) | 
|  | #define CFG_PREF_MEM_LIMIT_BASE_MEM_LIMIT_DECODE	BIT(16) | 
|  |  | 
|  | #define CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF	0x718 | 
|  | #define CFG_TIMER_CTRL_ACK_NAK_SHIFT	(19) | 
|  |  | 
|  | #define N_FTS_VAL					52 | 
|  | #define FTS_VAL						52 | 
|  |  | 
|  | #define GEN3_EQ_CONTROL_OFF			0x8a8 | 
|  | #define GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT	8 | 
|  | #define GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK	GENMASK(23, 8) | 
|  | #define GEN3_EQ_CONTROL_OFF_FB_MODE_MASK	GENMASK(3, 0) | 
|  |  | 
|  | #define PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT	0x8D0 | 
|  | #define AMBA_ERROR_RESPONSE_CRS_SHIFT		3 | 
|  | #define AMBA_ERROR_RESPONSE_CRS_MASK		GENMASK(1, 0) | 
|  | #define AMBA_ERROR_RESPONSE_CRS_OKAY		0 | 
|  | #define AMBA_ERROR_RESPONSE_CRS_OKAY_FFFFFFFF	1 | 
|  | #define AMBA_ERROR_RESPONSE_CRS_OKAY_FFFF0001	2 | 
|  |  | 
|  | #define MSIX_ADDR_MATCH_LOW_OFF			0x940 | 
|  | #define MSIX_ADDR_MATCH_LOW_OFF_EN		BIT(0) | 
|  | #define MSIX_ADDR_MATCH_LOW_OFF_MASK		GENMASK(31, 2) | 
|  |  | 
|  | #define MSIX_ADDR_MATCH_HIGH_OFF		0x944 | 
|  | #define MSIX_ADDR_MATCH_HIGH_OFF_MASK		GENMASK(31, 0) | 
|  |  | 
|  | #define PORT_LOGIC_MSIX_DOORBELL			0x948 | 
|  |  | 
|  | #define CAP_SPCIE_CAP_OFF			0x154 | 
|  | #define CAP_SPCIE_CAP_OFF_DSP_TX_PRESET0_MASK	GENMASK(3, 0) | 
|  | #define CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_MASK	GENMASK(11, 8) | 
|  | #define CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_SHIFT	8 | 
|  |  | 
|  | #define PME_ACK_TIMEOUT 10000 | 
|  |  | 
|  | #define LTSSM_TIMEOUT 50000	/* 50ms */ | 
|  |  | 
|  | #define GEN3_GEN4_EQ_PRESET_INIT	5 | 
|  |  | 
|  | #define GEN1_CORE_CLK_FREQ	62500000 | 
|  | #define GEN2_CORE_CLK_FREQ	125000000 | 
|  | #define GEN3_CORE_CLK_FREQ	250000000 | 
|  | #define GEN4_CORE_CLK_FREQ	500000000 | 
|  |  | 
|  | #define LTR_MSG_TIMEOUT		(100 * 1000) | 
|  |  | 
|  | #define PERST_DEBOUNCE_TIME	(5 * 1000) | 
|  |  | 
|  | #define EP_STATE_DISABLED	0 | 
|  | #define EP_STATE_ENABLED	1 | 
|  |  | 
|  | static const unsigned int pcie_gen_freq[] = { | 
|  | GEN1_CORE_CLK_FREQ,	/* PCI_EXP_LNKSTA_CLS == 0; undefined */ | 
|  | GEN1_CORE_CLK_FREQ, | 
|  | GEN2_CORE_CLK_FREQ, | 
|  | GEN3_CORE_CLK_FREQ, | 
|  | GEN4_CORE_CLK_FREQ | 
|  | }; | 
|  |  | 
|  | struct tegra_pcie_dw_of_data { | 
|  | u32 version; | 
|  | enum dw_pcie_device_mode mode; | 
|  | bool has_msix_doorbell_access_fix; | 
|  | bool has_sbr_reset_fix; | 
|  | bool has_l1ss_exit_fix; | 
|  | bool has_ltr_req_fix; | 
|  | u32 cdm_chk_int_en_bit; | 
|  | u32 gen4_preset_vec; | 
|  | u8 n_fts[2]; | 
|  | }; | 
|  |  | 
|  | struct tegra_pcie_dw { | 
|  | struct device *dev; | 
|  | struct resource *appl_res; | 
|  | struct resource *dbi_res; | 
|  | struct resource *atu_dma_res; | 
|  | void __iomem *appl_base; | 
|  | struct clk *core_clk; | 
|  | struct reset_control *core_apb_rst; | 
|  | struct reset_control *core_rst; | 
|  | struct dw_pcie pci; | 
|  | struct tegra_bpmp *bpmp; | 
|  |  | 
|  | struct tegra_pcie_dw_of_data *of_data; | 
|  |  | 
|  | bool supports_clkreq; | 
|  | bool enable_cdm_check; | 
|  | bool enable_srns; | 
|  | bool link_state; | 
|  | bool update_fc_fixup; | 
|  | bool enable_ext_refclk; | 
|  | u8 init_link_width; | 
|  | u32 msi_ctrl_int; | 
|  | u32 num_lanes; | 
|  | u32 cid; | 
|  | u32 cfg_link_cap_l1sub; | 
|  | u32 ras_des_cap; | 
|  | u32 pcie_cap_base; | 
|  | u32 aspm_cmrt; | 
|  | u32 aspm_pwr_on_t; | 
|  | u32 aspm_l0s_enter_lat; | 
|  |  | 
|  | struct regulator *pex_ctl_supply; | 
|  | struct regulator *slot_ctl_3v3; | 
|  | struct regulator *slot_ctl_12v; | 
|  |  | 
|  | unsigned int phy_count; | 
|  | struct phy **phys; | 
|  |  | 
|  | struct dentry *debugfs; | 
|  |  | 
|  | /* Endpoint mode specific */ | 
|  | struct gpio_desc *pex_rst_gpiod; | 
|  | struct gpio_desc *pex_refclk_sel_gpiod; | 
|  | unsigned int pex_rst_irq; | 
|  | int ep_state; | 
|  | long link_status; | 
|  | struct icc_path *icc_path; | 
|  | }; | 
|  |  | 
|  | static inline struct tegra_pcie_dw *to_tegra_pcie(struct dw_pcie *pci) | 
|  | { | 
|  | return container_of(pci, struct tegra_pcie_dw, pci); | 
|  | } | 
|  |  | 
|  | static inline void appl_writel(struct tegra_pcie_dw *pcie, const u32 value, | 
|  | const u32 reg) | 
|  | { | 
|  | writel_relaxed(value, pcie->appl_base + reg); | 
|  | } | 
|  |  | 
|  | static inline u32 appl_readl(struct tegra_pcie_dw *pcie, const u32 reg) | 
|  | { | 
|  | return readl_relaxed(pcie->appl_base + reg); | 
|  | } | 
|  |  | 
|  | struct tegra_pcie_soc { | 
|  | enum dw_pcie_device_mode mode; | 
|  | }; | 
|  |  | 
|  | static void tegra_pcie_icc_set(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | struct dw_pcie *pci = &pcie->pci; | 
|  | u32 val, speed, width; | 
|  |  | 
|  | val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA); | 
|  |  | 
|  | speed = FIELD_GET(PCI_EXP_LNKSTA_CLS, val); | 
|  | width = FIELD_GET(PCI_EXP_LNKSTA_NLW, val); | 
|  |  | 
|  | val = width * (PCIE_SPEED2MBS_ENC(pcie_link_speed[speed]) / BITS_PER_BYTE); | 
|  |  | 
|  | if (icc_set_bw(pcie->icc_path, MBps_to_icc(val), 0)) | 
|  | dev_err(pcie->dev, "can't set bw[%u]\n", val); | 
|  |  | 
|  | if (speed >= ARRAY_SIZE(pcie_gen_freq)) | 
|  | speed = 0; | 
|  |  | 
|  | clk_set_rate(pcie->core_clk, pcie_gen_freq[speed]); | 
|  | } | 
|  |  | 
|  | static void apply_bad_link_workaround(struct dw_pcie_rp *pp) | 
|  | { | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  | u32 current_link_width; | 
|  | u16 val; | 
|  |  | 
|  | /* | 
|  | * NOTE:- Since this scenario is uncommon and link as such is not | 
|  | * stable anyway, not waiting to confirm if link is really | 
|  | * transitioning to Gen-2 speed | 
|  | */ | 
|  | val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA); | 
|  | if (val & PCI_EXP_LNKSTA_LBMS) { | 
|  | current_link_width = FIELD_GET(PCI_EXP_LNKSTA_NLW, val); | 
|  | if (pcie->init_link_width > current_link_width) { | 
|  | dev_warn(pci->dev, "PCIe link is bad, width reduced\n"); | 
|  | val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKCTL2); | 
|  | val &= ~PCI_EXP_LNKCTL2_TLS; | 
|  | val |= PCI_EXP_LNKCTL2_TLS_2_5GT; | 
|  | dw_pcie_writew_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKCTL2, val); | 
|  |  | 
|  | val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKCTL); | 
|  | val |= PCI_EXP_LNKCTL_RL; | 
|  | dw_pcie_writew_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKCTL, val); | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static irqreturn_t tegra_pcie_rp_irq_handler(int irq, void *arg) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = arg; | 
|  | struct dw_pcie *pci = &pcie->pci; | 
|  | struct dw_pcie_rp *pp = &pci->pp; | 
|  | u32 val, status_l0, status_l1; | 
|  | u16 val_w; | 
|  |  | 
|  | status_l0 = appl_readl(pcie, APPL_INTR_STATUS_L0); | 
|  | if (status_l0 & APPL_INTR_STATUS_L0_LINK_STATE_INT) { | 
|  | status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_0_0); | 
|  | appl_writel(pcie, status_l1, APPL_INTR_STATUS_L1_0_0); | 
|  | if (!pcie->of_data->has_sbr_reset_fix && | 
|  | status_l1 & APPL_INTR_STATUS_L1_0_0_LINK_REQ_RST_NOT_CHGED) { | 
|  | /* SBR & Surprise Link Down WAR */ | 
|  | val = appl_readl(pcie, APPL_CAR_RESET_OVRD); | 
|  | val &= ~APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N; | 
|  | appl_writel(pcie, val, APPL_CAR_RESET_OVRD); | 
|  | udelay(1); | 
|  | val = appl_readl(pcie, APPL_CAR_RESET_OVRD); | 
|  | val |= APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N; | 
|  | appl_writel(pcie, val, APPL_CAR_RESET_OVRD); | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL); | 
|  | val |= PORT_LOGIC_SPEED_CHANGE; | 
|  | dw_pcie_writel_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL, val); | 
|  | } | 
|  | } | 
|  |  | 
|  | if (status_l0 & APPL_INTR_STATUS_L0_INT_INT) { | 
|  | status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_8_0); | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS) { | 
|  | appl_writel(pcie, | 
|  | APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS, | 
|  | APPL_INTR_STATUS_L1_8_0); | 
|  | apply_bad_link_workaround(pp); | 
|  | } | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS) { | 
|  | val_w = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKSTA); | 
|  | val_w |= PCI_EXP_LNKSTA_LBMS; | 
|  | dw_pcie_writew_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKSTA, val_w); | 
|  |  | 
|  | appl_writel(pcie, | 
|  | APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS, | 
|  | APPL_INTR_STATUS_L1_8_0); | 
|  |  | 
|  | val_w = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKSTA); | 
|  | dev_dbg(pci->dev, "Link Speed : Gen-%u\n", val_w & | 
|  | PCI_EXP_LNKSTA_CLS); | 
|  | } | 
|  | } | 
|  |  | 
|  | if (status_l0 & APPL_INTR_STATUS_L0_CDM_REG_CHK_INT) { | 
|  | status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_18); | 
|  | val = dw_pcie_readl_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS); | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMPLT) { | 
|  | dev_info(pci->dev, "CDM check complete\n"); | 
|  | val |= PCIE_PL_CHK_REG_CHK_REG_COMPLETE; | 
|  | } | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMP_ERR) { | 
|  | dev_err(pci->dev, "CDM comparison mismatch\n"); | 
|  | val |= PCIE_PL_CHK_REG_CHK_REG_COMPARISON_ERROR; | 
|  | } | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_LOGIC_ERR) { | 
|  | dev_err(pci->dev, "CDM Logic error\n"); | 
|  | val |= PCIE_PL_CHK_REG_CHK_REG_LOGIC_ERROR; | 
|  | } | 
|  | dw_pcie_writel_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS, val); | 
|  | val = dw_pcie_readl_dbi(pci, PCIE_PL_CHK_REG_ERR_ADDR); | 
|  | dev_err(pci->dev, "CDM Error Address Offset = 0x%08X\n", val); | 
|  | } | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static void pex_ep_event_hot_rst_done(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | u32 val; | 
|  |  | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_0_0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_1); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_2); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_3); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_6); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_7); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_8_0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_9); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_10); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_11); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_13); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_14); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_15); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_17); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_MSI_CTRL_2); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val |= APPL_CTRL_LTSSM_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  | } | 
|  |  | 
|  | static irqreturn_t tegra_pcie_ep_irq_thread(int irq, void *arg) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = arg; | 
|  | struct dw_pcie_ep *ep = &pcie->pci.ep; | 
|  | struct dw_pcie *pci = &pcie->pci; | 
|  | u32 val; | 
|  |  | 
|  | if (test_and_clear_bit(0, &pcie->link_status)) | 
|  | dw_pcie_ep_linkup(ep); | 
|  |  | 
|  | tegra_pcie_icc_set(pcie); | 
|  |  | 
|  | if (pcie->of_data->has_ltr_req_fix) | 
|  | return IRQ_HANDLED; | 
|  |  | 
|  | /* If EP doesn't advertise L1SS, just return */ | 
|  | val = dw_pcie_readl_dbi(pci, pcie->cfg_link_cap_l1sub); | 
|  | if (!(val & (PCI_L1SS_CAP_ASPM_L1_1 | PCI_L1SS_CAP_ASPM_L1_2))) | 
|  | return IRQ_HANDLED; | 
|  |  | 
|  | /* Check if BME is set to '1' */ | 
|  | val = dw_pcie_readl_dbi(pci, PCI_COMMAND); | 
|  | if (val & PCI_COMMAND_MASTER) { | 
|  | ktime_t timeout; | 
|  |  | 
|  | /* 110us for both snoop and no-snoop */ | 
|  | val = 110 | (2 << PCI_LTR_SCALE_SHIFT) | LTR_MSG_REQ; | 
|  | val |= (val << LTR_MST_NO_SNOOP_SHIFT); | 
|  | appl_writel(pcie, val, APPL_LTR_MSG_1); | 
|  |  | 
|  | /* Send LTR upstream */ | 
|  | val = appl_readl(pcie, APPL_LTR_MSG_2); | 
|  | val |= APPL_LTR_MSG_2_LTR_MSG_REQ_STATE; | 
|  | appl_writel(pcie, val, APPL_LTR_MSG_2); | 
|  |  | 
|  | timeout = ktime_add_us(ktime_get(), LTR_MSG_TIMEOUT); | 
|  | for (;;) { | 
|  | val = appl_readl(pcie, APPL_LTR_MSG_2); | 
|  | if (!(val & APPL_LTR_MSG_2_LTR_MSG_REQ_STATE)) | 
|  | break; | 
|  | if (ktime_after(ktime_get(), timeout)) | 
|  | break; | 
|  | usleep_range(1000, 1100); | 
|  | } | 
|  | if (val & APPL_LTR_MSG_2_LTR_MSG_REQ_STATE) | 
|  | dev_err(pcie->dev, "Failed to send LTR message\n"); | 
|  | } | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static irqreturn_t tegra_pcie_ep_hard_irq(int irq, void *arg) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = arg; | 
|  | int spurious = 1; | 
|  | u32 status_l0, status_l1, link_status; | 
|  |  | 
|  | status_l0 = appl_readl(pcie, APPL_INTR_STATUS_L0); | 
|  | if (status_l0 & APPL_INTR_STATUS_L0_LINK_STATE_INT) { | 
|  | status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_0_0); | 
|  | appl_writel(pcie, status_l1, APPL_INTR_STATUS_L1_0_0); | 
|  |  | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_0_0_HOT_RESET_DONE) | 
|  | pex_ep_event_hot_rst_done(pcie); | 
|  |  | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_0_0_RDLH_LINK_UP_CHGED) { | 
|  | link_status = appl_readl(pcie, APPL_LINK_STATUS); | 
|  | if (link_status & APPL_LINK_STATUS_RDLH_LINK_UP) { | 
|  | dev_dbg(pcie->dev, "Link is up with Host\n"); | 
|  | set_bit(0, &pcie->link_status); | 
|  | return IRQ_WAKE_THREAD; | 
|  | } | 
|  | } | 
|  |  | 
|  | spurious = 0; | 
|  | } | 
|  |  | 
|  | if (status_l0 & APPL_INTR_STATUS_L0_PCI_CMD_EN_INT) { | 
|  | status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_15); | 
|  | appl_writel(pcie, status_l1, APPL_INTR_STATUS_L1_15); | 
|  |  | 
|  | if (status_l1 & APPL_INTR_STATUS_L1_15_CFG_BME_CHGED) | 
|  | return IRQ_WAKE_THREAD; | 
|  |  | 
|  | spurious = 0; | 
|  | } | 
|  |  | 
|  | if (spurious) { | 
|  | dev_warn(pcie->dev, "Random interrupt (STATUS = 0x%08X)\n", | 
|  | status_l0); | 
|  | appl_writel(pcie, status_l0, APPL_INTR_STATUS_L0); | 
|  | } | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_rd_own_conf(struct pci_bus *bus, u32 devfn, int where, | 
|  | int size, u32 *val) | 
|  | { | 
|  | struct dw_pcie_rp *pp = bus->sysdata; | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  |  | 
|  | /* | 
|  | * This is an endpoint mode specific register happen to appear even | 
|  | * when controller is operating in root port mode and system hangs | 
|  | * when it is accessed with link being in ASPM-L1 state. | 
|  | * So skip accessing it altogether | 
|  | */ | 
|  | if (!pcie->of_data->has_msix_doorbell_access_fix && | 
|  | !PCI_SLOT(devfn) && where == PORT_LOGIC_MSIX_DOORBELL) { | 
|  | *val = 0x00000000; | 
|  | return PCIBIOS_SUCCESSFUL; | 
|  | } | 
|  |  | 
|  | return pci_generic_config_read(bus, devfn, where, size, val); | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_wr_own_conf(struct pci_bus *bus, u32 devfn, int where, | 
|  | int size, u32 val) | 
|  | { | 
|  | struct dw_pcie_rp *pp = bus->sysdata; | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  |  | 
|  | /* | 
|  | * This is an endpoint mode specific register happen to appear even | 
|  | * when controller is operating in root port mode and system hangs | 
|  | * when it is accessed with link being in ASPM-L1 state. | 
|  | * So skip accessing it altogether | 
|  | */ | 
|  | if (!pcie->of_data->has_msix_doorbell_access_fix && | 
|  | !PCI_SLOT(devfn) && where == PORT_LOGIC_MSIX_DOORBELL) | 
|  | return PCIBIOS_SUCCESSFUL; | 
|  |  | 
|  | return pci_generic_config_write(bus, devfn, where, size, val); | 
|  | } | 
|  |  | 
|  | static struct pci_ops tegra_pci_ops = { | 
|  | .map_bus = dw_pcie_own_conf_map_bus, | 
|  | .read = tegra_pcie_dw_rd_own_conf, | 
|  | .write = tegra_pcie_dw_wr_own_conf, | 
|  | }; | 
|  |  | 
|  | #if defined(CONFIG_PCIEASPM) | 
|  | static void disable_aspm_l11(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | u32 val; | 
|  |  | 
|  | val = dw_pcie_readl_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub); | 
|  | val &= ~PCI_L1SS_CAP_ASPM_L1_1; | 
|  | dw_pcie_writel_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub, val); | 
|  | } | 
|  |  | 
|  | static void disable_aspm_l12(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | u32 val; | 
|  |  | 
|  | val = dw_pcie_readl_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub); | 
|  | val &= ~PCI_L1SS_CAP_ASPM_L1_2; | 
|  | dw_pcie_writel_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub, val); | 
|  | } | 
|  |  | 
|  | static inline u32 event_counter_prog(struct tegra_pcie_dw *pcie, u32 event) | 
|  | { | 
|  | u32 val; | 
|  |  | 
|  | val = dw_pcie_readl_dbi(&pcie->pci, pcie->ras_des_cap + | 
|  | PCIE_RAS_DES_EVENT_COUNTER_CONTROL); | 
|  | val &= ~(EVENT_COUNTER_EVENT_SEL_MASK << EVENT_COUNTER_EVENT_SEL_SHIFT); | 
|  | val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT; | 
|  | val |= event << EVENT_COUNTER_EVENT_SEL_SHIFT; | 
|  | val |= EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT; | 
|  | dw_pcie_writel_dbi(&pcie->pci, pcie->ras_des_cap + | 
|  | PCIE_RAS_DES_EVENT_COUNTER_CONTROL, val); | 
|  | val = dw_pcie_readl_dbi(&pcie->pci, pcie->ras_des_cap + | 
|  | PCIE_RAS_DES_EVENT_COUNTER_DATA); | 
|  |  | 
|  | return val; | 
|  | } | 
|  |  | 
|  | static int aspm_state_cnt(struct seq_file *s, void *data) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = (struct tegra_pcie_dw *) | 
|  | dev_get_drvdata(s->private); | 
|  | u32 val; | 
|  |  | 
|  | seq_printf(s, "Tx L0s entry count : %u\n", | 
|  | event_counter_prog(pcie, EVENT_COUNTER_EVENT_Tx_L0S)); | 
|  |  | 
|  | seq_printf(s, "Rx L0s entry count : %u\n", | 
|  | event_counter_prog(pcie, EVENT_COUNTER_EVENT_Rx_L0S)); | 
|  |  | 
|  | seq_printf(s, "Link L1 entry count : %u\n", | 
|  | event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1)); | 
|  |  | 
|  | seq_printf(s, "Link L1.1 entry count : %u\n", | 
|  | event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1_1)); | 
|  |  | 
|  | seq_printf(s, "Link L1.2 entry count : %u\n", | 
|  | event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1_2)); | 
|  |  | 
|  | /* Clear all counters */ | 
|  | dw_pcie_writel_dbi(&pcie->pci, pcie->ras_des_cap + | 
|  | PCIE_RAS_DES_EVENT_COUNTER_CONTROL, | 
|  | EVENT_COUNTER_ALL_CLEAR); | 
|  |  | 
|  | /* Re-enable counting */ | 
|  | val = EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT; | 
|  | val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT; | 
|  | dw_pcie_writel_dbi(&pcie->pci, pcie->ras_des_cap + | 
|  | PCIE_RAS_DES_EVENT_COUNTER_CONTROL, val); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void init_host_aspm(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | struct dw_pcie *pci = &pcie->pci; | 
|  | u32 val; | 
|  |  | 
|  | val = dw_pcie_find_ext_capability(pci, PCI_EXT_CAP_ID_L1SS); | 
|  | pcie->cfg_link_cap_l1sub = val + PCI_L1SS_CAP; | 
|  |  | 
|  | pcie->ras_des_cap = dw_pcie_find_ext_capability(&pcie->pci, | 
|  | PCI_EXT_CAP_ID_VNDR); | 
|  |  | 
|  | /* Enable ASPM counters */ | 
|  | val = EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT; | 
|  | val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT; | 
|  | dw_pcie_writel_dbi(pci, pcie->ras_des_cap + | 
|  | PCIE_RAS_DES_EVENT_COUNTER_CONTROL, val); | 
|  |  | 
|  | /* Program T_cmrt and T_pwr_on values */ | 
|  | val = dw_pcie_readl_dbi(pci, pcie->cfg_link_cap_l1sub); | 
|  | val &= ~(PCI_L1SS_CAP_CM_RESTORE_TIME | PCI_L1SS_CAP_P_PWR_ON_VALUE); | 
|  | val |= (pcie->aspm_cmrt << 8); | 
|  | val |= (pcie->aspm_pwr_on_t << 19); | 
|  | dw_pcie_writel_dbi(pci, pcie->cfg_link_cap_l1sub, val); | 
|  |  | 
|  | /* Program L0s and L1 entrance latencies */ | 
|  | val = dw_pcie_readl_dbi(pci, PCIE_PORT_AFR); | 
|  | val &= ~PORT_AFR_L0S_ENTRANCE_LAT_MASK; | 
|  | val |= (pcie->aspm_l0s_enter_lat << PORT_AFR_L0S_ENTRANCE_LAT_SHIFT); | 
|  | val |= PORT_AFR_ENTER_ASPM; | 
|  | dw_pcie_writel_dbi(pci, PCIE_PORT_AFR, val); | 
|  | } | 
|  |  | 
|  | static void init_debugfs(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | debugfs_create_devm_seqfile(pcie->dev, "aspm_state_cnt", pcie->debugfs, | 
|  | aspm_state_cnt); | 
|  | } | 
|  | #else | 
|  | static inline void disable_aspm_l12(struct tegra_pcie_dw *pcie) { return; } | 
|  | static inline void disable_aspm_l11(struct tegra_pcie_dw *pcie) { return; } | 
|  | static inline void init_host_aspm(struct tegra_pcie_dw *pcie) { return; } | 
|  | static inline void init_debugfs(struct tegra_pcie_dw *pcie) { return; } | 
|  | #endif | 
|  |  | 
|  | static void tegra_pcie_enable_system_interrupts(struct dw_pcie_rp *pp) | 
|  | { | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  | u32 val; | 
|  | u16 val_w; | 
|  |  | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L0_0); | 
|  | val |= APPL_INTR_EN_L0_0_LINK_STATE_INT_EN; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L0_0); | 
|  |  | 
|  | if (!pcie->of_data->has_sbr_reset_fix) { | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L1_0_0); | 
|  | val |= APPL_INTR_EN_L1_0_0_LINK_REQ_RST_NOT_INT_EN; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L1_0_0); | 
|  | } | 
|  |  | 
|  | if (pcie->enable_cdm_check) { | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L0_0); | 
|  | val |= pcie->of_data->cdm_chk_int_en_bit; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L0_0); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L1_18); | 
|  | val |= APPL_INTR_EN_L1_18_CDM_REG_CHK_CMP_ERR; | 
|  | val |= APPL_INTR_EN_L1_18_CDM_REG_CHK_LOGIC_ERR; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L1_18); | 
|  | } | 
|  |  | 
|  | val_w = dw_pcie_readw_dbi(&pcie->pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKSTA); | 
|  | pcie->init_link_width = FIELD_GET(PCI_EXP_LNKSTA_NLW, val_w); | 
|  |  | 
|  | val_w = dw_pcie_readw_dbi(&pcie->pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKCTL); | 
|  | val_w |= PCI_EXP_LNKCTL_LBMIE; | 
|  | dw_pcie_writew_dbi(&pcie->pci, pcie->pcie_cap_base + PCI_EXP_LNKCTL, | 
|  | val_w); | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_enable_legacy_interrupts(struct dw_pcie_rp *pp) | 
|  | { | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  | u32 val; | 
|  |  | 
|  | /* Enable legacy interrupt generation */ | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L0_0); | 
|  | val |= APPL_INTR_EN_L0_0_SYS_INTR_EN; | 
|  | val |= APPL_INTR_EN_L0_0_INT_INT_EN; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L0_0); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L1_8_0); | 
|  | val |= APPL_INTR_EN_L1_8_INTX_EN; | 
|  | val |= APPL_INTR_EN_L1_8_AUTO_BW_INT_EN; | 
|  | val |= APPL_INTR_EN_L1_8_BW_MGT_INT_EN; | 
|  | if (IS_ENABLED(CONFIG_PCIEAER)) | 
|  | val |= APPL_INTR_EN_L1_8_AER_INT_EN; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L1_8_0); | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_enable_msi_interrupts(struct dw_pcie_rp *pp) | 
|  | { | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  | u32 val; | 
|  |  | 
|  | /* Enable MSI interrupt generation */ | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L0_0); | 
|  | val |= APPL_INTR_EN_L0_0_SYS_MSI_INTR_EN; | 
|  | val |= APPL_INTR_EN_L0_0_MSI_RCV_INT_EN; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L0_0); | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_enable_interrupts(struct dw_pcie_rp *pp) | 
|  | { | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  |  | 
|  | /* Clear interrupt statuses before enabling interrupts */ | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_0_0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_1); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_2); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_3); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_6); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_7); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_8_0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_9); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_10); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_11); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_13); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_14); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_15); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_17); | 
|  |  | 
|  | tegra_pcie_enable_system_interrupts(pp); | 
|  | tegra_pcie_enable_legacy_interrupts(pp); | 
|  | if (IS_ENABLED(CONFIG_PCI_MSI)) | 
|  | tegra_pcie_enable_msi_interrupts(pp); | 
|  | } | 
|  |  | 
|  | static void config_gen3_gen4_eq_presets(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | struct dw_pcie *pci = &pcie->pci; | 
|  | u32 val, offset, i; | 
|  |  | 
|  | /* Program init preset */ | 
|  | for (i = 0; i < pcie->num_lanes; i++) { | 
|  | val = dw_pcie_readw_dbi(pci, CAP_SPCIE_CAP_OFF + (i * 2)); | 
|  | val &= ~CAP_SPCIE_CAP_OFF_DSP_TX_PRESET0_MASK; | 
|  | val |= GEN3_GEN4_EQ_PRESET_INIT; | 
|  | val &= ~CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_MASK; | 
|  | val |= (GEN3_GEN4_EQ_PRESET_INIT << | 
|  | CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_SHIFT); | 
|  | dw_pcie_writew_dbi(pci, CAP_SPCIE_CAP_OFF + (i * 2), val); | 
|  |  | 
|  | offset = dw_pcie_find_ext_capability(pci, | 
|  | PCI_EXT_CAP_ID_PL_16GT) + | 
|  | PCI_PL_16GT_LE_CTRL; | 
|  | val = dw_pcie_readb_dbi(pci, offset + i); | 
|  | val &= ~PCI_PL_16GT_LE_CTRL_DSP_TX_PRESET_MASK; | 
|  | val |= GEN3_GEN4_EQ_PRESET_INIT; | 
|  | val &= ~PCI_PL_16GT_LE_CTRL_USP_TX_PRESET_MASK; | 
|  | val |= (GEN3_GEN4_EQ_PRESET_INIT << | 
|  | PCI_PL_16GT_LE_CTRL_USP_TX_PRESET_SHIFT); | 
|  | dw_pcie_writeb_dbi(pci, offset + i, val); | 
|  | } | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF); | 
|  | val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK; | 
|  | dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val); | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, GEN3_EQ_CONTROL_OFF); | 
|  | val &= ~GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK; | 
|  | val |= (0x3ff << GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT); | 
|  | val &= ~GEN3_EQ_CONTROL_OFF_FB_MODE_MASK; | 
|  | dw_pcie_writel_dbi(pci, GEN3_EQ_CONTROL_OFF, val); | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF); | 
|  | val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK; | 
|  | val |= (0x1 << GEN3_RELATED_OFF_RATE_SHADOW_SEL_SHIFT); | 
|  | dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val); | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, GEN3_EQ_CONTROL_OFF); | 
|  | val &= ~GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK; | 
|  | val |= (pcie->of_data->gen4_preset_vec << | 
|  | GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT); | 
|  | val &= ~GEN3_EQ_CONTROL_OFF_FB_MODE_MASK; | 
|  | dw_pcie_writel_dbi(pci, GEN3_EQ_CONTROL_OFF, val); | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF); | 
|  | val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK; | 
|  | dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val); | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_host_init(struct dw_pcie_rp *pp) | 
|  | { | 
|  | struct dw_pcie *pci = to_dw_pcie_from_pp(pp); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  | u32 val; | 
|  | u16 val_16; | 
|  |  | 
|  | pp->bridge->ops = &tegra_pci_ops; | 
|  |  | 
|  | if (!pcie->pcie_cap_base) | 
|  | pcie->pcie_cap_base = dw_pcie_find_capability(&pcie->pci, | 
|  | PCI_CAP_ID_EXP); | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, PCI_IO_BASE); | 
|  | val &= ~(IO_BASE_IO_DECODE | IO_BASE_IO_DECODE_BIT8); | 
|  | dw_pcie_writel_dbi(pci, PCI_IO_BASE, val); | 
|  |  | 
|  | val = dw_pcie_readl_dbi(pci, PCI_PREF_MEMORY_BASE); | 
|  | val |= CFG_PREF_MEM_LIMIT_BASE_MEM_DECODE; | 
|  | val |= CFG_PREF_MEM_LIMIT_BASE_MEM_LIMIT_DECODE; | 
|  | dw_pcie_writel_dbi(pci, PCI_PREF_MEMORY_BASE, val); | 
|  |  | 
|  | dw_pcie_writel_dbi(pci, PCI_BASE_ADDRESS_0, 0); | 
|  |  | 
|  | /* Enable as 0xFFFF0001 response for CRS */ | 
|  | val = dw_pcie_readl_dbi(pci, PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT); | 
|  | val &= ~(AMBA_ERROR_RESPONSE_CRS_MASK << AMBA_ERROR_RESPONSE_CRS_SHIFT); | 
|  | val |= (AMBA_ERROR_RESPONSE_CRS_OKAY_FFFF0001 << | 
|  | AMBA_ERROR_RESPONSE_CRS_SHIFT); | 
|  | dw_pcie_writel_dbi(pci, PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT, val); | 
|  |  | 
|  | /* Configure Max lane width from DT */ | 
|  | val = dw_pcie_readl_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKCAP); | 
|  | val &= ~PCI_EXP_LNKCAP_MLW; | 
|  | val |= FIELD_PREP(PCI_EXP_LNKCAP_MLW, pcie->num_lanes); | 
|  | dw_pcie_writel_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKCAP, val); | 
|  |  | 
|  | /* Clear Slot Clock Configuration bit if SRNS configuration */ | 
|  | if (pcie->enable_srns) { | 
|  | val_16 = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKSTA); | 
|  | val_16 &= ~PCI_EXP_LNKSTA_SLC; | 
|  | dw_pcie_writew_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA, | 
|  | val_16); | 
|  | } | 
|  |  | 
|  | config_gen3_gen4_eq_presets(pcie); | 
|  |  | 
|  | init_host_aspm(pcie); | 
|  |  | 
|  | /* Disable ASPM-L1SS advertisement if there is no CLKREQ routing */ | 
|  | if (!pcie->supports_clkreq) { | 
|  | disable_aspm_l11(pcie); | 
|  | disable_aspm_l12(pcie); | 
|  | } | 
|  |  | 
|  | if (!pcie->of_data->has_l1ss_exit_fix) { | 
|  | val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF); | 
|  | val &= ~GEN3_RELATED_OFF_GEN3_ZRXDC_NONCOMPL; | 
|  | dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val); | 
|  | } | 
|  |  | 
|  | if (pcie->update_fc_fixup) { | 
|  | val = dw_pcie_readl_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF); | 
|  | val |= 0x1 << CFG_TIMER_CTRL_ACK_NAK_SHIFT; | 
|  | dw_pcie_writel_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF, val); | 
|  | } | 
|  |  | 
|  | clk_set_rate(pcie->core_clk, GEN4_CORE_CLK_FREQ); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_start_link(struct dw_pcie *pci) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  | struct dw_pcie_rp *pp = &pci->pp; | 
|  | u32 val, offset, tmp; | 
|  | bool retry = true; | 
|  |  | 
|  | if (pcie->of_data->mode == DW_PCIE_EP_TYPE) { | 
|  | enable_irq(pcie->pex_rst_irq); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | retry_link: | 
|  | /* Assert RST */ | 
|  | val = appl_readl(pcie, APPL_PINMUX); | 
|  | val &= ~APPL_PINMUX_PEX_RST; | 
|  | appl_writel(pcie, val, APPL_PINMUX); | 
|  |  | 
|  | usleep_range(100, 200); | 
|  |  | 
|  | /* Enable LTSSM */ | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val |= APPL_CTRL_LTSSM_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  |  | 
|  | /* De-assert RST */ | 
|  | val = appl_readl(pcie, APPL_PINMUX); | 
|  | val |= APPL_PINMUX_PEX_RST; | 
|  | appl_writel(pcie, val, APPL_PINMUX); | 
|  |  | 
|  | msleep(100); | 
|  |  | 
|  | if (dw_pcie_wait_for_link(pci)) { | 
|  | if (!retry) | 
|  | return 0; | 
|  | /* | 
|  | * There are some endpoints which can't get the link up if | 
|  | * root port has Data Link Feature (DLF) enabled. | 
|  | * Refer Spec rev 4.0 ver 1.0 sec 3.4.2 & 7.7.4 for more info | 
|  | * on Scaled Flow Control and DLF. | 
|  | * So, need to confirm that is indeed the case here and attempt | 
|  | * link up once again with DLF disabled. | 
|  | */ | 
|  | val = appl_readl(pcie, APPL_DEBUG); | 
|  | val &= APPL_DEBUG_LTSSM_STATE_MASK; | 
|  | val >>= APPL_DEBUG_LTSSM_STATE_SHIFT; | 
|  | tmp = appl_readl(pcie, APPL_LINK_STATUS); | 
|  | tmp &= APPL_LINK_STATUS_RDLH_LINK_UP; | 
|  | if (!(val == 0x11 && !tmp)) { | 
|  | /* Link is down for all good reasons */ | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | dev_info(pci->dev, "Link is down in DLL"); | 
|  | dev_info(pci->dev, "Trying again with DLFE disabled\n"); | 
|  | /* Disable LTSSM */ | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val &= ~APPL_CTRL_LTSSM_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  |  | 
|  | reset_control_assert(pcie->core_rst); | 
|  | reset_control_deassert(pcie->core_rst); | 
|  |  | 
|  | offset = dw_pcie_find_ext_capability(pci, PCI_EXT_CAP_ID_DLF); | 
|  | val = dw_pcie_readl_dbi(pci, offset + PCI_DLF_CAP); | 
|  | val &= ~PCI_DLF_EXCHANGE_ENABLE; | 
|  | dw_pcie_writel_dbi(pci, offset + PCI_DLF_CAP, val); | 
|  |  | 
|  | tegra_pcie_dw_host_init(pp); | 
|  | dw_pcie_setup_rc(pp); | 
|  |  | 
|  | retry = false; | 
|  | goto retry_link; | 
|  | } | 
|  |  | 
|  | tegra_pcie_icc_set(pcie); | 
|  |  | 
|  | tegra_pcie_enable_interrupts(pp); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_link_up(struct dw_pcie *pci) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  | u32 val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA); | 
|  |  | 
|  | return !!(val & PCI_EXP_LNKSTA_DLLLA); | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_dw_stop_link(struct dw_pcie *pci) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  |  | 
|  | disable_irq(pcie->pex_rst_irq); | 
|  | } | 
|  |  | 
|  | static const struct dw_pcie_ops tegra_dw_pcie_ops = { | 
|  | .link_up = tegra_pcie_dw_link_up, | 
|  | .start_link = tegra_pcie_dw_start_link, | 
|  | .stop_link = tegra_pcie_dw_stop_link, | 
|  | }; | 
|  |  | 
|  | static const struct dw_pcie_host_ops tegra_pcie_dw_host_ops = { | 
|  | .host_init = tegra_pcie_dw_host_init, | 
|  | }; | 
|  |  | 
|  | static void tegra_pcie_disable_phy(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | unsigned int phy_count = pcie->phy_count; | 
|  |  | 
|  | while (phy_count--) { | 
|  | phy_power_off(pcie->phys[phy_count]); | 
|  | phy_exit(pcie->phys[phy_count]); | 
|  | } | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_enable_phy(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | unsigned int i; | 
|  | int ret; | 
|  |  | 
|  | for (i = 0; i < pcie->phy_count; i++) { | 
|  | ret = phy_init(pcie->phys[i]); | 
|  | if (ret < 0) | 
|  | goto phy_power_off; | 
|  |  | 
|  | ret = phy_power_on(pcie->phys[i]); | 
|  | if (ret < 0) | 
|  | goto phy_exit; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | phy_power_off: | 
|  | while (i--) { | 
|  | phy_power_off(pcie->phys[i]); | 
|  | phy_exit: | 
|  | phy_exit(pcie->phys[i]); | 
|  | } | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_parse_dt(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | struct platform_device *pdev = to_platform_device(pcie->dev); | 
|  | struct device_node *np = pcie->dev->of_node; | 
|  | int ret; | 
|  |  | 
|  | pcie->dbi_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dbi"); | 
|  | if (!pcie->dbi_res) { | 
|  | dev_err(pcie->dev, "Failed to find \"dbi\" region\n"); | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | ret = of_property_read_u32(np, "nvidia,aspm-cmrt-us", &pcie->aspm_cmrt); | 
|  | if (ret < 0) { | 
|  | dev_info(pcie->dev, "Failed to read ASPM T_cmrt: %d\n", ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | ret = of_property_read_u32(np, "nvidia,aspm-pwr-on-t-us", | 
|  | &pcie->aspm_pwr_on_t); | 
|  | if (ret < 0) | 
|  | dev_info(pcie->dev, "Failed to read ASPM Power On time: %d\n", | 
|  | ret); | 
|  |  | 
|  | ret = of_property_read_u32(np, "nvidia,aspm-l0s-entrance-latency-us", | 
|  | &pcie->aspm_l0s_enter_lat); | 
|  | if (ret < 0) | 
|  | dev_info(pcie->dev, | 
|  | "Failed to read ASPM L0s Entrance latency: %d\n", ret); | 
|  |  | 
|  | ret = of_property_read_u32(np, "num-lanes", &pcie->num_lanes); | 
|  | if (ret < 0) { | 
|  | dev_err(pcie->dev, "Failed to read num-lanes: %d\n", ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | ret = of_property_read_u32_index(np, "nvidia,bpmp", 1, &pcie->cid); | 
|  | if (ret) { | 
|  | dev_err(pcie->dev, "Failed to read Controller-ID: %d\n", ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | ret = of_property_count_strings(np, "phy-names"); | 
|  | if (ret < 0) { | 
|  | dev_err(pcie->dev, "Failed to find PHY entries: %d\n", | 
|  | ret); | 
|  | return ret; | 
|  | } | 
|  | pcie->phy_count = ret; | 
|  |  | 
|  | if (of_property_read_bool(np, "nvidia,update-fc-fixup")) | 
|  | pcie->update_fc_fixup = true; | 
|  |  | 
|  | /* RP using an external REFCLK is supported only in Tegra234 */ | 
|  | if (pcie->of_data->version == TEGRA194_DWC_IP_VER) { | 
|  | if (pcie->of_data->mode == DW_PCIE_EP_TYPE) | 
|  | pcie->enable_ext_refclk = true; | 
|  | } else { | 
|  | pcie->enable_ext_refclk = | 
|  | of_property_read_bool(pcie->dev->of_node, | 
|  | "nvidia,enable-ext-refclk"); | 
|  | } | 
|  |  | 
|  | pcie->supports_clkreq = | 
|  | of_property_read_bool(pcie->dev->of_node, "supports-clkreq"); | 
|  |  | 
|  | pcie->enable_cdm_check = | 
|  | of_property_read_bool(np, "snps,enable-cdm-check"); | 
|  |  | 
|  | if (pcie->of_data->version == TEGRA234_DWC_IP_VER) | 
|  | pcie->enable_srns = | 
|  | of_property_read_bool(np, "nvidia,enable-srns"); | 
|  |  | 
|  | if (pcie->of_data->mode == DW_PCIE_RC_TYPE) | 
|  | return 0; | 
|  |  | 
|  | /* Endpoint mode specific DT entries */ | 
|  | pcie->pex_rst_gpiod = devm_gpiod_get(pcie->dev, "reset", GPIOD_IN); | 
|  | if (IS_ERR(pcie->pex_rst_gpiod)) { | 
|  | int err = PTR_ERR(pcie->pex_rst_gpiod); | 
|  | const char *level = KERN_ERR; | 
|  |  | 
|  | if (err == -EPROBE_DEFER) | 
|  | level = KERN_DEBUG; | 
|  |  | 
|  | dev_printk(level, pcie->dev, | 
|  | dev_fmt("Failed to get PERST GPIO: %d\n"), | 
|  | err); | 
|  | return err; | 
|  | } | 
|  |  | 
|  | pcie->pex_refclk_sel_gpiod = devm_gpiod_get(pcie->dev, | 
|  | "nvidia,refclk-select", | 
|  | GPIOD_OUT_HIGH); | 
|  | if (IS_ERR(pcie->pex_refclk_sel_gpiod)) { | 
|  | int err = PTR_ERR(pcie->pex_refclk_sel_gpiod); | 
|  | const char *level = KERN_ERR; | 
|  |  | 
|  | if (err == -EPROBE_DEFER) | 
|  | level = KERN_DEBUG; | 
|  |  | 
|  | dev_printk(level, pcie->dev, | 
|  | dev_fmt("Failed to get REFCLK select GPIOs: %d\n"), | 
|  | err); | 
|  | pcie->pex_refclk_sel_gpiod = NULL; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_bpmp_set_ctrl_state(struct tegra_pcie_dw *pcie, | 
|  | bool enable) | 
|  | { | 
|  | struct mrq_uphy_response resp; | 
|  | struct tegra_bpmp_message msg; | 
|  | struct mrq_uphy_request req; | 
|  |  | 
|  | /* | 
|  | * Controller-5 doesn't need to have its state set by BPMP-FW in | 
|  | * Tegra194 | 
|  | */ | 
|  | if (pcie->of_data->version == TEGRA194_DWC_IP_VER && pcie->cid == 5) | 
|  | return 0; | 
|  |  | 
|  | memset(&req, 0, sizeof(req)); | 
|  | memset(&resp, 0, sizeof(resp)); | 
|  |  | 
|  | req.cmd = CMD_UPHY_PCIE_CONTROLLER_STATE; | 
|  | req.controller_state.pcie_controller = pcie->cid; | 
|  | req.controller_state.enable = enable; | 
|  |  | 
|  | memset(&msg, 0, sizeof(msg)); | 
|  | msg.mrq = MRQ_UPHY; | 
|  | msg.tx.data = &req; | 
|  | msg.tx.size = sizeof(req); | 
|  | msg.rx.data = &resp; | 
|  | msg.rx.size = sizeof(resp); | 
|  |  | 
|  | return tegra_bpmp_transfer(pcie->bpmp, &msg); | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_bpmp_set_pll_state(struct tegra_pcie_dw *pcie, | 
|  | bool enable) | 
|  | { | 
|  | struct mrq_uphy_response resp; | 
|  | struct tegra_bpmp_message msg; | 
|  | struct mrq_uphy_request req; | 
|  |  | 
|  | memset(&req, 0, sizeof(req)); | 
|  | memset(&resp, 0, sizeof(resp)); | 
|  |  | 
|  | if (enable) { | 
|  | req.cmd = CMD_UPHY_PCIE_EP_CONTROLLER_PLL_INIT; | 
|  | req.ep_ctrlr_pll_init.ep_controller = pcie->cid; | 
|  | } else { | 
|  | req.cmd = CMD_UPHY_PCIE_EP_CONTROLLER_PLL_OFF; | 
|  | req.ep_ctrlr_pll_off.ep_controller = pcie->cid; | 
|  | } | 
|  |  | 
|  | memset(&msg, 0, sizeof(msg)); | 
|  | msg.mrq = MRQ_UPHY; | 
|  | msg.tx.data = &req; | 
|  | msg.tx.size = sizeof(req); | 
|  | msg.rx.data = &resp; | 
|  | msg.rx.size = sizeof(resp); | 
|  |  | 
|  | return tegra_bpmp_transfer(pcie->bpmp, &msg); | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_downstream_dev_to_D0(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | struct dw_pcie_rp *pp = &pcie->pci.pp; | 
|  | struct pci_bus *child, *root_bus = NULL; | 
|  | struct pci_dev *pdev; | 
|  |  | 
|  | /* | 
|  | * link doesn't go into L2 state with some of the endpoints with Tegra | 
|  | * if they are not in D0 state. So, need to make sure that immediate | 
|  | * downstream devices are in D0 state before sending PME_TurnOff to put | 
|  | * link into L2 state. | 
|  | * This is as per PCI Express Base r4.0 v1.0 September 27-2017, | 
|  | * 5.2 Link State Power Management (Page #428). | 
|  | */ | 
|  |  | 
|  | list_for_each_entry(child, &pp->bridge->bus->children, node) { | 
|  | /* Bring downstream devices to D0 if they are not already in */ | 
|  | if (child->parent == pp->bridge->bus) { | 
|  | root_bus = child; | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | if (!root_bus) { | 
|  | dev_err(pcie->dev, "Failed to find downstream devices\n"); | 
|  | return; | 
|  | } | 
|  |  | 
|  | list_for_each_entry(pdev, &root_bus->devices, bus_list) { | 
|  | if (PCI_SLOT(pdev->devfn) == 0) { | 
|  | if (pci_set_power_state(pdev, PCI_D0)) | 
|  | dev_err(pcie->dev, | 
|  | "Failed to transition %s to D0 state\n", | 
|  | dev_name(&pdev->dev)); | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_get_slot_regulators(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | pcie->slot_ctl_3v3 = devm_regulator_get_optional(pcie->dev, "vpcie3v3"); | 
|  | if (IS_ERR(pcie->slot_ctl_3v3)) { | 
|  | if (PTR_ERR(pcie->slot_ctl_3v3) != -ENODEV) | 
|  | return PTR_ERR(pcie->slot_ctl_3v3); | 
|  |  | 
|  | pcie->slot_ctl_3v3 = NULL; | 
|  | } | 
|  |  | 
|  | pcie->slot_ctl_12v = devm_regulator_get_optional(pcie->dev, "vpcie12v"); | 
|  | if (IS_ERR(pcie->slot_ctl_12v)) { | 
|  | if (PTR_ERR(pcie->slot_ctl_12v) != -ENODEV) | 
|  | return PTR_ERR(pcie->slot_ctl_12v); | 
|  |  | 
|  | pcie->slot_ctl_12v = NULL; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_enable_slot_regulators(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | if (pcie->slot_ctl_3v3) { | 
|  | ret = regulator_enable(pcie->slot_ctl_3v3); | 
|  | if (ret < 0) { | 
|  | dev_err(pcie->dev, | 
|  | "Failed to enable 3.3V slot supply: %d\n", ret); | 
|  | return ret; | 
|  | } | 
|  | } | 
|  |  | 
|  | if (pcie->slot_ctl_12v) { | 
|  | ret = regulator_enable(pcie->slot_ctl_12v); | 
|  | if (ret < 0) { | 
|  | dev_err(pcie->dev, | 
|  | "Failed to enable 12V slot supply: %d\n", ret); | 
|  | goto fail_12v_enable; | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * According to PCI Express Card Electromechanical Specification | 
|  | * Revision 1.1, Table-2.4, T_PVPERL (Power stable to PERST# inactive) | 
|  | * should be a minimum of 100ms. | 
|  | */ | 
|  | if (pcie->slot_ctl_3v3 || pcie->slot_ctl_12v) | 
|  | msleep(100); | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | fail_12v_enable: | 
|  | if (pcie->slot_ctl_3v3) | 
|  | regulator_disable(pcie->slot_ctl_3v3); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_disable_slot_regulators(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | if (pcie->slot_ctl_12v) | 
|  | regulator_disable(pcie->slot_ctl_12v); | 
|  | if (pcie->slot_ctl_3v3) | 
|  | regulator_disable(pcie->slot_ctl_3v3); | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_config_controller(struct tegra_pcie_dw *pcie, | 
|  | bool en_hw_hot_rst) | 
|  | { | 
|  | int ret; | 
|  | u32 val; | 
|  |  | 
|  | ret = tegra_pcie_bpmp_set_ctrl_state(pcie, true); | 
|  | if (ret) { | 
|  | dev_err(pcie->dev, | 
|  | "Failed to enable controller %u: %d\n", pcie->cid, ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | if (pcie->enable_ext_refclk) { | 
|  | ret = tegra_pcie_bpmp_set_pll_state(pcie, true); | 
|  | if (ret) { | 
|  | dev_err(pcie->dev, "Failed to init UPHY: %d\n", ret); | 
|  | goto fail_pll_init; | 
|  | } | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_enable_slot_regulators(pcie); | 
|  | if (ret < 0) | 
|  | goto fail_slot_reg_en; | 
|  |  | 
|  | ret = regulator_enable(pcie->pex_ctl_supply); | 
|  | if (ret < 0) { | 
|  | dev_err(pcie->dev, "Failed to enable regulator: %d\n", ret); | 
|  | goto fail_reg_en; | 
|  | } | 
|  |  | 
|  | ret = clk_prepare_enable(pcie->core_clk); | 
|  | if (ret) { | 
|  | dev_err(pcie->dev, "Failed to enable core clock: %d\n", ret); | 
|  | goto fail_core_clk; | 
|  | } | 
|  |  | 
|  | ret = reset_control_deassert(pcie->core_apb_rst); | 
|  | if (ret) { | 
|  | dev_err(pcie->dev, "Failed to deassert core APB reset: %d\n", | 
|  | ret); | 
|  | goto fail_core_apb_rst; | 
|  | } | 
|  |  | 
|  | if (en_hw_hot_rst || pcie->of_data->has_sbr_reset_fix) { | 
|  | /* Enable HW_HOT_RST mode */ | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK << | 
|  | APPL_CTRL_HW_HOT_RST_MODE_SHIFT); | 
|  | val |= (APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST_LTSSM_EN << | 
|  | APPL_CTRL_HW_HOT_RST_MODE_SHIFT); | 
|  | val |= APPL_CTRL_HW_HOT_RST_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_enable_phy(pcie); | 
|  | if (ret) { | 
|  | dev_err(pcie->dev, "Failed to enable PHY: %d\n", ret); | 
|  | goto fail_phy; | 
|  | } | 
|  |  | 
|  | /* Update CFG base address */ | 
|  | appl_writel(pcie, pcie->dbi_res->start & APPL_CFG_BASE_ADDR_MASK, | 
|  | APPL_CFG_BASE_ADDR); | 
|  |  | 
|  | /* Configure this core for RP mode operation */ | 
|  | appl_writel(pcie, APPL_DM_TYPE_RP, APPL_DM_TYPE); | 
|  |  | 
|  | appl_writel(pcie, 0x0, APPL_CFG_SLCG_OVERRIDE); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | appl_writel(pcie, val | APPL_CTRL_SYS_PRE_DET_STATE, APPL_CTRL); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_CFG_MISC); | 
|  | val |= (APPL_CFG_MISC_ARCACHE_VAL << APPL_CFG_MISC_ARCACHE_SHIFT); | 
|  | appl_writel(pcie, val, APPL_CFG_MISC); | 
|  |  | 
|  | if (pcie->enable_srns || pcie->enable_ext_refclk) { | 
|  | /* | 
|  | * When Tegra PCIe RP is using external clock, it cannot supply | 
|  | * same clock to its downstream hierarchy. Hence, gate PCIe RP | 
|  | * REFCLK out pads when RP & EP are using separate clocks or RP | 
|  | * is using an external REFCLK. | 
|  | */ | 
|  | val = appl_readl(pcie, APPL_PINMUX); | 
|  | val |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN; | 
|  | val &= ~APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE; | 
|  | appl_writel(pcie, val, APPL_PINMUX); | 
|  | } | 
|  |  | 
|  | if (!pcie->supports_clkreq) { | 
|  | val = appl_readl(pcie, APPL_PINMUX); | 
|  | val |= APPL_PINMUX_CLKREQ_OVERRIDE_EN; | 
|  | val &= ~APPL_PINMUX_CLKREQ_OVERRIDE; | 
|  | appl_writel(pcie, val, APPL_PINMUX); | 
|  | } | 
|  |  | 
|  | /* Update iATU_DMA base address */ | 
|  | appl_writel(pcie, | 
|  | pcie->atu_dma_res->start & APPL_CFG_IATU_DMA_BASE_ADDR_MASK, | 
|  | APPL_CFG_IATU_DMA_BASE_ADDR); | 
|  |  | 
|  | reset_control_deassert(pcie->core_rst); | 
|  |  | 
|  | return ret; | 
|  |  | 
|  | fail_phy: | 
|  | reset_control_assert(pcie->core_apb_rst); | 
|  | fail_core_apb_rst: | 
|  | clk_disable_unprepare(pcie->core_clk); | 
|  | fail_core_clk: | 
|  | regulator_disable(pcie->pex_ctl_supply); | 
|  | fail_reg_en: | 
|  | tegra_pcie_disable_slot_regulators(pcie); | 
|  | fail_slot_reg_en: | 
|  | if (pcie->enable_ext_refclk) | 
|  | tegra_pcie_bpmp_set_pll_state(pcie, false); | 
|  | fail_pll_init: | 
|  | tegra_pcie_bpmp_set_ctrl_state(pcie, false); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_unconfig_controller(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = reset_control_assert(pcie->core_rst); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to assert \"core\" reset: %d\n", ret); | 
|  |  | 
|  | tegra_pcie_disable_phy(pcie); | 
|  |  | 
|  | ret = reset_control_assert(pcie->core_apb_rst); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to assert APB reset: %d\n", ret); | 
|  |  | 
|  | clk_disable_unprepare(pcie->core_clk); | 
|  |  | 
|  | ret = regulator_disable(pcie->pex_ctl_supply); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to disable regulator: %d\n", ret); | 
|  |  | 
|  | tegra_pcie_disable_slot_regulators(pcie); | 
|  |  | 
|  | if (pcie->enable_ext_refclk) { | 
|  | ret = tegra_pcie_bpmp_set_pll_state(pcie, false); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to deinit UPHY: %d\n", ret); | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_bpmp_set_ctrl_state(pcie, false); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to disable controller %d: %d\n", | 
|  | pcie->cid, ret); | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_init_controller(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | struct dw_pcie *pci = &pcie->pci; | 
|  | struct dw_pcie_rp *pp = &pci->pp; | 
|  | int ret; | 
|  |  | 
|  | ret = tegra_pcie_config_controller(pcie, false); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | pp->ops = &tegra_pcie_dw_host_ops; | 
|  |  | 
|  | ret = dw_pcie_host_init(pp); | 
|  | if (ret < 0) { | 
|  | dev_err(pcie->dev, "Failed to add PCIe port: %d\n", ret); | 
|  | goto fail_host_init; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | fail_host_init: | 
|  | tegra_pcie_unconfig_controller(pcie); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_try_link_l2(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | u32 val; | 
|  |  | 
|  | if (!tegra_pcie_dw_link_up(&pcie->pci)) | 
|  | return 0; | 
|  |  | 
|  | val = appl_readl(pcie, APPL_RADM_STATUS); | 
|  | val |= APPL_PM_XMT_TURNOFF_STATE; | 
|  | appl_writel(pcie, val, APPL_RADM_STATUS); | 
|  |  | 
|  | return readl_poll_timeout_atomic(pcie->appl_base + APPL_DEBUG, val, | 
|  | val & APPL_DEBUG_PM_LINKST_IN_L2_LAT, | 
|  | 1, PME_ACK_TIMEOUT); | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_dw_pme_turnoff(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | u32 data; | 
|  | int err; | 
|  |  | 
|  | if (!tegra_pcie_dw_link_up(&pcie->pci)) { | 
|  | dev_dbg(pcie->dev, "PCIe link is not up...!\n"); | 
|  | return; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * PCIe controller exits from L2 only if reset is applied, so | 
|  | * controller doesn't handle interrupts. But in cases where | 
|  | * L2 entry fails, PERST# is asserted which can trigger surprise | 
|  | * link down AER. However this function call happens in | 
|  | * suspend_noirq(), so AER interrupt will not be processed. | 
|  | * Disable all interrupts to avoid such a scenario. | 
|  | */ | 
|  | appl_writel(pcie, 0x0, APPL_INTR_EN_L0_0); | 
|  |  | 
|  | if (tegra_pcie_try_link_l2(pcie)) { | 
|  | dev_info(pcie->dev, "Link didn't transition to L2 state\n"); | 
|  | /* | 
|  | * TX lane clock freq will reset to Gen1 only if link is in L2 | 
|  | * or detect state. | 
|  | * So apply pex_rst to end point to force RP to go into detect | 
|  | * state | 
|  | */ | 
|  | data = appl_readl(pcie, APPL_PINMUX); | 
|  | data &= ~APPL_PINMUX_PEX_RST; | 
|  | appl_writel(pcie, data, APPL_PINMUX); | 
|  |  | 
|  | /* | 
|  | * Some cards do not go to detect state even after de-asserting | 
|  | * PERST#. So, de-assert LTSSM to bring link to detect state. | 
|  | */ | 
|  | data = readl(pcie->appl_base + APPL_CTRL); | 
|  | data &= ~APPL_CTRL_LTSSM_EN; | 
|  | writel(data, pcie->appl_base + APPL_CTRL); | 
|  |  | 
|  | err = readl_poll_timeout_atomic(pcie->appl_base + APPL_DEBUG, | 
|  | data, | 
|  | ((data & | 
|  | APPL_DEBUG_LTSSM_STATE_MASK) >> | 
|  | APPL_DEBUG_LTSSM_STATE_SHIFT) == | 
|  | LTSSM_STATE_PRE_DETECT, | 
|  | 1, LTSSM_TIMEOUT); | 
|  | if (err) | 
|  | dev_info(pcie->dev, "Link didn't go to detect state\n"); | 
|  | } | 
|  | /* | 
|  | * DBI registers may not be accessible after this as PLL-E would be | 
|  | * down depending on how CLKREQ is pulled by end point | 
|  | */ | 
|  | data = appl_readl(pcie, APPL_PINMUX); | 
|  | data |= (APPL_PINMUX_CLKREQ_OVERRIDE_EN | APPL_PINMUX_CLKREQ_OVERRIDE); | 
|  | /* Cut REFCLK to slot */ | 
|  | data |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN; | 
|  | data &= ~APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE; | 
|  | appl_writel(pcie, data, APPL_PINMUX); | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_deinit_controller(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | tegra_pcie_downstream_dev_to_D0(pcie); | 
|  | dw_pcie_host_deinit(&pcie->pci.pp); | 
|  | tegra_pcie_dw_pme_turnoff(pcie); | 
|  | tegra_pcie_unconfig_controller(pcie); | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_config_rp(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | struct device *dev = pcie->dev; | 
|  | char *name; | 
|  | int ret; | 
|  |  | 
|  | pm_runtime_enable(dev); | 
|  |  | 
|  | ret = pm_runtime_get_sync(dev); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to get runtime sync for PCIe dev: %d\n", | 
|  | ret); | 
|  | goto fail_pm_get_sync; | 
|  | } | 
|  |  | 
|  | ret = pinctrl_pm_select_default_state(dev); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to configure sideband pins: %d\n", ret); | 
|  | goto fail_pm_get_sync; | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_init_controller(pcie); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to initialize controller: %d\n", ret); | 
|  | goto fail_pm_get_sync; | 
|  | } | 
|  |  | 
|  | pcie->link_state = tegra_pcie_dw_link_up(&pcie->pci); | 
|  | if (!pcie->link_state) { | 
|  | ret = -ENOMEDIUM; | 
|  | goto fail_host_init; | 
|  | } | 
|  |  | 
|  | name = devm_kasprintf(dev, GFP_KERNEL, "%pOFP", dev->of_node); | 
|  | if (!name) { | 
|  | ret = -ENOMEM; | 
|  | goto fail_host_init; | 
|  | } | 
|  |  | 
|  | pcie->debugfs = debugfs_create_dir(name, NULL); | 
|  | init_debugfs(pcie); | 
|  |  | 
|  | return ret; | 
|  |  | 
|  | fail_host_init: | 
|  | tegra_pcie_deinit_controller(pcie); | 
|  | fail_pm_get_sync: | 
|  | pm_runtime_put_sync(dev); | 
|  | pm_runtime_disable(dev); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static void pex_ep_event_pex_rst_assert(struct tegra_pcie_dw *pcie) | 
|  | { | 
|  | u32 val; | 
|  | int ret; | 
|  |  | 
|  | if (pcie->ep_state == EP_STATE_DISABLED) | 
|  | return; | 
|  |  | 
|  | /* Disable LTSSM */ | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val &= ~APPL_CTRL_LTSSM_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  |  | 
|  | ret = readl_poll_timeout(pcie->appl_base + APPL_DEBUG, val, | 
|  | ((val & APPL_DEBUG_LTSSM_STATE_MASK) >> | 
|  | APPL_DEBUG_LTSSM_STATE_SHIFT) == | 
|  | LTSSM_STATE_PRE_DETECT, | 
|  | 1, LTSSM_TIMEOUT); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to go Detect state: %d\n", ret); | 
|  |  | 
|  | reset_control_assert(pcie->core_rst); | 
|  |  | 
|  | tegra_pcie_disable_phy(pcie); | 
|  |  | 
|  | reset_control_assert(pcie->core_apb_rst); | 
|  |  | 
|  | clk_disable_unprepare(pcie->core_clk); | 
|  |  | 
|  | pm_runtime_put_sync(pcie->dev); | 
|  |  | 
|  | if (pcie->enable_ext_refclk) { | 
|  | ret = tegra_pcie_bpmp_set_pll_state(pcie, false); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to turn off UPHY: %d\n", | 
|  | ret); | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_bpmp_set_pll_state(pcie, false); | 
|  | if (ret) | 
|  | dev_err(pcie->dev, "Failed to turn off UPHY: %d\n", ret); | 
|  |  | 
|  | pcie->ep_state = EP_STATE_DISABLED; | 
|  | dev_dbg(pcie->dev, "Uninitialization of endpoint is completed\n"); | 
|  | } | 
|  |  | 
|  | 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; | 
|  | int ret; | 
|  | u16 val_16; | 
|  |  | 
|  | if (pcie->ep_state == EP_STATE_ENABLED) | 
|  | return; | 
|  |  | 
|  | ret = pm_runtime_resume_and_get(dev); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to get runtime sync for PCIe dev: %d\n", | 
|  | ret); | 
|  | return; | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_bpmp_set_ctrl_state(pcie, true); | 
|  | if (ret) { | 
|  | dev_err(pcie->dev, "Failed to enable controller %u: %d\n", | 
|  | pcie->cid, ret); | 
|  | goto fail_set_ctrl_state; | 
|  | } | 
|  |  | 
|  | if (pcie->enable_ext_refclk) { | 
|  | ret = tegra_pcie_bpmp_set_pll_state(pcie, true); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to init UPHY for PCIe EP: %d\n", | 
|  | ret); | 
|  | goto fail_pll_init; | 
|  | } | 
|  | } | 
|  |  | 
|  | ret = clk_prepare_enable(pcie->core_clk); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to enable core clock: %d\n", ret); | 
|  | goto fail_core_clk_enable; | 
|  | } | 
|  |  | 
|  | ret = reset_control_deassert(pcie->core_apb_rst); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to deassert core APB reset: %d\n", ret); | 
|  | goto fail_core_apb_rst; | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_enable_phy(pcie); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to enable PHY: %d\n", ret); | 
|  | goto fail_phy; | 
|  | } | 
|  |  | 
|  | /* Clear any stale interrupt statuses */ | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_0_0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_1); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_2); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_3); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_6); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_7); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_8_0); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_9); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_10); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_11); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_13); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_14); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_15); | 
|  | appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_17); | 
|  |  | 
|  | /* configure this core for EP mode operation */ | 
|  | val = appl_readl(pcie, APPL_DM_TYPE); | 
|  | val &= ~APPL_DM_TYPE_MASK; | 
|  | val |= APPL_DM_TYPE_EP; | 
|  | appl_writel(pcie, val, APPL_DM_TYPE); | 
|  |  | 
|  | appl_writel(pcie, 0x0, APPL_CFG_SLCG_OVERRIDE); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val |= APPL_CTRL_SYS_PRE_DET_STATE; | 
|  | val |= APPL_CTRL_HW_HOT_RST_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_CFG_MISC); | 
|  | val |= APPL_CFG_MISC_SLV_EP_MODE; | 
|  | val |= (APPL_CFG_MISC_ARCACHE_VAL << APPL_CFG_MISC_ARCACHE_SHIFT); | 
|  | appl_writel(pcie, val, APPL_CFG_MISC); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_PINMUX); | 
|  | val |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN; | 
|  | val |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE; | 
|  | appl_writel(pcie, val, APPL_PINMUX); | 
|  |  | 
|  | appl_writel(pcie, pcie->dbi_res->start & APPL_CFG_BASE_ADDR_MASK, | 
|  | APPL_CFG_BASE_ADDR); | 
|  |  | 
|  | appl_writel(pcie, pcie->atu_dma_res->start & | 
|  | APPL_CFG_IATU_DMA_BASE_ADDR_MASK, | 
|  | APPL_CFG_IATU_DMA_BASE_ADDR); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L0_0); | 
|  | val |= APPL_INTR_EN_L0_0_SYS_INTR_EN; | 
|  | val |= APPL_INTR_EN_L0_0_LINK_STATE_INT_EN; | 
|  | val |= APPL_INTR_EN_L0_0_PCI_CMD_EN_INT_EN; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L0_0); | 
|  |  | 
|  | val = appl_readl(pcie, APPL_INTR_EN_L1_0_0); | 
|  | val |= APPL_INTR_EN_L1_0_0_HOT_RESET_DONE_INT_EN; | 
|  | val |= APPL_INTR_EN_L1_0_0_RDLH_LINK_UP_INT_EN; | 
|  | appl_writel(pcie, val, APPL_INTR_EN_L1_0_0); | 
|  |  | 
|  | reset_control_deassert(pcie->core_rst); | 
|  |  | 
|  | if (pcie->update_fc_fixup) { | 
|  | val = dw_pcie_readl_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF); | 
|  | val |= 0x1 << CFG_TIMER_CTRL_ACK_NAK_SHIFT; | 
|  | dw_pcie_writel_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF, val); | 
|  | } | 
|  |  | 
|  | config_gen3_gen4_eq_presets(pcie); | 
|  |  | 
|  | init_host_aspm(pcie); | 
|  |  | 
|  | /* Disable ASPM-L1SS advertisement if there is no CLKREQ routing */ | 
|  | if (!pcie->supports_clkreq) { | 
|  | disable_aspm_l11(pcie); | 
|  | disable_aspm_l12(pcie); | 
|  | } | 
|  |  | 
|  | if (!pcie->of_data->has_l1ss_exit_fix) { | 
|  | val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF); | 
|  | val &= ~GEN3_RELATED_OFF_GEN3_ZRXDC_NONCOMPL; | 
|  | dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val); | 
|  | } | 
|  |  | 
|  | pcie->pcie_cap_base = dw_pcie_find_capability(&pcie->pci, | 
|  | PCI_CAP_ID_EXP); | 
|  |  | 
|  | /* Clear Slot Clock Configuration bit if SRNS configuration */ | 
|  | if (pcie->enable_srns) { | 
|  | val_16 = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + | 
|  | PCI_EXP_LNKSTA); | 
|  | val_16 &= ~PCI_EXP_LNKSTA_SLC; | 
|  | dw_pcie_writew_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA, | 
|  | val_16); | 
|  | } | 
|  |  | 
|  | clk_set_rate(pcie->core_clk, GEN4_CORE_CLK_FREQ); | 
|  |  | 
|  | 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); | 
|  | val = (upper_32_bits(ep->msi_mem_phys) & MSIX_ADDR_MATCH_HIGH_OFF_MASK); | 
|  | dw_pcie_writel_dbi(pci, MSIX_ADDR_MATCH_HIGH_OFF, val); | 
|  |  | 
|  | ret = dw_pcie_ep_init_complete(ep); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to complete initialization: %d\n", ret); | 
|  | goto fail_init_complete; | 
|  | } | 
|  |  | 
|  | dw_pcie_ep_init_notify(ep); | 
|  |  | 
|  | /* Program the private control to allow sending LTR upstream */ | 
|  | if (pcie->of_data->has_ltr_req_fix) { | 
|  | val = appl_readl(pcie, APPL_LTR_MSG_2); | 
|  | val |= APPL_LTR_MSG_2_LTR_MSG_REQ_STATE; | 
|  | appl_writel(pcie, val, APPL_LTR_MSG_2); | 
|  | } | 
|  |  | 
|  | /* Enable LTSSM */ | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val |= APPL_CTRL_LTSSM_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  |  | 
|  | pcie->ep_state = EP_STATE_ENABLED; | 
|  | dev_dbg(dev, "Initialization of endpoint is completed\n"); | 
|  |  | 
|  | return; | 
|  |  | 
|  | fail_init_complete: | 
|  | reset_control_assert(pcie->core_rst); | 
|  | tegra_pcie_disable_phy(pcie); | 
|  | fail_phy: | 
|  | reset_control_assert(pcie->core_apb_rst); | 
|  | fail_core_apb_rst: | 
|  | clk_disable_unprepare(pcie->core_clk); | 
|  | fail_core_clk_enable: | 
|  | tegra_pcie_bpmp_set_pll_state(pcie, false); | 
|  | fail_pll_init: | 
|  | tegra_pcie_bpmp_set_ctrl_state(pcie, false); | 
|  | fail_set_ctrl_state: | 
|  | pm_runtime_put_sync(dev); | 
|  | } | 
|  |  | 
|  | static irqreturn_t tegra_pcie_ep_pex_rst_irq(int irq, void *arg) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = arg; | 
|  |  | 
|  | if (gpiod_get_value(pcie->pex_rst_gpiod)) | 
|  | pex_ep_event_pex_rst_assert(pcie); | 
|  | else | 
|  | pex_ep_event_pex_rst_deassert(pcie); | 
|  |  | 
|  | return IRQ_HANDLED; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_ep_raise_legacy_irq(struct tegra_pcie_dw *pcie, u16 irq) | 
|  | { | 
|  | /* Tegra194 supports only INTA */ | 
|  | if (irq > 1) | 
|  | return -EINVAL; | 
|  |  | 
|  | appl_writel(pcie, 1, APPL_LEGACY_INTX); | 
|  | usleep_range(1000, 2000); | 
|  | appl_writel(pcie, 0, APPL_LEGACY_INTX); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_ep_raise_msi_irq(struct tegra_pcie_dw *pcie, u16 irq) | 
|  | { | 
|  | if (unlikely(irq > 31)) | 
|  | return -EINVAL; | 
|  |  | 
|  | appl_writel(pcie, BIT(irq), APPL_MSI_CTRL_1); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_ep_raise_msix_irq(struct tegra_pcie_dw *pcie, u16 irq) | 
|  | { | 
|  | struct dw_pcie_ep *ep = &pcie->pci.ep; | 
|  |  | 
|  | writel(irq, ep->msi_mem); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_ep_raise_irq(struct dw_pcie_ep *ep, u8 func_no, | 
|  | enum pci_epc_irq_type type, | 
|  | u16 interrupt_num) | 
|  | { | 
|  | struct dw_pcie *pci = to_dw_pcie_from_ep(ep); | 
|  | struct tegra_pcie_dw *pcie = to_tegra_pcie(pci); | 
|  |  | 
|  | switch (type) { | 
|  | case PCI_EPC_IRQ_LEGACY: | 
|  | return tegra_pcie_ep_raise_legacy_irq(pcie, interrupt_num); | 
|  |  | 
|  | case PCI_EPC_IRQ_MSI: | 
|  | return tegra_pcie_ep_raise_msi_irq(pcie, interrupt_num); | 
|  |  | 
|  | case PCI_EPC_IRQ_MSIX: | 
|  | return tegra_pcie_ep_raise_msix_irq(pcie, interrupt_num); | 
|  |  | 
|  | default: | 
|  | dev_err(pci->dev, "Unknown IRQ type\n"); | 
|  | return -EPERM; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static const struct pci_epc_features tegra_pcie_epc_features = { | 
|  | .linkup_notifier = true, | 
|  | .core_init_notifier = true, | 
|  | .msi_capable = false, | 
|  | .msix_capable = false, | 
|  | .reserved_bar = 1 << BAR_2 | 1 << BAR_3 | 1 << BAR_4 | 1 << BAR_5, | 
|  | .bar_fixed_64bit = 1 << BAR_0, | 
|  | .bar_fixed_size[0] = SZ_1M, | 
|  | }; | 
|  |  | 
|  | static const struct pci_epc_features* | 
|  | tegra_pcie_ep_get_features(struct dw_pcie_ep *ep) | 
|  | { | 
|  | return &tegra_pcie_epc_features; | 
|  | } | 
|  |  | 
|  | static const struct dw_pcie_ep_ops pcie_ep_ops = { | 
|  | .raise_irq = tegra_pcie_ep_raise_irq, | 
|  | .get_features = tegra_pcie_ep_get_features, | 
|  | }; | 
|  |  | 
|  | static int tegra_pcie_config_ep(struct tegra_pcie_dw *pcie, | 
|  | struct platform_device *pdev) | 
|  | { | 
|  | struct dw_pcie *pci = &pcie->pci; | 
|  | struct device *dev = pcie->dev; | 
|  | struct dw_pcie_ep *ep; | 
|  | char *name; | 
|  | int ret; | 
|  |  | 
|  | ep = &pci->ep; | 
|  | ep->ops = &pcie_ep_ops; | 
|  |  | 
|  | ep->page_size = SZ_64K; | 
|  |  | 
|  | ret = gpiod_set_debounce(pcie->pex_rst_gpiod, PERST_DEBOUNCE_TIME); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to set PERST GPIO debounce time: %d\n", | 
|  | ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | ret = gpiod_to_irq(pcie->pex_rst_gpiod); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to get IRQ for PERST GPIO: %d\n", ret); | 
|  | return ret; | 
|  | } | 
|  | pcie->pex_rst_irq = (unsigned int)ret; | 
|  |  | 
|  | name = devm_kasprintf(dev, GFP_KERNEL, "tegra_pcie_%u_pex_rst_irq", | 
|  | pcie->cid); | 
|  | if (!name) { | 
|  | dev_err(dev, "Failed to create PERST IRQ string\n"); | 
|  | return -ENOMEM; | 
|  | } | 
|  |  | 
|  | irq_set_status_flags(pcie->pex_rst_irq, IRQ_NOAUTOEN); | 
|  |  | 
|  | pcie->ep_state = EP_STATE_DISABLED; | 
|  |  | 
|  | ret = devm_request_threaded_irq(dev, pcie->pex_rst_irq, NULL, | 
|  | tegra_pcie_ep_pex_rst_irq, | 
|  | IRQF_TRIGGER_RISING | | 
|  | IRQF_TRIGGER_FALLING | IRQF_ONESHOT, | 
|  | name, (void *)pcie); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to request IRQ for PERST: %d\n", ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | pm_runtime_enable(dev); | 
|  |  | 
|  | ret = dw_pcie_ep_init(ep); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to initialize DWC Endpoint subsystem: %d\n", | 
|  | ret); | 
|  | pm_runtime_disable(dev); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_probe(struct platform_device *pdev) | 
|  | { | 
|  | const struct tegra_pcie_dw_of_data *data; | 
|  | struct device *dev = &pdev->dev; | 
|  | struct resource *atu_dma_res; | 
|  | struct tegra_pcie_dw *pcie; | 
|  | struct dw_pcie_rp *pp; | 
|  | struct dw_pcie *pci; | 
|  | struct phy **phys; | 
|  | char *name; | 
|  | int ret; | 
|  | u32 i; | 
|  |  | 
|  | data = of_device_get_match_data(dev); | 
|  |  | 
|  | pcie = devm_kzalloc(dev, sizeof(*pcie), GFP_KERNEL); | 
|  | if (!pcie) | 
|  | return -ENOMEM; | 
|  |  | 
|  | pci = &pcie->pci; | 
|  | pci->dev = &pdev->dev; | 
|  | pci->ops = &tegra_dw_pcie_ops; | 
|  | pcie->dev = &pdev->dev; | 
|  | pcie->of_data = (struct tegra_pcie_dw_of_data *)data; | 
|  | pci->n_fts[0] = pcie->of_data->n_fts[0]; | 
|  | pci->n_fts[1] = pcie->of_data->n_fts[1]; | 
|  | pp = &pci->pp; | 
|  | pp->num_vectors = MAX_MSI_IRQS; | 
|  |  | 
|  | ret = tegra_pcie_dw_parse_dt(pcie); | 
|  | if (ret < 0) { | 
|  | const char *level = KERN_ERR; | 
|  |  | 
|  | if (ret == -EPROBE_DEFER) | 
|  | level = KERN_DEBUG; | 
|  |  | 
|  | dev_printk(level, dev, | 
|  | dev_fmt("Failed to parse device tree: %d\n"), | 
|  | ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_get_slot_regulators(pcie); | 
|  | if (ret < 0) { | 
|  | const char *level = KERN_ERR; | 
|  |  | 
|  | if (ret == -EPROBE_DEFER) | 
|  | level = KERN_DEBUG; | 
|  |  | 
|  | dev_printk(level, dev, | 
|  | dev_fmt("Failed to get slot regulators: %d\n"), | 
|  | ret); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | if (pcie->pex_refclk_sel_gpiod) | 
|  | gpiod_set_value(pcie->pex_refclk_sel_gpiod, 1); | 
|  |  | 
|  | pcie->pex_ctl_supply = devm_regulator_get(dev, "vddio-pex-ctl"); | 
|  | if (IS_ERR(pcie->pex_ctl_supply)) { | 
|  | ret = PTR_ERR(pcie->pex_ctl_supply); | 
|  | if (ret != -EPROBE_DEFER) | 
|  | dev_err(dev, "Failed to get regulator: %ld\n", | 
|  | PTR_ERR(pcie->pex_ctl_supply)); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | pcie->core_clk = devm_clk_get(dev, "core"); | 
|  | if (IS_ERR(pcie->core_clk)) { | 
|  | dev_err(dev, "Failed to get core clock: %ld\n", | 
|  | PTR_ERR(pcie->core_clk)); | 
|  | return PTR_ERR(pcie->core_clk); | 
|  | } | 
|  |  | 
|  | pcie->appl_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, | 
|  | "appl"); | 
|  | if (!pcie->appl_res) { | 
|  | dev_err(dev, "Failed to find \"appl\" region\n"); | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | pcie->appl_base = devm_ioremap_resource(dev, pcie->appl_res); | 
|  | if (IS_ERR(pcie->appl_base)) | 
|  | return PTR_ERR(pcie->appl_base); | 
|  |  | 
|  | pcie->core_apb_rst = devm_reset_control_get(dev, "apb"); | 
|  | if (IS_ERR(pcie->core_apb_rst)) { | 
|  | dev_err(dev, "Failed to get APB reset: %ld\n", | 
|  | PTR_ERR(pcie->core_apb_rst)); | 
|  | return PTR_ERR(pcie->core_apb_rst); | 
|  | } | 
|  |  | 
|  | phys = devm_kcalloc(dev, pcie->phy_count, sizeof(*phys), GFP_KERNEL); | 
|  | if (!phys) | 
|  | return -ENOMEM; | 
|  |  | 
|  | for (i = 0; i < pcie->phy_count; i++) { | 
|  | name = kasprintf(GFP_KERNEL, "p2u-%u", i); | 
|  | if (!name) { | 
|  | dev_err(dev, "Failed to create P2U string\n"); | 
|  | return -ENOMEM; | 
|  | } | 
|  | phys[i] = devm_phy_get(dev, name); | 
|  | kfree(name); | 
|  | if (IS_ERR(phys[i])) { | 
|  | ret = PTR_ERR(phys[i]); | 
|  | if (ret != -EPROBE_DEFER) | 
|  | dev_err(dev, "Failed to get PHY: %d\n", ret); | 
|  | return ret; | 
|  | } | 
|  | } | 
|  |  | 
|  | pcie->phys = phys; | 
|  |  | 
|  | atu_dma_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, | 
|  | "atu_dma"); | 
|  | if (!atu_dma_res) { | 
|  | dev_err(dev, "Failed to find \"atu_dma\" region\n"); | 
|  | return -ENODEV; | 
|  | } | 
|  | pcie->atu_dma_res = atu_dma_res; | 
|  |  | 
|  | pci->atu_size = resource_size(atu_dma_res); | 
|  | pci->atu_base = devm_ioremap_resource(dev, atu_dma_res); | 
|  | if (IS_ERR(pci->atu_base)) | 
|  | return PTR_ERR(pci->atu_base); | 
|  |  | 
|  | pcie->core_rst = devm_reset_control_get(dev, "core"); | 
|  | if (IS_ERR(pcie->core_rst)) { | 
|  | dev_err(dev, "Failed to get core reset: %ld\n", | 
|  | PTR_ERR(pcie->core_rst)); | 
|  | return PTR_ERR(pcie->core_rst); | 
|  | } | 
|  |  | 
|  | pp->irq = platform_get_irq_byname(pdev, "intr"); | 
|  | if (pp->irq < 0) | 
|  | return pp->irq; | 
|  |  | 
|  | pcie->bpmp = tegra_bpmp_get(dev); | 
|  | if (IS_ERR(pcie->bpmp)) | 
|  | return PTR_ERR(pcie->bpmp); | 
|  |  | 
|  | platform_set_drvdata(pdev, pcie); | 
|  |  | 
|  | pcie->icc_path = devm_of_icc_get(&pdev->dev, "write"); | 
|  | ret = PTR_ERR_OR_ZERO(pcie->icc_path); | 
|  | if (ret) { | 
|  | tegra_bpmp_put(pcie->bpmp); | 
|  | dev_err_probe(&pdev->dev, ret, "failed to get write interconnect\n"); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | switch (pcie->of_data->mode) { | 
|  | case DW_PCIE_RC_TYPE: | 
|  | ret = devm_request_irq(dev, pp->irq, tegra_pcie_rp_irq_handler, | 
|  | IRQF_SHARED, "tegra-pcie-intr", pcie); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to request IRQ %d: %d\n", pp->irq, | 
|  | ret); | 
|  | goto fail; | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_config_rp(pcie); | 
|  | if (ret && ret != -ENOMEDIUM) | 
|  | goto fail; | 
|  | else | 
|  | return 0; | 
|  | break; | 
|  |  | 
|  | case DW_PCIE_EP_TYPE: | 
|  | ret = devm_request_threaded_irq(dev, pp->irq, | 
|  | tegra_pcie_ep_hard_irq, | 
|  | tegra_pcie_ep_irq_thread, | 
|  | IRQF_SHARED | IRQF_ONESHOT, | 
|  | "tegra-pcie-ep-intr", pcie); | 
|  | if (ret) { | 
|  | dev_err(dev, "Failed to request IRQ %d: %d\n", pp->irq, | 
|  | ret); | 
|  | goto fail; | 
|  | } | 
|  |  | 
|  | ret = tegra_pcie_config_ep(pcie, pdev); | 
|  | if (ret < 0) | 
|  | goto fail; | 
|  | else | 
|  | return 0; | 
|  | break; | 
|  |  | 
|  | default: | 
|  | dev_err(dev, "Invalid PCIe device type %d\n", | 
|  | pcie->of_data->mode); | 
|  | ret = -EINVAL; | 
|  | } | 
|  |  | 
|  | fail: | 
|  | tegra_bpmp_put(pcie->bpmp); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_dw_remove(struct platform_device *pdev) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = platform_get_drvdata(pdev); | 
|  |  | 
|  | if (pcie->of_data->mode == DW_PCIE_RC_TYPE) { | 
|  | if (!pcie->link_state) | 
|  | return; | 
|  |  | 
|  | debugfs_remove_recursive(pcie->debugfs); | 
|  | tegra_pcie_deinit_controller(pcie); | 
|  | pm_runtime_put_sync(pcie->dev); | 
|  | } else { | 
|  | disable_irq(pcie->pex_rst_irq); | 
|  | pex_ep_event_pex_rst_assert(pcie); | 
|  | } | 
|  |  | 
|  | pm_runtime_disable(pcie->dev); | 
|  | tegra_bpmp_put(pcie->bpmp); | 
|  | if (pcie->pex_refclk_sel_gpiod) | 
|  | gpiod_set_value(pcie->pex_refclk_sel_gpiod, 0); | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_suspend_late(struct device *dev) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = dev_get_drvdata(dev); | 
|  | u32 val; | 
|  |  | 
|  | if (pcie->of_data->mode == DW_PCIE_EP_TYPE) { | 
|  | dev_err(dev, "Failed to Suspend as Tegra PCIe is in EP mode\n"); | 
|  | return -EPERM; | 
|  | } | 
|  |  | 
|  | if (!pcie->link_state) | 
|  | return 0; | 
|  |  | 
|  | /* Enable HW_HOT_RST mode */ | 
|  | if (!pcie->of_data->has_sbr_reset_fix) { | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK << | 
|  | APPL_CTRL_HW_HOT_RST_MODE_SHIFT); | 
|  | val |= APPL_CTRL_HW_HOT_RST_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_suspend_noirq(struct device *dev) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = dev_get_drvdata(dev); | 
|  |  | 
|  | if (!pcie->link_state) | 
|  | return 0; | 
|  |  | 
|  | tegra_pcie_downstream_dev_to_D0(pcie); | 
|  | tegra_pcie_dw_pme_turnoff(pcie); | 
|  | tegra_pcie_unconfig_controller(pcie); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_resume_noirq(struct device *dev) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = dev_get_drvdata(dev); | 
|  | int ret; | 
|  |  | 
|  | if (!pcie->link_state) | 
|  | return 0; | 
|  |  | 
|  | ret = tegra_pcie_config_controller(pcie, true); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | ret = tegra_pcie_dw_host_init(&pcie->pci.pp); | 
|  | if (ret < 0) { | 
|  | dev_err(dev, "Failed to init host: %d\n", ret); | 
|  | goto fail_host_init; | 
|  | } | 
|  |  | 
|  | dw_pcie_setup_rc(&pcie->pci.pp); | 
|  |  | 
|  | ret = tegra_pcie_dw_start_link(&pcie->pci); | 
|  | if (ret < 0) | 
|  | goto fail_host_init; | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | fail_host_init: | 
|  | tegra_pcie_unconfig_controller(pcie); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int tegra_pcie_dw_resume_early(struct device *dev) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = dev_get_drvdata(dev); | 
|  | u32 val; | 
|  |  | 
|  | if (pcie->of_data->mode == DW_PCIE_EP_TYPE) { | 
|  | dev_err(dev, "Suspend is not supported in EP mode"); | 
|  | return -ENOTSUPP; | 
|  | } | 
|  |  | 
|  | if (!pcie->link_state) | 
|  | return 0; | 
|  |  | 
|  | /* Disable HW_HOT_RST mode */ | 
|  | if (!pcie->of_data->has_sbr_reset_fix) { | 
|  | val = appl_readl(pcie, APPL_CTRL); | 
|  | val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK << | 
|  | APPL_CTRL_HW_HOT_RST_MODE_SHIFT); | 
|  | val |= APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST << | 
|  | APPL_CTRL_HW_HOT_RST_MODE_SHIFT; | 
|  | val &= ~APPL_CTRL_HW_HOT_RST_EN; | 
|  | appl_writel(pcie, val, APPL_CTRL); | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static void tegra_pcie_dw_shutdown(struct platform_device *pdev) | 
|  | { | 
|  | struct tegra_pcie_dw *pcie = platform_get_drvdata(pdev); | 
|  |  | 
|  | if (pcie->of_data->mode == DW_PCIE_RC_TYPE) { | 
|  | if (!pcie->link_state) | 
|  | return; | 
|  |  | 
|  | debugfs_remove_recursive(pcie->debugfs); | 
|  | tegra_pcie_downstream_dev_to_D0(pcie); | 
|  |  | 
|  | disable_irq(pcie->pci.pp.irq); | 
|  | if (IS_ENABLED(CONFIG_PCI_MSI)) | 
|  | disable_irq(pcie->pci.pp.msi_irq[0]); | 
|  |  | 
|  | tegra_pcie_dw_pme_turnoff(pcie); | 
|  | tegra_pcie_unconfig_controller(pcie); | 
|  | pm_runtime_put_sync(pcie->dev); | 
|  | } else { | 
|  | disable_irq(pcie->pex_rst_irq); | 
|  | pex_ep_event_pex_rst_assert(pcie); | 
|  | } | 
|  | } | 
|  |  | 
|  | static const struct tegra_pcie_dw_of_data tegra194_pcie_dw_rc_of_data = { | 
|  | .version = TEGRA194_DWC_IP_VER, | 
|  | .mode = DW_PCIE_RC_TYPE, | 
|  | .cdm_chk_int_en_bit = BIT(19), | 
|  | /* Gen4 - 5, 6, 8 and 9 presets enabled */ | 
|  | .gen4_preset_vec = 0x360, | 
|  | .n_fts = { 52, 52 }, | 
|  | }; | 
|  |  | 
|  | static const struct tegra_pcie_dw_of_data tegra194_pcie_dw_ep_of_data = { | 
|  | .version = TEGRA194_DWC_IP_VER, | 
|  | .mode = DW_PCIE_EP_TYPE, | 
|  | .cdm_chk_int_en_bit = BIT(19), | 
|  | /* Gen4 - 5, 6, 8 and 9 presets enabled */ | 
|  | .gen4_preset_vec = 0x360, | 
|  | .n_fts = { 52, 52 }, | 
|  | }; | 
|  |  | 
|  | static const struct tegra_pcie_dw_of_data tegra234_pcie_dw_rc_of_data = { | 
|  | .version = TEGRA234_DWC_IP_VER, | 
|  | .mode = DW_PCIE_RC_TYPE, | 
|  | .has_msix_doorbell_access_fix = true, | 
|  | .has_sbr_reset_fix = true, | 
|  | .has_l1ss_exit_fix = true, | 
|  | .cdm_chk_int_en_bit = BIT(18), | 
|  | /* Gen4 - 6, 8 and 9 presets enabled */ | 
|  | .gen4_preset_vec = 0x340, | 
|  | .n_fts = { 52, 80 }, | 
|  | }; | 
|  |  | 
|  | static const struct tegra_pcie_dw_of_data tegra234_pcie_dw_ep_of_data = { | 
|  | .version = TEGRA234_DWC_IP_VER, | 
|  | .mode = DW_PCIE_EP_TYPE, | 
|  | .has_l1ss_exit_fix = true, | 
|  | .has_ltr_req_fix = true, | 
|  | .cdm_chk_int_en_bit = BIT(18), | 
|  | /* Gen4 - 6, 8 and 9 presets enabled */ | 
|  | .gen4_preset_vec = 0x340, | 
|  | .n_fts = { 52, 80 }, | 
|  | }; | 
|  |  | 
|  | static const struct of_device_id tegra_pcie_dw_of_match[] = { | 
|  | { | 
|  | .compatible = "nvidia,tegra194-pcie", | 
|  | .data = &tegra194_pcie_dw_rc_of_data, | 
|  | }, | 
|  | { | 
|  | .compatible = "nvidia,tegra194-pcie-ep", | 
|  | .data = &tegra194_pcie_dw_ep_of_data, | 
|  | }, | 
|  | { | 
|  | .compatible = "nvidia,tegra234-pcie", | 
|  | .data = &tegra234_pcie_dw_rc_of_data, | 
|  | }, | 
|  | { | 
|  | .compatible = "nvidia,tegra234-pcie-ep", | 
|  | .data = &tegra234_pcie_dw_ep_of_data, | 
|  | }, | 
|  | {} | 
|  | }; | 
|  |  | 
|  | static const struct dev_pm_ops tegra_pcie_dw_pm_ops = { | 
|  | .suspend_late = tegra_pcie_dw_suspend_late, | 
|  | .suspend_noirq = tegra_pcie_dw_suspend_noirq, | 
|  | .resume_noirq = tegra_pcie_dw_resume_noirq, | 
|  | .resume_early = tegra_pcie_dw_resume_early, | 
|  | }; | 
|  |  | 
|  | static struct platform_driver tegra_pcie_dw_driver = { | 
|  | .probe = tegra_pcie_dw_probe, | 
|  | .remove_new = tegra_pcie_dw_remove, | 
|  | .shutdown = tegra_pcie_dw_shutdown, | 
|  | .driver = { | 
|  | .name	= "tegra194-pcie", | 
|  | .pm = &tegra_pcie_dw_pm_ops, | 
|  | .of_match_table = tegra_pcie_dw_of_match, | 
|  | }, | 
|  | }; | 
|  | module_platform_driver(tegra_pcie_dw_driver); | 
|  |  | 
|  | MODULE_DEVICE_TABLE(of, tegra_pcie_dw_of_match); | 
|  |  | 
|  | MODULE_AUTHOR("Vidya Sagar <vidyas@nvidia.com>"); | 
|  | MODULE_DESCRIPTION("NVIDIA PCIe host controller driver"); | 
|  | MODULE_LICENSE("GPL v2"); |