Linux Audio

Check our new training course

Loading...
v6.8
   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * PCIe host controller driver for the following SoCs
   4 * Tegra194
   5 * Tegra234
   6 *
   7 * Copyright (C) 2019-2022 NVIDIA Corporation.
   8 *
   9 * Author: Vidya Sagar <vidyas@nvidia.com>
  10 */
  11
  12#include <linux/bitfield.h>
  13#include <linux/clk.h>
  14#include <linux/debugfs.h>
  15#include <linux/delay.h>
  16#include <linux/gpio.h>
  17#include <linux/gpio/consumer.h>
  18#include <linux/interconnect.h>
  19#include <linux/interrupt.h>
  20#include <linux/iopoll.h>
  21#include <linux/kernel.h>
  22#include <linux/module.h>
  23#include <linux/of.h>
 
  24#include <linux/of_gpio.h>
 
  25#include <linux/of_pci.h>
  26#include <linux/pci.h>
  27#include <linux/phy/phy.h>
  28#include <linux/pinctrl/consumer.h>
  29#include <linux/platform_device.h>
  30#include <linux/pm_runtime.h>
  31#include <linux/random.h>
  32#include <linux/reset.h>
  33#include <linux/resource.h>
  34#include <linux/types.h>
  35#include "pcie-designware.h"
  36#include <soc/tegra/bpmp.h>
  37#include <soc/tegra/bpmp-abi.h>
  38#include "../../pci.h"
  39
  40#define TEGRA194_DWC_IP_VER			0x490A
  41#define TEGRA234_DWC_IP_VER			0x562A
  42
  43#define APPL_PINMUX				0x0
  44#define APPL_PINMUX_PEX_RST			BIT(0)
  45#define APPL_PINMUX_CLKREQ_OVERRIDE_EN		BIT(2)
  46#define APPL_PINMUX_CLKREQ_OVERRIDE		BIT(3)
  47#define APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN	BIT(4)
  48#define APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE	BIT(5)
 
 
  49
  50#define APPL_CTRL				0x4
  51#define APPL_CTRL_SYS_PRE_DET_STATE		BIT(6)
  52#define APPL_CTRL_LTSSM_EN			BIT(7)
  53#define APPL_CTRL_HW_HOT_RST_EN			BIT(20)
  54#define APPL_CTRL_HW_HOT_RST_MODE_MASK		GENMASK(1, 0)
  55#define APPL_CTRL_HW_HOT_RST_MODE_SHIFT		22
  56#define APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST	0x1
  57#define APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST_LTSSM_EN	0x2
  58
  59#define APPL_INTR_EN_L0_0			0x8
  60#define APPL_INTR_EN_L0_0_LINK_STATE_INT_EN	BIT(0)
  61#define APPL_INTR_EN_L0_0_MSI_RCV_INT_EN	BIT(4)
  62#define APPL_INTR_EN_L0_0_INT_INT_EN		BIT(8)
  63#define APPL_INTR_EN_L0_0_PCI_CMD_EN_INT_EN	BIT(15)
  64#define APPL_INTR_EN_L0_0_CDM_REG_CHK_INT_EN	BIT(19)
  65#define APPL_INTR_EN_L0_0_SYS_INTR_EN		BIT(30)
  66#define APPL_INTR_EN_L0_0_SYS_MSI_INTR_EN	BIT(31)
  67
  68#define APPL_INTR_STATUS_L0			0xC
  69#define APPL_INTR_STATUS_L0_LINK_STATE_INT	BIT(0)
  70#define APPL_INTR_STATUS_L0_INT_INT		BIT(8)
  71#define APPL_INTR_STATUS_L0_PCI_CMD_EN_INT	BIT(15)
  72#define APPL_INTR_STATUS_L0_PEX_RST_INT		BIT(16)
  73#define APPL_INTR_STATUS_L0_CDM_REG_CHK_INT	BIT(18)
  74
  75#define APPL_INTR_EN_L1_0_0				0x1C
  76#define APPL_INTR_EN_L1_0_0_LINK_REQ_RST_NOT_INT_EN	BIT(1)
  77#define APPL_INTR_EN_L1_0_0_RDLH_LINK_UP_INT_EN		BIT(3)
  78#define APPL_INTR_EN_L1_0_0_HOT_RESET_DONE_INT_EN	BIT(30)
  79
  80#define APPL_INTR_STATUS_L1_0_0				0x20
  81#define APPL_INTR_STATUS_L1_0_0_LINK_REQ_RST_NOT_CHGED	BIT(1)
  82#define APPL_INTR_STATUS_L1_0_0_RDLH_LINK_UP_CHGED	BIT(3)
  83#define APPL_INTR_STATUS_L1_0_0_HOT_RESET_DONE		BIT(30)
  84
  85#define APPL_INTR_STATUS_L1_1			0x2C
  86#define APPL_INTR_STATUS_L1_2			0x30
  87#define APPL_INTR_STATUS_L1_3			0x34
  88#define APPL_INTR_STATUS_L1_6			0x3C
  89#define APPL_INTR_STATUS_L1_7			0x40
  90#define APPL_INTR_STATUS_L1_15_CFG_BME_CHGED	BIT(1)
  91
  92#define APPL_INTR_EN_L1_8_0			0x44
  93#define APPL_INTR_EN_L1_8_BW_MGT_INT_EN		BIT(2)
  94#define APPL_INTR_EN_L1_8_AUTO_BW_INT_EN	BIT(3)
  95#define APPL_INTR_EN_L1_8_INTX_EN		BIT(11)
  96#define APPL_INTR_EN_L1_8_AER_INT_EN		BIT(15)
  97
  98#define APPL_INTR_STATUS_L1_8_0			0x4C
  99#define APPL_INTR_STATUS_L1_8_0_EDMA_INT_MASK	GENMASK(11, 6)
 100#define APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS	BIT(2)
 101#define APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS	BIT(3)
 102
 103#define APPL_INTR_STATUS_L1_9			0x54
 104#define APPL_INTR_STATUS_L1_10			0x58
 105#define APPL_INTR_STATUS_L1_11			0x64
 106#define APPL_INTR_STATUS_L1_13			0x74
 107#define APPL_INTR_STATUS_L1_14			0x78
 108#define APPL_INTR_STATUS_L1_15			0x7C
 109#define APPL_INTR_STATUS_L1_17			0x88
 110
 111#define APPL_INTR_EN_L1_18				0x90
 112#define APPL_INTR_EN_L1_18_CDM_REG_CHK_CMPLT		BIT(2)
 113#define APPL_INTR_EN_L1_18_CDM_REG_CHK_CMP_ERR		BIT(1)
 114#define APPL_INTR_EN_L1_18_CDM_REG_CHK_LOGIC_ERR	BIT(0)
 115
 116#define APPL_INTR_STATUS_L1_18				0x94
 117#define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMPLT	BIT(2)
 118#define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMP_ERR	BIT(1)
 119#define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_LOGIC_ERR	BIT(0)
 120
 121#define APPL_MSI_CTRL_1				0xAC
 122
 123#define APPL_MSI_CTRL_2				0xB0
 124
 125#define APPL_LEGACY_INTX			0xB8
 126
 127#define APPL_LTR_MSG_1				0xC4
 128#define LTR_MSG_REQ				BIT(15)
 129#define LTR_NOSNOOP_MSG_REQ			BIT(31)
 130
 131#define APPL_LTR_MSG_2				0xC8
 132#define APPL_LTR_MSG_2_LTR_MSG_REQ_STATE	BIT(3)
 133
 134#define APPL_LINK_STATUS			0xCC
 135#define APPL_LINK_STATUS_RDLH_LINK_UP		BIT(0)
 136
 137#define APPL_DEBUG				0xD0
 138#define APPL_DEBUG_PM_LINKST_IN_L2_LAT		BIT(21)
 139#define APPL_DEBUG_PM_LINKST_IN_L0		0x11
 140#define APPL_DEBUG_LTSSM_STATE_MASK		GENMASK(8, 3)
 141#define APPL_DEBUG_LTSSM_STATE_SHIFT		3
 142#define LTSSM_STATE_PRE_DETECT			5
 143
 144#define APPL_RADM_STATUS			0xE4
 145#define APPL_PM_XMT_TURNOFF_STATE		BIT(0)
 146
 147#define APPL_DM_TYPE				0x100
 148#define APPL_DM_TYPE_MASK			GENMASK(3, 0)
 149#define APPL_DM_TYPE_RP				0x4
 150#define APPL_DM_TYPE_EP				0x0
 151
 152#define APPL_CFG_BASE_ADDR			0x104
 153#define APPL_CFG_BASE_ADDR_MASK			GENMASK(31, 12)
 154
 155#define APPL_CFG_IATU_DMA_BASE_ADDR		0x108
 156#define APPL_CFG_IATU_DMA_BASE_ADDR_MASK	GENMASK(31, 18)
 157
 158#define APPL_CFG_MISC				0x110
 159#define APPL_CFG_MISC_SLV_EP_MODE		BIT(14)
 160#define APPL_CFG_MISC_ARCACHE_MASK		GENMASK(13, 10)
 161#define APPL_CFG_MISC_ARCACHE_SHIFT		10
 162#define APPL_CFG_MISC_ARCACHE_VAL		3
 163
 164#define APPL_CFG_SLCG_OVERRIDE			0x114
 165#define APPL_CFG_SLCG_OVERRIDE_SLCG_EN_MASTER	BIT(0)
 166
 167#define APPL_CAR_RESET_OVRD				0x12C
 168#define APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N	BIT(0)
 169
 170#define IO_BASE_IO_DECODE				BIT(0)
 171#define IO_BASE_IO_DECODE_BIT8				BIT(8)
 172
 173#define CFG_PREF_MEM_LIMIT_BASE_MEM_DECODE		BIT(0)
 174#define CFG_PREF_MEM_LIMIT_BASE_MEM_LIMIT_DECODE	BIT(16)
 175
 176#define CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF	0x718
 177#define CFG_TIMER_CTRL_ACK_NAK_SHIFT	(19)
 178
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 179#define N_FTS_VAL					52
 
 
 
 
 180#define FTS_VAL						52
 181
 
 
 182#define GEN3_EQ_CONTROL_OFF			0x8a8
 183#define GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT	8
 184#define GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK	GENMASK(23, 8)
 185#define GEN3_EQ_CONTROL_OFF_FB_MODE_MASK	GENMASK(3, 0)
 186
 
 
 
 
 
 
 187#define PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT	0x8D0
 188#define AMBA_ERROR_RESPONSE_CRS_SHIFT		3
 189#define AMBA_ERROR_RESPONSE_CRS_MASK		GENMASK(1, 0)
 190#define AMBA_ERROR_RESPONSE_CRS_OKAY		0
 191#define AMBA_ERROR_RESPONSE_CRS_OKAY_FFFFFFFF	1
 192#define AMBA_ERROR_RESPONSE_CRS_OKAY_FFFF0001	2
 193
 194#define MSIX_ADDR_MATCH_LOW_OFF			0x940
 195#define MSIX_ADDR_MATCH_LOW_OFF_EN		BIT(0)
 196#define MSIX_ADDR_MATCH_LOW_OFF_MASK		GENMASK(31, 2)
 197
 198#define MSIX_ADDR_MATCH_HIGH_OFF		0x944
 199#define MSIX_ADDR_MATCH_HIGH_OFF_MASK		GENMASK(31, 0)
 200
 201#define PORT_LOGIC_MSIX_DOORBELL			0x948
 202
 203#define CAP_SPCIE_CAP_OFF			0x154
 204#define CAP_SPCIE_CAP_OFF_DSP_TX_PRESET0_MASK	GENMASK(3, 0)
 205#define CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_MASK	GENMASK(11, 8)
 206#define CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_SHIFT	8
 207
 208#define PME_ACK_TIMEOUT 10000
 209
 210#define LTSSM_TIMEOUT 50000	/* 50ms */
 211
 212#define GEN3_GEN4_EQ_PRESET_INIT	5
 213
 214#define GEN1_CORE_CLK_FREQ	62500000
 215#define GEN2_CORE_CLK_FREQ	125000000
 216#define GEN3_CORE_CLK_FREQ	250000000
 217#define GEN4_CORE_CLK_FREQ	500000000
 218
 219#define LTR_MSG_TIMEOUT		(100 * 1000)
 220
 221#define PERST_DEBOUNCE_TIME	(5 * 1000)
 222
 223#define EP_STATE_DISABLED	0
 224#define EP_STATE_ENABLED	1
 225
 226static const unsigned int pcie_gen_freq[] = {
 227	GEN1_CORE_CLK_FREQ,	/* PCI_EXP_LNKSTA_CLS == 0; undefined */
 228	GEN1_CORE_CLK_FREQ,
 229	GEN2_CORE_CLK_FREQ,
 230	GEN3_CORE_CLK_FREQ,
 231	GEN4_CORE_CLK_FREQ
 232};
 233
 234struct tegra_pcie_dw_of_data {
 235	u32 version;
 236	enum dw_pcie_device_mode mode;
 237	bool has_msix_doorbell_access_fix;
 238	bool has_sbr_reset_fix;
 239	bool has_l1ss_exit_fix;
 240	bool has_ltr_req_fix;
 241	u32 cdm_chk_int_en_bit;
 242	u32 gen4_preset_vec;
 243	u8 n_fts[2];
 
 
 
 
 
 
 244};
 245
 246struct tegra_pcie_dw {
 247	struct device *dev;
 248	struct resource *appl_res;
 249	struct resource *dbi_res;
 250	struct resource *atu_dma_res;
 251	void __iomem *appl_base;
 252	struct clk *core_clk;
 253	struct reset_control *core_apb_rst;
 254	struct reset_control *core_rst;
 255	struct dw_pcie pci;
 256	struct tegra_bpmp *bpmp;
 257
 258	struct tegra_pcie_dw_of_data *of_data;
 259
 260	bool supports_clkreq;
 261	bool enable_cdm_check;
 262	bool enable_srns;
 263	bool link_state;
 264	bool update_fc_fixup;
 265	bool enable_ext_refclk;
 266	u8 init_link_width;
 267	u32 msi_ctrl_int;
 268	u32 num_lanes;
 
 269	u32 cid;
 270	u32 cfg_link_cap_l1sub;
 271	u32 ras_des_cap;
 272	u32 pcie_cap_base;
 273	u32 aspm_cmrt;
 274	u32 aspm_pwr_on_t;
 275	u32 aspm_l0s_enter_lat;
 276
 277	struct regulator *pex_ctl_supply;
 278	struct regulator *slot_ctl_3v3;
 279	struct regulator *slot_ctl_12v;
 280
 281	unsigned int phy_count;
 282	struct phy **phys;
 283
 284	struct dentry *debugfs;
 285
 286	/* Endpoint mode specific */
 287	struct gpio_desc *pex_rst_gpiod;
 288	struct gpio_desc *pex_refclk_sel_gpiod;
 289	unsigned int pex_rst_irq;
 290	int ep_state;
 291	long link_status;
 292	struct icc_path *icc_path;
 293};
 294
 295static inline struct tegra_pcie_dw *to_tegra_pcie(struct dw_pcie *pci)
 296{
 297	return container_of(pci, struct tegra_pcie_dw, pci);
 298}
 299
 300static inline void appl_writel(struct tegra_pcie_dw *pcie, const u32 value,
 301			       const u32 reg)
 302{
 303	writel_relaxed(value, pcie->appl_base + reg);
 304}
 305
 306static inline u32 appl_readl(struct tegra_pcie_dw *pcie, const u32 reg)
 307{
 308	return readl_relaxed(pcie->appl_base + reg);
 309}
 310
 311struct tegra_pcie_soc {
 312	enum dw_pcie_device_mode mode;
 313};
 314
 315static void tegra_pcie_icc_set(struct tegra_pcie_dw *pcie)
 316{
 317	struct dw_pcie *pci = &pcie->pci;
 318	u32 val, speed, width;
 319
 320	val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA);
 321
 322	speed = FIELD_GET(PCI_EXP_LNKSTA_CLS, val);
 323	width = FIELD_GET(PCI_EXP_LNKSTA_NLW, val);
 324
 325	val = width * PCIE_SPEED2MBS_ENC(pcie_link_speed[speed]);
 326
 327	if (icc_set_bw(pcie->icc_path, Mbps_to_icc(val), 0))
 328		dev_err(pcie->dev, "can't set bw[%u]\n", val);
 329
 330	if (speed >= ARRAY_SIZE(pcie_gen_freq))
 331		speed = 0;
 332
 333	clk_set_rate(pcie->core_clk, pcie_gen_freq[speed]);
 334}
 335
 336static void apply_bad_link_workaround(struct dw_pcie_rp *pp)
 337{
 338	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 339	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 340	u32 current_link_width;
 341	u16 val;
 342
 343	/*
 344	 * NOTE:- Since this scenario is uncommon and link as such is not
 345	 * stable anyway, not waiting to confirm if link is really
 346	 * transitioning to Gen-2 speed
 347	 */
 348	val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA);
 349	if (val & PCI_EXP_LNKSTA_LBMS) {
 350		current_link_width = FIELD_GET(PCI_EXP_LNKSTA_NLW, val);
 
 351		if (pcie->init_link_width > current_link_width) {
 352			dev_warn(pci->dev, "PCIe link is bad, width reduced\n");
 353			val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 354						PCI_EXP_LNKCTL2);
 355			val &= ~PCI_EXP_LNKCTL2_TLS;
 356			val |= PCI_EXP_LNKCTL2_TLS_2_5GT;
 357			dw_pcie_writew_dbi(pci, pcie->pcie_cap_base +
 358					   PCI_EXP_LNKCTL2, val);
 359
 360			val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 361						PCI_EXP_LNKCTL);
 362			val |= PCI_EXP_LNKCTL_RL;
 363			dw_pcie_writew_dbi(pci, pcie->pcie_cap_base +
 364					   PCI_EXP_LNKCTL, val);
 365		}
 366	}
 367}
 368
 369static irqreturn_t tegra_pcie_rp_irq_handler(int irq, void *arg)
 370{
 371	struct tegra_pcie_dw *pcie = arg;
 372	struct dw_pcie *pci = &pcie->pci;
 373	struct dw_pcie_rp *pp = &pci->pp;
 374	u32 val, status_l0, status_l1;
 375	u16 val_w;
 376
 377	status_l0 = appl_readl(pcie, APPL_INTR_STATUS_L0);
 378	if (status_l0 & APPL_INTR_STATUS_L0_LINK_STATE_INT) {
 379		status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_0_0);
 380		appl_writel(pcie, status_l1, APPL_INTR_STATUS_L1_0_0);
 381		if (!pcie->of_data->has_sbr_reset_fix &&
 382		    status_l1 & APPL_INTR_STATUS_L1_0_0_LINK_REQ_RST_NOT_CHGED) {
 383			/* SBR & Surprise Link Down WAR */
 384			val = appl_readl(pcie, APPL_CAR_RESET_OVRD);
 385			val &= ~APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N;
 386			appl_writel(pcie, val, APPL_CAR_RESET_OVRD);
 387			udelay(1);
 388			val = appl_readl(pcie, APPL_CAR_RESET_OVRD);
 389			val |= APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N;
 390			appl_writel(pcie, val, APPL_CAR_RESET_OVRD);
 391
 392			val = dw_pcie_readl_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL);
 393			val |= PORT_LOGIC_SPEED_CHANGE;
 394			dw_pcie_writel_dbi(pci, PCIE_LINK_WIDTH_SPEED_CONTROL, val);
 395		}
 396	}
 397
 398	if (status_l0 & APPL_INTR_STATUS_L0_INT_INT) {
 399		status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_8_0);
 400		if (status_l1 & APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS) {
 401			appl_writel(pcie,
 402				    APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS,
 403				    APPL_INTR_STATUS_L1_8_0);
 404			apply_bad_link_workaround(pp);
 405		}
 406		if (status_l1 & APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS) {
 407			val_w = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 408						  PCI_EXP_LNKSTA);
 409			val_w |= PCI_EXP_LNKSTA_LBMS;
 410			dw_pcie_writew_dbi(pci, pcie->pcie_cap_base +
 411					   PCI_EXP_LNKSTA, val_w);
 412
 413			appl_writel(pcie,
 414				    APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS,
 415				    APPL_INTR_STATUS_L1_8_0);
 416
 417			val_w = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 418						  PCI_EXP_LNKSTA);
 419			dev_dbg(pci->dev, "Link Speed : Gen-%u\n", val_w &
 420				PCI_EXP_LNKSTA_CLS);
 421		}
 422	}
 423
 424	if (status_l0 & APPL_INTR_STATUS_L0_CDM_REG_CHK_INT) {
 425		status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_18);
 426		val = dw_pcie_readl_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS);
 427		if (status_l1 & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMPLT) {
 
 428			dev_info(pci->dev, "CDM check complete\n");
 429			val |= PCIE_PL_CHK_REG_CHK_REG_COMPLETE;
 430		}
 431		if (status_l1 & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMP_ERR) {
 432			dev_err(pci->dev, "CDM comparison mismatch\n");
 433			val |= PCIE_PL_CHK_REG_CHK_REG_COMPARISON_ERROR;
 434		}
 435		if (status_l1 & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_LOGIC_ERR) {
 436			dev_err(pci->dev, "CDM Logic error\n");
 437			val |= PCIE_PL_CHK_REG_CHK_REG_LOGIC_ERROR;
 438		}
 439		dw_pcie_writel_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS, val);
 440		val = dw_pcie_readl_dbi(pci, PCIE_PL_CHK_REG_ERR_ADDR);
 441		dev_err(pci->dev, "CDM Error Address Offset = 0x%08X\n", val);
 442	}
 443
 444	return IRQ_HANDLED;
 445}
 446
 447static void pex_ep_event_hot_rst_done(struct tegra_pcie_dw *pcie)
 448{
 449	u32 val;
 450
 451	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L0);
 452	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_0_0);
 453	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_1);
 454	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_2);
 455	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_3);
 456	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_6);
 457	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_7);
 458	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_8_0);
 459	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_9);
 460	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_10);
 461	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_11);
 462	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_13);
 463	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_14);
 464	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_15);
 465	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_17);
 466	appl_writel(pcie, 0xFFFFFFFF, APPL_MSI_CTRL_2);
 467
 468	val = appl_readl(pcie, APPL_CTRL);
 469	val |= APPL_CTRL_LTSSM_EN;
 470	appl_writel(pcie, val, APPL_CTRL);
 471}
 472
 473static irqreturn_t tegra_pcie_ep_irq_thread(int irq, void *arg)
 474{
 475	struct tegra_pcie_dw *pcie = arg;
 476	struct dw_pcie_ep *ep = &pcie->pci.ep;
 477	struct dw_pcie *pci = &pcie->pci;
 478	u32 val;
 479
 480	if (test_and_clear_bit(0, &pcie->link_status))
 481		dw_pcie_ep_linkup(ep);
 482
 483	tegra_pcie_icc_set(pcie);
 484
 485	if (pcie->of_data->has_ltr_req_fix)
 486		return IRQ_HANDLED;
 487
 488	/* If EP doesn't advertise L1SS, just return */
 489	val = dw_pcie_readl_dbi(pci, pcie->cfg_link_cap_l1sub);
 490	if (!(val & (PCI_L1SS_CAP_ASPM_L1_1 | PCI_L1SS_CAP_ASPM_L1_2)))
 491		return IRQ_HANDLED;
 492
 493	/* Check if BME is set to '1' */
 494	val = dw_pcie_readl_dbi(pci, PCI_COMMAND);
 495	if (val & PCI_COMMAND_MASTER) {
 496		ktime_t timeout;
 497
 498		/* 110us for both snoop and no-snoop */
 499		val = FIELD_PREP(PCI_LTR_VALUE_MASK, 110) |
 500		      FIELD_PREP(PCI_LTR_SCALE_MASK, 2) |
 501		      LTR_MSG_REQ |
 502		      FIELD_PREP(PCI_LTR_NOSNOOP_VALUE, 110) |
 503		      FIELD_PREP(PCI_LTR_NOSNOOP_SCALE, 2) |
 504		      LTR_NOSNOOP_MSG_REQ;
 505		appl_writel(pcie, val, APPL_LTR_MSG_1);
 506
 507		/* Send LTR upstream */
 508		val = appl_readl(pcie, APPL_LTR_MSG_2);
 509		val |= APPL_LTR_MSG_2_LTR_MSG_REQ_STATE;
 510		appl_writel(pcie, val, APPL_LTR_MSG_2);
 511
 512		timeout = ktime_add_us(ktime_get(), LTR_MSG_TIMEOUT);
 513		for (;;) {
 514			val = appl_readl(pcie, APPL_LTR_MSG_2);
 515			if (!(val & APPL_LTR_MSG_2_LTR_MSG_REQ_STATE))
 516				break;
 517			if (ktime_after(ktime_get(), timeout))
 518				break;
 519			usleep_range(1000, 1100);
 520		}
 521		if (val & APPL_LTR_MSG_2_LTR_MSG_REQ_STATE)
 522			dev_err(pcie->dev, "Failed to send LTR message\n");
 523	}
 524
 525	return IRQ_HANDLED;
 526}
 527
 528static irqreturn_t tegra_pcie_ep_hard_irq(int irq, void *arg)
 529{
 530	struct tegra_pcie_dw *pcie = arg;
 531	int spurious = 1;
 532	u32 status_l0, status_l1, link_status;
 533
 534	status_l0 = appl_readl(pcie, APPL_INTR_STATUS_L0);
 535	if (status_l0 & APPL_INTR_STATUS_L0_LINK_STATE_INT) {
 536		status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_0_0);
 537		appl_writel(pcie, status_l1, APPL_INTR_STATUS_L1_0_0);
 538
 539		if (status_l1 & APPL_INTR_STATUS_L1_0_0_HOT_RESET_DONE)
 540			pex_ep_event_hot_rst_done(pcie);
 541
 542		if (status_l1 & APPL_INTR_STATUS_L1_0_0_RDLH_LINK_UP_CHGED) {
 543			link_status = appl_readl(pcie, APPL_LINK_STATUS);
 544			if (link_status & APPL_LINK_STATUS_RDLH_LINK_UP) {
 545				dev_dbg(pcie->dev, "Link is up with Host\n");
 546				set_bit(0, &pcie->link_status);
 547				return IRQ_WAKE_THREAD;
 548			}
 549		}
 550
 551		spurious = 0;
 552	}
 553
 554	if (status_l0 & APPL_INTR_STATUS_L0_PCI_CMD_EN_INT) {
 555		status_l1 = appl_readl(pcie, APPL_INTR_STATUS_L1_15);
 556		appl_writel(pcie, status_l1, APPL_INTR_STATUS_L1_15);
 557
 558		if (status_l1 & APPL_INTR_STATUS_L1_15_CFG_BME_CHGED)
 559			return IRQ_WAKE_THREAD;
 560
 561		spurious = 0;
 562	}
 563
 564	if (spurious) {
 565		dev_warn(pcie->dev, "Random interrupt (STATUS = 0x%08X)\n",
 566			 status_l0);
 567		appl_writel(pcie, status_l0, APPL_INTR_STATUS_L0);
 568	}
 569
 570	return IRQ_HANDLED;
 571}
 572
 573static int tegra_pcie_dw_rd_own_conf(struct pci_bus *bus, u32 devfn, int where,
 574				     int size, u32 *val)
 575{
 576	struct dw_pcie_rp *pp = bus->sysdata;
 577	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 578	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 579
 580	/*
 581	 * This is an endpoint mode specific register happen to appear even
 582	 * when controller is operating in root port mode and system hangs
 583	 * when it is accessed with link being in ASPM-L1 state.
 584	 * So skip accessing it altogether
 585	 */
 586	if (!pcie->of_data->has_msix_doorbell_access_fix &&
 587	    !PCI_SLOT(devfn) && where == PORT_LOGIC_MSIX_DOORBELL) {
 588		*val = 0x00000000;
 589		return PCIBIOS_SUCCESSFUL;
 590	}
 591
 592	return pci_generic_config_read(bus, devfn, where, size, val);
 593}
 594
 595static int tegra_pcie_dw_wr_own_conf(struct pci_bus *bus, u32 devfn, int where,
 596				     int size, u32 val)
 597{
 598	struct dw_pcie_rp *pp = bus->sysdata;
 599	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 600	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 601
 602	/*
 603	 * This is an endpoint mode specific register happen to appear even
 604	 * when controller is operating in root port mode and system hangs
 605	 * when it is accessed with link being in ASPM-L1 state.
 606	 * So skip accessing it altogether
 607	 */
 608	if (!pcie->of_data->has_msix_doorbell_access_fix &&
 609	    !PCI_SLOT(devfn) && where == PORT_LOGIC_MSIX_DOORBELL)
 610		return PCIBIOS_SUCCESSFUL;
 611
 612	return pci_generic_config_write(bus, devfn, where, size, val);
 613}
 614
 615static struct pci_ops tegra_pci_ops = {
 616	.map_bus = dw_pcie_own_conf_map_bus,
 617	.read = tegra_pcie_dw_rd_own_conf,
 618	.write = tegra_pcie_dw_wr_own_conf,
 619};
 620
 621#if defined(CONFIG_PCIEASPM)
 622static void disable_aspm_l11(struct tegra_pcie_dw *pcie)
 623{
 624	u32 val;
 625
 626	val = dw_pcie_readl_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub);
 627	val &= ~PCI_L1SS_CAP_ASPM_L1_1;
 628	dw_pcie_writel_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub, val);
 629}
 630
 631static void disable_aspm_l12(struct tegra_pcie_dw *pcie)
 632{
 633	u32 val;
 634
 635	val = dw_pcie_readl_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub);
 636	val &= ~PCI_L1SS_CAP_ASPM_L1_2;
 637	dw_pcie_writel_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub, val);
 638}
 639
 640static inline u32 event_counter_prog(struct tegra_pcie_dw *pcie, u32 event)
 641{
 642	u32 val;
 643
 644	val = dw_pcie_readl_dbi(&pcie->pci, pcie->ras_des_cap +
 645				PCIE_RAS_DES_EVENT_COUNTER_CONTROL);
 646	val &= ~(EVENT_COUNTER_EVENT_SEL_MASK << EVENT_COUNTER_EVENT_SEL_SHIFT);
 647	val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT;
 648	val |= event << EVENT_COUNTER_EVENT_SEL_SHIFT;
 649	val |= EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT;
 650	dw_pcie_writel_dbi(&pcie->pci, pcie->ras_des_cap +
 651			   PCIE_RAS_DES_EVENT_COUNTER_CONTROL, val);
 652	val = dw_pcie_readl_dbi(&pcie->pci, pcie->ras_des_cap +
 653				PCIE_RAS_DES_EVENT_COUNTER_DATA);
 654
 655	return val;
 656}
 657
 658static int aspm_state_cnt(struct seq_file *s, void *data)
 659{
 660	struct tegra_pcie_dw *pcie = (struct tegra_pcie_dw *)
 661				     dev_get_drvdata(s->private);
 662	u32 val;
 663
 664	seq_printf(s, "Tx L0s entry count : %u\n",
 665		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_Tx_L0S));
 666
 667	seq_printf(s, "Rx L0s entry count : %u\n",
 668		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_Rx_L0S));
 669
 670	seq_printf(s, "Link L1 entry count : %u\n",
 671		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1));
 672
 673	seq_printf(s, "Link L1.1 entry count : %u\n",
 674		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1_1));
 675
 676	seq_printf(s, "Link L1.2 entry count : %u\n",
 677		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1_2));
 678
 679	/* Clear all counters */
 680	dw_pcie_writel_dbi(&pcie->pci, pcie->ras_des_cap +
 681			   PCIE_RAS_DES_EVENT_COUNTER_CONTROL,
 682			   EVENT_COUNTER_ALL_CLEAR);
 683
 684	/* Re-enable counting */
 685	val = EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT;
 686	val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT;
 687	dw_pcie_writel_dbi(&pcie->pci, pcie->ras_des_cap +
 688			   PCIE_RAS_DES_EVENT_COUNTER_CONTROL, val);
 689
 690	return 0;
 691}
 692
 693static void init_host_aspm(struct tegra_pcie_dw *pcie)
 694{
 695	struct dw_pcie *pci = &pcie->pci;
 696	u32 val;
 697
 698	val = dw_pcie_find_ext_capability(pci, PCI_EXT_CAP_ID_L1SS);
 699	pcie->cfg_link_cap_l1sub = val + PCI_L1SS_CAP;
 700
 701	pcie->ras_des_cap = dw_pcie_find_ext_capability(&pcie->pci,
 702							PCI_EXT_CAP_ID_VNDR);
 703
 704	/* Enable ASPM counters */
 705	val = EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT;
 706	val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT;
 707	dw_pcie_writel_dbi(pci, pcie->ras_des_cap +
 708			   PCIE_RAS_DES_EVENT_COUNTER_CONTROL, val);
 709
 710	/* Program T_cmrt and T_pwr_on values */
 711	val = dw_pcie_readl_dbi(pci, pcie->cfg_link_cap_l1sub);
 712	val &= ~(PCI_L1SS_CAP_CM_RESTORE_TIME | PCI_L1SS_CAP_P_PWR_ON_VALUE);
 713	val |= (pcie->aspm_cmrt << 8);
 714	val |= (pcie->aspm_pwr_on_t << 19);
 715	dw_pcie_writel_dbi(pci, pcie->cfg_link_cap_l1sub, val);
 716
 717	/* Program L0s and L1 entrance latencies */
 718	val = dw_pcie_readl_dbi(pci, PCIE_PORT_AFR);
 719	val &= ~PORT_AFR_L0S_ENTRANCE_LAT_MASK;
 720	val |= (pcie->aspm_l0s_enter_lat << PORT_AFR_L0S_ENTRANCE_LAT_SHIFT);
 721	val |= PORT_AFR_ENTER_ASPM;
 722	dw_pcie_writel_dbi(pci, PCIE_PORT_AFR, val);
 723}
 724
 725static void init_debugfs(struct tegra_pcie_dw *pcie)
 726{
 727	debugfs_create_devm_seqfile(pcie->dev, "aspm_state_cnt", pcie->debugfs,
 728				    aspm_state_cnt);
 
 
 
 
 
 
 
 729}
 730#else
 731static inline void disable_aspm_l12(struct tegra_pcie_dw *pcie) { return; }
 732static inline void disable_aspm_l11(struct tegra_pcie_dw *pcie) { return; }
 733static inline void init_host_aspm(struct tegra_pcie_dw *pcie) { return; }
 734static inline void init_debugfs(struct tegra_pcie_dw *pcie) { return; }
 735#endif
 736
 737static void tegra_pcie_enable_system_interrupts(struct dw_pcie_rp *pp)
 738{
 739	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 740	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 741	u32 val;
 742	u16 val_w;
 743
 744	val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 745	val |= APPL_INTR_EN_L0_0_LINK_STATE_INT_EN;
 746	appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 747
 748	if (!pcie->of_data->has_sbr_reset_fix) {
 749		val = appl_readl(pcie, APPL_INTR_EN_L1_0_0);
 750		val |= APPL_INTR_EN_L1_0_0_LINK_REQ_RST_NOT_INT_EN;
 751		appl_writel(pcie, val, APPL_INTR_EN_L1_0_0);
 752	}
 753
 754	if (pcie->enable_cdm_check) {
 755		val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 756		val |= pcie->of_data->cdm_chk_int_en_bit;
 757		appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 758
 759		val = appl_readl(pcie, APPL_INTR_EN_L1_18);
 760		val |= APPL_INTR_EN_L1_18_CDM_REG_CHK_CMP_ERR;
 761		val |= APPL_INTR_EN_L1_18_CDM_REG_CHK_LOGIC_ERR;
 762		appl_writel(pcie, val, APPL_INTR_EN_L1_18);
 763	}
 764
 765	val_w = dw_pcie_readw_dbi(&pcie->pci, pcie->pcie_cap_base +
 766				  PCI_EXP_LNKSTA);
 767	pcie->init_link_width = FIELD_GET(PCI_EXP_LNKSTA_NLW, val_w);
 
 768
 769	val_w = dw_pcie_readw_dbi(&pcie->pci, pcie->pcie_cap_base +
 770				  PCI_EXP_LNKCTL);
 771	val_w |= PCI_EXP_LNKCTL_LBMIE;
 772	dw_pcie_writew_dbi(&pcie->pci, pcie->pcie_cap_base + PCI_EXP_LNKCTL,
 773			   val_w);
 774}
 775
 776static void tegra_pcie_enable_intx_interrupts(struct dw_pcie_rp *pp)
 777{
 778	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 779	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 780	u32 val;
 781
 782	/* Enable INTX interrupt generation */
 783	val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 784	val |= APPL_INTR_EN_L0_0_SYS_INTR_EN;
 785	val |= APPL_INTR_EN_L0_0_INT_INT_EN;
 786	appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 787
 788	val = appl_readl(pcie, APPL_INTR_EN_L1_8_0);
 789	val |= APPL_INTR_EN_L1_8_INTX_EN;
 790	val |= APPL_INTR_EN_L1_8_AUTO_BW_INT_EN;
 791	val |= APPL_INTR_EN_L1_8_BW_MGT_INT_EN;
 792	if (IS_ENABLED(CONFIG_PCIEAER))
 793		val |= APPL_INTR_EN_L1_8_AER_INT_EN;
 794	appl_writel(pcie, val, APPL_INTR_EN_L1_8_0);
 795}
 796
 797static void tegra_pcie_enable_msi_interrupts(struct dw_pcie_rp *pp)
 798{
 799	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 800	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 801	u32 val;
 802
 
 
 803	/* Enable MSI interrupt generation */
 804	val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 805	val |= APPL_INTR_EN_L0_0_SYS_MSI_INTR_EN;
 806	val |= APPL_INTR_EN_L0_0_MSI_RCV_INT_EN;
 807	appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 808}
 809
 810static void tegra_pcie_enable_interrupts(struct dw_pcie_rp *pp)
 811{
 812	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 813	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 814
 815	/* Clear interrupt statuses before enabling interrupts */
 816	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L0);
 817	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_0_0);
 818	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_1);
 819	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_2);
 820	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_3);
 821	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_6);
 822	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_7);
 823	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_8_0);
 824	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_9);
 825	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_10);
 826	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_11);
 827	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_13);
 828	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_14);
 829	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_15);
 830	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_17);
 831
 832	tegra_pcie_enable_system_interrupts(pp);
 833	tegra_pcie_enable_intx_interrupts(pp);
 834	if (IS_ENABLED(CONFIG_PCI_MSI))
 835		tegra_pcie_enable_msi_interrupts(pp);
 836}
 837
 838static void config_gen3_gen4_eq_presets(struct tegra_pcie_dw *pcie)
 839{
 840	struct dw_pcie *pci = &pcie->pci;
 841	u32 val, offset, i;
 842
 843	/* Program init preset */
 844	for (i = 0; i < pcie->num_lanes; i++) {
 845		val = dw_pcie_readw_dbi(pci, CAP_SPCIE_CAP_OFF + (i * 2));
 
 846		val &= ~CAP_SPCIE_CAP_OFF_DSP_TX_PRESET0_MASK;
 847		val |= GEN3_GEN4_EQ_PRESET_INIT;
 848		val &= ~CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_MASK;
 849		val |= (GEN3_GEN4_EQ_PRESET_INIT <<
 850			   CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_SHIFT);
 851		dw_pcie_writew_dbi(pci, CAP_SPCIE_CAP_OFF + (i * 2), val);
 
 852
 853		offset = dw_pcie_find_ext_capability(pci,
 854						     PCI_EXT_CAP_ID_PL_16GT) +
 855				PCI_PL_16GT_LE_CTRL;
 856		val = dw_pcie_readb_dbi(pci, offset + i);
 857		val &= ~PCI_PL_16GT_LE_CTRL_DSP_TX_PRESET_MASK;
 858		val |= GEN3_GEN4_EQ_PRESET_INIT;
 859		val &= ~PCI_PL_16GT_LE_CTRL_USP_TX_PRESET_MASK;
 860		val |= (GEN3_GEN4_EQ_PRESET_INIT <<
 861			PCI_PL_16GT_LE_CTRL_USP_TX_PRESET_SHIFT);
 862		dw_pcie_writeb_dbi(pci, offset + i, val);
 863	}
 864
 865	val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 866	val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK;
 867	dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 868
 869	val = dw_pcie_readl_dbi(pci, GEN3_EQ_CONTROL_OFF);
 870	val &= ~GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK;
 871	val |= (0x3ff << GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT);
 872	val &= ~GEN3_EQ_CONTROL_OFF_FB_MODE_MASK;
 873	dw_pcie_writel_dbi(pci, GEN3_EQ_CONTROL_OFF, val);
 874
 875	val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 876	val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK;
 877	val |= (0x1 << GEN3_RELATED_OFF_RATE_SHADOW_SEL_SHIFT);
 878	dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 879
 880	val = dw_pcie_readl_dbi(pci, GEN3_EQ_CONTROL_OFF);
 881	val &= ~GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK;
 882	val |= (pcie->of_data->gen4_preset_vec <<
 883		GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT);
 884	val &= ~GEN3_EQ_CONTROL_OFF_FB_MODE_MASK;
 885	dw_pcie_writel_dbi(pci, GEN3_EQ_CONTROL_OFF, val);
 886
 887	val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 888	val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK;
 889	dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 890}
 891
 892static int tegra_pcie_dw_host_init(struct dw_pcie_rp *pp)
 893{
 894	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 895	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 896	u32 val;
 897	u16 val_16;
 898
 899	pp->bridge->ops = &tegra_pci_ops;
 900
 901	if (!pcie->pcie_cap_base)
 902		pcie->pcie_cap_base = dw_pcie_find_capability(&pcie->pci,
 903							      PCI_CAP_ID_EXP);
 904
 905	val = dw_pcie_readl_dbi(pci, PCI_IO_BASE);
 906	val &= ~(IO_BASE_IO_DECODE | IO_BASE_IO_DECODE_BIT8);
 907	dw_pcie_writel_dbi(pci, PCI_IO_BASE, val);
 908
 909	val = dw_pcie_readl_dbi(pci, PCI_PREF_MEMORY_BASE);
 910	val |= CFG_PREF_MEM_LIMIT_BASE_MEM_DECODE;
 911	val |= CFG_PREF_MEM_LIMIT_BASE_MEM_LIMIT_DECODE;
 912	dw_pcie_writel_dbi(pci, PCI_PREF_MEMORY_BASE, val);
 913
 914	dw_pcie_writel_dbi(pci, PCI_BASE_ADDRESS_0, 0);
 915
 
 
 
 
 
 
 
 
 
 
 
 916	/* Enable as 0xFFFF0001 response for CRS */
 917	val = dw_pcie_readl_dbi(pci, PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT);
 918	val &= ~(AMBA_ERROR_RESPONSE_CRS_MASK << AMBA_ERROR_RESPONSE_CRS_SHIFT);
 919	val |= (AMBA_ERROR_RESPONSE_CRS_OKAY_FFFF0001 <<
 920		AMBA_ERROR_RESPONSE_CRS_SHIFT);
 921	dw_pcie_writel_dbi(pci, PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT, val);
 922
 923	/* Clear Slot Clock Configuration bit if SRNS configuration */
 924	if (pcie->enable_srns) {
 925		val_16 = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 926					   PCI_EXP_LNKSTA);
 927		val_16 &= ~PCI_EXP_LNKSTA_SLC;
 928		dw_pcie_writew_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA,
 929				   val_16);
 
 930	}
 931
 
 
 
 
 
 
 932	config_gen3_gen4_eq_presets(pcie);
 933
 934	init_host_aspm(pcie);
 935
 936	/* Disable ASPM-L1SS advertisement if there is no CLKREQ routing */
 937	if (!pcie->supports_clkreq) {
 938		disable_aspm_l11(pcie);
 939		disable_aspm_l12(pcie);
 940	}
 941
 942	if (!pcie->of_data->has_l1ss_exit_fix) {
 943		val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 944		val &= ~GEN3_RELATED_OFF_GEN3_ZRXDC_NONCOMPL;
 945		dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 946	}
 947
 948	if (pcie->update_fc_fixup) {
 949		val = dw_pcie_readl_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF);
 950		val |= 0x1 << CFG_TIMER_CTRL_ACK_NAK_SHIFT;
 951		dw_pcie_writel_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF, val);
 952	}
 953
 954	clk_set_rate(pcie->core_clk, GEN4_CORE_CLK_FREQ);
 955
 956	return 0;
 957}
 958
 959static int tegra_pcie_dw_start_link(struct dw_pcie *pci)
 960{
 961	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 962	struct dw_pcie_rp *pp = &pci->pp;
 963	u32 val, offset, tmp;
 964	bool retry = true;
 965
 966	if (pcie->of_data->mode == DW_PCIE_EP_TYPE) {
 967		enable_irq(pcie->pex_rst_irq);
 968		return 0;
 969	}
 970
 971retry_link:
 972	/* Assert RST */
 973	val = appl_readl(pcie, APPL_PINMUX);
 974	val &= ~APPL_PINMUX_PEX_RST;
 975	appl_writel(pcie, val, APPL_PINMUX);
 976
 977	usleep_range(100, 200);
 978
 979	/* Enable LTSSM */
 980	val = appl_readl(pcie, APPL_CTRL);
 981	val |= APPL_CTRL_LTSSM_EN;
 982	appl_writel(pcie, val, APPL_CTRL);
 983
 984	/* De-assert RST */
 985	val = appl_readl(pcie, APPL_PINMUX);
 986	val |= APPL_PINMUX_PEX_RST;
 987	appl_writel(pcie, val, APPL_PINMUX);
 988
 989	msleep(100);
 
 
 
 
 
 
 
 
 
 990
 991	if (dw_pcie_wait_for_link(pci)) {
 992		if (!retry)
 993			return 0;
 994		/*
 995		 * There are some endpoints which can't get the link up if
 996		 * root port has Data Link Feature (DLF) enabled.
 997		 * Refer Spec rev 4.0 ver 1.0 sec 3.4.2 & 7.7.4 for more info
 998		 * on Scaled Flow Control and DLF.
 999		 * So, need to confirm that is indeed the case here and attempt
1000		 * link up once again with DLF disabled.
1001		 */
1002		val = appl_readl(pcie, APPL_DEBUG);
1003		val &= APPL_DEBUG_LTSSM_STATE_MASK;
1004		val >>= APPL_DEBUG_LTSSM_STATE_SHIFT;
1005		tmp = appl_readl(pcie, APPL_LINK_STATUS);
1006		tmp &= APPL_LINK_STATUS_RDLH_LINK_UP;
1007		if (!(val == 0x11 && !tmp)) {
1008			/* Link is down for all good reasons */
1009			return 0;
1010		}
1011
1012		dev_info(pci->dev, "Link is down in DLL");
1013		dev_info(pci->dev, "Trying again with DLFE disabled\n");
1014		/* Disable LTSSM */
1015		val = appl_readl(pcie, APPL_CTRL);
1016		val &= ~APPL_CTRL_LTSSM_EN;
1017		appl_writel(pcie, val, APPL_CTRL);
1018
1019		reset_control_assert(pcie->core_rst);
1020		reset_control_deassert(pcie->core_rst);
1021
1022		offset = dw_pcie_find_ext_capability(pci, PCI_EXT_CAP_ID_DLF);
1023		val = dw_pcie_readl_dbi(pci, offset + PCI_DLF_CAP);
1024		val &= ~PCI_DLF_EXCHANGE_ENABLE;
1025		dw_pcie_writel_dbi(pci, offset + PCI_DLF_CAP, val);
1026
1027		tegra_pcie_dw_host_init(pp);
1028		dw_pcie_setup_rc(pp);
1029
1030		retry = false;
1031		goto retry_link;
1032	}
1033
1034	tegra_pcie_icc_set(pcie);
 
 
1035
1036	tegra_pcie_enable_interrupts(pp);
1037
1038	return 0;
1039}
1040
1041static int tegra_pcie_dw_link_up(struct dw_pcie *pci)
1042{
1043	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
1044	u32 val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA);
1045
1046	return !!(val & PCI_EXP_LNKSTA_DLLLA);
1047}
1048
1049static void tegra_pcie_dw_stop_link(struct dw_pcie *pci)
1050{
1051	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
1052
1053	disable_irq(pcie->pex_rst_irq);
1054}
1055
1056static const struct dw_pcie_ops tegra_dw_pcie_ops = {
1057	.link_up = tegra_pcie_dw_link_up,
1058	.start_link = tegra_pcie_dw_start_link,
1059	.stop_link = tegra_pcie_dw_stop_link,
1060};
1061
1062static const struct dw_pcie_host_ops tegra_pcie_dw_host_ops = {
1063	.init = tegra_pcie_dw_host_init,
 
 
 
1064};
1065
1066static void tegra_pcie_disable_phy(struct tegra_pcie_dw *pcie)
1067{
1068	unsigned int phy_count = pcie->phy_count;
1069
1070	while (phy_count--) {
1071		phy_power_off(pcie->phys[phy_count]);
1072		phy_exit(pcie->phys[phy_count]);
1073	}
1074}
1075
1076static int tegra_pcie_enable_phy(struct tegra_pcie_dw *pcie)
1077{
1078	unsigned int i;
1079	int ret;
1080
1081	for (i = 0; i < pcie->phy_count; i++) {
1082		ret = phy_init(pcie->phys[i]);
1083		if (ret < 0)
1084			goto phy_power_off;
1085
1086		ret = phy_power_on(pcie->phys[i]);
1087		if (ret < 0)
1088			goto phy_exit;
1089	}
1090
1091	return 0;
1092
1093phy_power_off:
1094	while (i--) {
1095		phy_power_off(pcie->phys[i]);
1096phy_exit:
1097		phy_exit(pcie->phys[i]);
1098	}
1099
1100	return ret;
1101}
1102
1103static int tegra_pcie_dw_parse_dt(struct tegra_pcie_dw *pcie)
1104{
1105	struct platform_device *pdev = to_platform_device(pcie->dev);
1106	struct device_node *np = pcie->dev->of_node;
1107	int ret;
1108
1109	pcie->dbi_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dbi");
1110	if (!pcie->dbi_res) {
1111		dev_err(pcie->dev, "Failed to find \"dbi\" region\n");
1112		return -ENODEV;
1113	}
1114
1115	ret = of_property_read_u32(np, "nvidia,aspm-cmrt-us", &pcie->aspm_cmrt);
1116	if (ret < 0) {
1117		dev_info(pcie->dev, "Failed to read ASPM T_cmrt: %d\n", ret);
1118		return ret;
1119	}
1120
1121	ret = of_property_read_u32(np, "nvidia,aspm-pwr-on-t-us",
1122				   &pcie->aspm_pwr_on_t);
1123	if (ret < 0)
1124		dev_info(pcie->dev, "Failed to read ASPM Power On time: %d\n",
1125			 ret);
1126
1127	ret = of_property_read_u32(np, "nvidia,aspm-l0s-entrance-latency-us",
1128				   &pcie->aspm_l0s_enter_lat);
1129	if (ret < 0)
1130		dev_info(pcie->dev,
1131			 "Failed to read ASPM L0s Entrance latency: %d\n", ret);
1132
1133	ret = of_property_read_u32(np, "num-lanes", &pcie->num_lanes);
1134	if (ret < 0) {
1135		dev_err(pcie->dev, "Failed to read num-lanes: %d\n", ret);
1136		return ret;
1137	}
1138
 
 
1139	ret = of_property_read_u32_index(np, "nvidia,bpmp", 1, &pcie->cid);
1140	if (ret) {
1141		dev_err(pcie->dev, "Failed to read Controller-ID: %d\n", ret);
1142		return ret;
1143	}
1144
1145	ret = of_property_count_strings(np, "phy-names");
1146	if (ret < 0) {
1147		dev_err(pcie->dev, "Failed to find PHY entries: %d\n",
1148			ret);
1149		return ret;
1150	}
1151	pcie->phy_count = ret;
1152
1153	if (of_property_read_bool(np, "nvidia,update-fc-fixup"))
1154		pcie->update_fc_fixup = true;
1155
1156	/* RP using an external REFCLK is supported only in Tegra234 */
1157	if (pcie->of_data->version == TEGRA194_DWC_IP_VER) {
1158		if (pcie->of_data->mode == DW_PCIE_EP_TYPE)
1159			pcie->enable_ext_refclk = true;
1160	} else {
1161		pcie->enable_ext_refclk =
1162			of_property_read_bool(pcie->dev->of_node,
1163					      "nvidia,enable-ext-refclk");
1164	}
1165
1166	pcie->supports_clkreq =
1167		of_property_read_bool(pcie->dev->of_node, "supports-clkreq");
1168
1169	pcie->enable_cdm_check =
1170		of_property_read_bool(np, "snps,enable-cdm-check");
1171
1172	if (pcie->of_data->version == TEGRA234_DWC_IP_VER)
1173		pcie->enable_srns =
1174			of_property_read_bool(np, "nvidia,enable-srns");
1175
1176	if (pcie->of_data->mode == DW_PCIE_RC_TYPE)
1177		return 0;
1178
1179	/* Endpoint mode specific DT entries */
1180	pcie->pex_rst_gpiod = devm_gpiod_get(pcie->dev, "reset", GPIOD_IN);
1181	if (IS_ERR(pcie->pex_rst_gpiod)) {
1182		int err = PTR_ERR(pcie->pex_rst_gpiod);
1183		const char *level = KERN_ERR;
1184
1185		if (err == -EPROBE_DEFER)
1186			level = KERN_DEBUG;
1187
1188		dev_printk(level, pcie->dev,
1189			   dev_fmt("Failed to get PERST GPIO: %d\n"),
1190			   err);
1191		return err;
1192	}
1193
1194	pcie->pex_refclk_sel_gpiod = devm_gpiod_get(pcie->dev,
1195						    "nvidia,refclk-select",
1196						    GPIOD_OUT_HIGH);
1197	if (IS_ERR(pcie->pex_refclk_sel_gpiod)) {
1198		int err = PTR_ERR(pcie->pex_refclk_sel_gpiod);
1199		const char *level = KERN_ERR;
1200
1201		if (err == -EPROBE_DEFER)
1202			level = KERN_DEBUG;
1203
1204		dev_printk(level, pcie->dev,
1205			   dev_fmt("Failed to get REFCLK select GPIOs: %d\n"),
1206			   err);
1207		pcie->pex_refclk_sel_gpiod = NULL;
1208	}
1209
1210	return 0;
1211}
1212
1213static int tegra_pcie_bpmp_set_ctrl_state(struct tegra_pcie_dw *pcie,
1214					  bool enable)
1215{
1216	struct mrq_uphy_response resp;
1217	struct tegra_bpmp_message msg;
1218	struct mrq_uphy_request req;
1219
1220	/*
1221	 * Controller-5 doesn't need to have its state set by BPMP-FW in
1222	 * Tegra194
1223	 */
1224	if (pcie->of_data->version == TEGRA194_DWC_IP_VER && pcie->cid == 5)
1225		return 0;
1226
1227	memset(&req, 0, sizeof(req));
1228	memset(&resp, 0, sizeof(resp));
1229
1230	req.cmd = CMD_UPHY_PCIE_CONTROLLER_STATE;
1231	req.controller_state.pcie_controller = pcie->cid;
1232	req.controller_state.enable = enable;
1233
1234	memset(&msg, 0, sizeof(msg));
1235	msg.mrq = MRQ_UPHY;
1236	msg.tx.data = &req;
1237	msg.tx.size = sizeof(req);
1238	msg.rx.data = &resp;
1239	msg.rx.size = sizeof(resp);
1240
1241	return tegra_bpmp_transfer(pcie->bpmp, &msg);
1242}
1243
1244static int tegra_pcie_bpmp_set_pll_state(struct tegra_pcie_dw *pcie,
1245					 bool enable)
1246{
1247	struct mrq_uphy_response resp;
1248	struct tegra_bpmp_message msg;
1249	struct mrq_uphy_request req;
1250
1251	memset(&req, 0, sizeof(req));
1252	memset(&resp, 0, sizeof(resp));
1253
1254	if (enable) {
1255		req.cmd = CMD_UPHY_PCIE_EP_CONTROLLER_PLL_INIT;
1256		req.ep_ctrlr_pll_init.ep_controller = pcie->cid;
1257	} else {
1258		req.cmd = CMD_UPHY_PCIE_EP_CONTROLLER_PLL_OFF;
1259		req.ep_ctrlr_pll_off.ep_controller = pcie->cid;
1260	}
1261
1262	memset(&msg, 0, sizeof(msg));
1263	msg.mrq = MRQ_UPHY;
1264	msg.tx.data = &req;
1265	msg.tx.size = sizeof(req);
1266	msg.rx.data = &resp;
1267	msg.rx.size = sizeof(resp);
1268
1269	return tegra_bpmp_transfer(pcie->bpmp, &msg);
1270}
1271
1272static void tegra_pcie_downstream_dev_to_D0(struct tegra_pcie_dw *pcie)
1273{
1274	struct dw_pcie_rp *pp = &pcie->pci.pp;
1275	struct pci_bus *child, *root_bus = NULL;
1276	struct pci_dev *pdev;
1277
1278	/*
1279	 * link doesn't go into L2 state with some of the endpoints with Tegra
1280	 * if they are not in D0 state. So, need to make sure that immediate
1281	 * downstream devices are in D0 state before sending PME_TurnOff to put
1282	 * link into L2 state.
1283	 * This is as per PCI Express Base r4.0 v1.0 September 27-2017,
1284	 * 5.2 Link State Power Management (Page #428).
1285	 */
1286
1287	list_for_each_entry(child, &pp->bridge->bus->children, node) {
1288		/* Bring downstream devices to D0 if they are not already in */
1289		if (child->parent == pp->bridge->bus) {
1290			root_bus = child;
1291			break;
1292		}
1293	}
1294
1295	if (!root_bus) {
1296		dev_err(pcie->dev, "Failed to find downstream devices\n");
1297		return;
1298	}
1299
1300	list_for_each_entry(pdev, &root_bus->devices, bus_list) {
1301		if (PCI_SLOT(pdev->devfn) == 0) {
1302			if (pci_set_power_state(pdev, PCI_D0))
1303				dev_err(pcie->dev,
1304					"Failed to transition %s to D0 state\n",
1305					dev_name(&pdev->dev));
1306		}
1307	}
1308}
1309
1310static int tegra_pcie_get_slot_regulators(struct tegra_pcie_dw *pcie)
1311{
1312	pcie->slot_ctl_3v3 = devm_regulator_get_optional(pcie->dev, "vpcie3v3");
1313	if (IS_ERR(pcie->slot_ctl_3v3)) {
1314		if (PTR_ERR(pcie->slot_ctl_3v3) != -ENODEV)
1315			return PTR_ERR(pcie->slot_ctl_3v3);
1316
1317		pcie->slot_ctl_3v3 = NULL;
1318	}
1319
1320	pcie->slot_ctl_12v = devm_regulator_get_optional(pcie->dev, "vpcie12v");
1321	if (IS_ERR(pcie->slot_ctl_12v)) {
1322		if (PTR_ERR(pcie->slot_ctl_12v) != -ENODEV)
1323			return PTR_ERR(pcie->slot_ctl_12v);
1324
1325		pcie->slot_ctl_12v = NULL;
1326	}
1327
1328	return 0;
1329}
1330
1331static int tegra_pcie_enable_slot_regulators(struct tegra_pcie_dw *pcie)
1332{
1333	int ret;
1334
1335	if (pcie->slot_ctl_3v3) {
1336		ret = regulator_enable(pcie->slot_ctl_3v3);
1337		if (ret < 0) {
1338			dev_err(pcie->dev,
1339				"Failed to enable 3.3V slot supply: %d\n", ret);
1340			return ret;
1341		}
1342	}
1343
1344	if (pcie->slot_ctl_12v) {
1345		ret = regulator_enable(pcie->slot_ctl_12v);
1346		if (ret < 0) {
1347			dev_err(pcie->dev,
1348				"Failed to enable 12V slot supply: %d\n", ret);
1349			goto fail_12v_enable;
1350		}
1351	}
1352
1353	/*
1354	 * According to PCI Express Card Electromechanical Specification
1355	 * Revision 1.1, Table-2.4, T_PVPERL (Power stable to PERST# inactive)
1356	 * should be a minimum of 100ms.
1357	 */
1358	if (pcie->slot_ctl_3v3 || pcie->slot_ctl_12v)
1359		msleep(100);
1360
1361	return 0;
1362
1363fail_12v_enable:
1364	if (pcie->slot_ctl_3v3)
1365		regulator_disable(pcie->slot_ctl_3v3);
1366	return ret;
1367}
1368
1369static void tegra_pcie_disable_slot_regulators(struct tegra_pcie_dw *pcie)
1370{
1371	if (pcie->slot_ctl_12v)
1372		regulator_disable(pcie->slot_ctl_12v);
1373	if (pcie->slot_ctl_3v3)
1374		regulator_disable(pcie->slot_ctl_3v3);
1375}
1376
1377static int tegra_pcie_config_controller(struct tegra_pcie_dw *pcie,
1378					bool en_hw_hot_rst)
1379{
1380	int ret;
1381	u32 val;
1382
1383	ret = tegra_pcie_bpmp_set_ctrl_state(pcie, true);
1384	if (ret) {
1385		dev_err(pcie->dev,
1386			"Failed to enable controller %u: %d\n", pcie->cid, ret);
1387		return ret;
1388	}
1389
1390	if (pcie->enable_ext_refclk) {
1391		ret = tegra_pcie_bpmp_set_pll_state(pcie, true);
1392		if (ret) {
1393			dev_err(pcie->dev, "Failed to init UPHY: %d\n", ret);
1394			goto fail_pll_init;
1395		}
1396	}
1397
1398	ret = tegra_pcie_enable_slot_regulators(pcie);
1399	if (ret < 0)
1400		goto fail_slot_reg_en;
1401
1402	ret = regulator_enable(pcie->pex_ctl_supply);
1403	if (ret < 0) {
1404		dev_err(pcie->dev, "Failed to enable regulator: %d\n", ret);
1405		goto fail_reg_en;
1406	}
1407
1408	ret = clk_prepare_enable(pcie->core_clk);
1409	if (ret) {
1410		dev_err(pcie->dev, "Failed to enable core clock: %d\n", ret);
1411		goto fail_core_clk;
1412	}
1413
1414	ret = reset_control_deassert(pcie->core_apb_rst);
1415	if (ret) {
1416		dev_err(pcie->dev, "Failed to deassert core APB reset: %d\n",
1417			ret);
1418		goto fail_core_apb_rst;
1419	}
1420
1421	if (en_hw_hot_rst || pcie->of_data->has_sbr_reset_fix) {
1422		/* Enable HW_HOT_RST mode */
1423		val = appl_readl(pcie, APPL_CTRL);
1424		val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK <<
1425			 APPL_CTRL_HW_HOT_RST_MODE_SHIFT);
1426		val |= (APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST_LTSSM_EN <<
1427			APPL_CTRL_HW_HOT_RST_MODE_SHIFT);
1428		val |= APPL_CTRL_HW_HOT_RST_EN;
1429		appl_writel(pcie, val, APPL_CTRL);
1430	}
1431
1432	ret = tegra_pcie_enable_phy(pcie);
1433	if (ret) {
1434		dev_err(pcie->dev, "Failed to enable PHY: %d\n", ret);
1435		goto fail_phy;
1436	}
1437
1438	/* Update CFG base address */
1439	appl_writel(pcie, pcie->dbi_res->start & APPL_CFG_BASE_ADDR_MASK,
1440		    APPL_CFG_BASE_ADDR);
1441
1442	/* Configure this core for RP mode operation */
1443	appl_writel(pcie, APPL_DM_TYPE_RP, APPL_DM_TYPE);
1444
1445	appl_writel(pcie, 0x0, APPL_CFG_SLCG_OVERRIDE);
1446
1447	val = appl_readl(pcie, APPL_CTRL);
1448	appl_writel(pcie, val | APPL_CTRL_SYS_PRE_DET_STATE, APPL_CTRL);
1449
1450	val = appl_readl(pcie, APPL_CFG_MISC);
1451	val |= (APPL_CFG_MISC_ARCACHE_VAL << APPL_CFG_MISC_ARCACHE_SHIFT);
1452	appl_writel(pcie, val, APPL_CFG_MISC);
1453
1454	if (pcie->enable_srns || pcie->enable_ext_refclk) {
1455		/*
1456		 * When Tegra PCIe RP is using external clock, it cannot supply
1457		 * same clock to its downstream hierarchy. Hence, gate PCIe RP
1458		 * REFCLK out pads when RP & EP are using separate clocks or RP
1459		 * is using an external REFCLK.
1460		 */
1461		val = appl_readl(pcie, APPL_PINMUX);
1462		val |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN;
1463		val &= ~APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE;
1464		appl_writel(pcie, val, APPL_PINMUX);
1465	}
1466
1467	if (!pcie->supports_clkreq) {
1468		val = appl_readl(pcie, APPL_PINMUX);
1469		val |= APPL_PINMUX_CLKREQ_OVERRIDE_EN;
1470		val &= ~APPL_PINMUX_CLKREQ_OVERRIDE;
1471		appl_writel(pcie, val, APPL_PINMUX);
1472	}
1473
1474	/* Update iATU_DMA base address */
1475	appl_writel(pcie,
1476		    pcie->atu_dma_res->start & APPL_CFG_IATU_DMA_BASE_ADDR_MASK,
1477		    APPL_CFG_IATU_DMA_BASE_ADDR);
1478
1479	reset_control_deassert(pcie->core_rst);
1480
 
 
 
 
 
 
 
 
 
1481	return ret;
1482
1483fail_phy:
1484	reset_control_assert(pcie->core_apb_rst);
1485fail_core_apb_rst:
1486	clk_disable_unprepare(pcie->core_clk);
1487fail_core_clk:
1488	regulator_disable(pcie->pex_ctl_supply);
1489fail_reg_en:
1490	tegra_pcie_disable_slot_regulators(pcie);
1491fail_slot_reg_en:
1492	if (pcie->enable_ext_refclk)
1493		tegra_pcie_bpmp_set_pll_state(pcie, false);
1494fail_pll_init:
1495	tegra_pcie_bpmp_set_ctrl_state(pcie, false);
1496
1497	return ret;
1498}
1499
1500static void tegra_pcie_unconfig_controller(struct tegra_pcie_dw *pcie)
1501{
1502	int ret;
1503
1504	ret = reset_control_assert(pcie->core_rst);
1505	if (ret)
1506		dev_err(pcie->dev, "Failed to assert \"core\" reset: %d\n", ret);
 
 
 
1507
1508	tegra_pcie_disable_phy(pcie);
1509
1510	ret = reset_control_assert(pcie->core_apb_rst);
1511	if (ret)
1512		dev_err(pcie->dev, "Failed to assert APB reset: %d\n", ret);
 
 
1513
1514	clk_disable_unprepare(pcie->core_clk);
1515
1516	ret = regulator_disable(pcie->pex_ctl_supply);
1517	if (ret)
1518		dev_err(pcie->dev, "Failed to disable regulator: %d\n", ret);
 
 
1519
1520	tegra_pcie_disable_slot_regulators(pcie);
1521
1522	if (pcie->enable_ext_refclk) {
1523		ret = tegra_pcie_bpmp_set_pll_state(pcie, false);
1524		if (ret)
1525			dev_err(pcie->dev, "Failed to deinit UPHY: %d\n", ret);
1526	}
1527
1528	ret = tegra_pcie_bpmp_set_ctrl_state(pcie, false);
1529	if (ret)
1530		dev_err(pcie->dev, "Failed to disable controller %d: %d\n",
1531			pcie->cid, ret);
 
 
 
 
1532}
1533
1534static int tegra_pcie_init_controller(struct tegra_pcie_dw *pcie)
1535{
1536	struct dw_pcie *pci = &pcie->pci;
1537	struct dw_pcie_rp *pp = &pci->pp;
1538	int ret;
1539
1540	ret = tegra_pcie_config_controller(pcie, false);
1541	if (ret < 0)
1542		return ret;
1543
1544	pp->ops = &tegra_pcie_dw_host_ops;
1545
1546	ret = dw_pcie_host_init(pp);
1547	if (ret < 0) {
1548		dev_err(pcie->dev, "Failed to add PCIe port: %d\n", ret);
1549		goto fail_host_init;
1550	}
1551
1552	return 0;
1553
1554fail_host_init:
1555	tegra_pcie_unconfig_controller(pcie);
1556	return ret;
1557}
1558
1559static int tegra_pcie_try_link_l2(struct tegra_pcie_dw *pcie)
1560{
1561	u32 val;
1562
1563	if (!tegra_pcie_dw_link_up(&pcie->pci))
1564		return 0;
1565
1566	val = appl_readl(pcie, APPL_RADM_STATUS);
1567	val |= APPL_PM_XMT_TURNOFF_STATE;
1568	appl_writel(pcie, val, APPL_RADM_STATUS);
1569
1570	return readl_poll_timeout_atomic(pcie->appl_base + APPL_DEBUG, val,
1571				 val & APPL_DEBUG_PM_LINKST_IN_L2_LAT,
1572				 1, PME_ACK_TIMEOUT);
1573}
1574
1575static void tegra_pcie_dw_pme_turnoff(struct tegra_pcie_dw *pcie)
1576{
1577	u32 data;
1578	int err;
1579
1580	if (!tegra_pcie_dw_link_up(&pcie->pci)) {
1581		dev_dbg(pcie->dev, "PCIe link is not up...!\n");
1582		return;
1583	}
1584
1585	/*
1586	 * PCIe controller exits from L2 only if reset is applied, so
1587	 * controller doesn't handle interrupts. But in cases where
1588	 * L2 entry fails, PERST# is asserted which can trigger surprise
1589	 * link down AER. However this function call happens in
1590	 * suspend_noirq(), so AER interrupt will not be processed.
1591	 * Disable all interrupts to avoid such a scenario.
1592	 */
1593	appl_writel(pcie, 0x0, APPL_INTR_EN_L0_0);
1594
1595	if (tegra_pcie_try_link_l2(pcie)) {
1596		dev_info(pcie->dev, "Link didn't transition to L2 state\n");
1597		/*
1598		 * TX lane clock freq will reset to Gen1 only if link is in L2
1599		 * or detect state.
1600		 * So apply pex_rst to end point to force RP to go into detect
1601		 * state
1602		 */
1603		data = appl_readl(pcie, APPL_PINMUX);
1604		data &= ~APPL_PINMUX_PEX_RST;
1605		appl_writel(pcie, data, APPL_PINMUX);
1606
1607		/*
1608		 * Some cards do not go to detect state even after de-asserting
1609		 * PERST#. So, de-assert LTSSM to bring link to detect state.
1610		 */
1611		data = readl(pcie->appl_base + APPL_CTRL);
1612		data &= ~APPL_CTRL_LTSSM_EN;
1613		writel(data, pcie->appl_base + APPL_CTRL);
1614
1615		err = readl_poll_timeout_atomic(pcie->appl_base + APPL_DEBUG,
1616						data,
1617						((data &
1618						APPL_DEBUG_LTSSM_STATE_MASK) >>
1619						APPL_DEBUG_LTSSM_STATE_SHIFT) ==
1620						LTSSM_STATE_PRE_DETECT,
1621						1, LTSSM_TIMEOUT);
1622		if (err)
1623			dev_info(pcie->dev, "Link didn't go to detect state\n");
 
 
 
 
 
 
1624	}
1625	/*
1626	 * DBI registers may not be accessible after this as PLL-E would be
1627	 * down depending on how CLKREQ is pulled by end point
1628	 */
1629	data = appl_readl(pcie, APPL_PINMUX);
1630	data |= (APPL_PINMUX_CLKREQ_OVERRIDE_EN | APPL_PINMUX_CLKREQ_OVERRIDE);
1631	/* Cut REFCLK to slot */
1632	data |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN;
1633	data &= ~APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE;
1634	appl_writel(pcie, data, APPL_PINMUX);
1635}
1636
1637static void tegra_pcie_deinit_controller(struct tegra_pcie_dw *pcie)
1638{
1639	tegra_pcie_downstream_dev_to_D0(pcie);
1640	dw_pcie_host_deinit(&pcie->pci.pp);
1641	tegra_pcie_dw_pme_turnoff(pcie);
1642	tegra_pcie_unconfig_controller(pcie);
 
1643}
1644
1645static int tegra_pcie_config_rp(struct tegra_pcie_dw *pcie)
1646{
 
1647	struct device *dev = pcie->dev;
1648	char *name;
1649	int ret;
1650
 
 
 
 
 
 
 
 
1651	pm_runtime_enable(dev);
1652
1653	ret = pm_runtime_get_sync(dev);
1654	if (ret < 0) {
1655		dev_err(dev, "Failed to get runtime sync for PCIe dev: %d\n",
1656			ret);
1657		goto fail_pm_get_sync;
1658	}
1659
1660	ret = pinctrl_pm_select_default_state(dev);
1661	if (ret < 0) {
1662		dev_err(dev, "Failed to configure sideband pins: %d\n", ret);
1663		goto fail_pm_get_sync;
1664	}
1665
1666	ret = tegra_pcie_init_controller(pcie);
1667	if (ret < 0) {
1668		dev_err(dev, "Failed to initialize controller: %d\n", ret);
1669		goto fail_pm_get_sync;
1670	}
1671
1672	pcie->link_state = tegra_pcie_dw_link_up(&pcie->pci);
1673	if (!pcie->link_state) {
1674		ret = -ENOMEDIUM;
1675		goto fail_host_init;
1676	}
1677
1678	name = devm_kasprintf(dev, GFP_KERNEL, "%pOFP", dev->of_node);
1679	if (!name) {
1680		ret = -ENOMEM;
1681		goto fail_host_init;
1682	}
1683
1684	pcie->debugfs = debugfs_create_dir(name, NULL);
1685	init_debugfs(pcie);
 
 
 
1686
1687	return ret;
1688
1689fail_host_init:
1690	tegra_pcie_deinit_controller(pcie);
1691fail_pm_get_sync:
1692	pm_runtime_put_sync(dev);
 
1693	pm_runtime_disable(dev);
1694	return ret;
1695}
1696
1697static void pex_ep_event_pex_rst_assert(struct tegra_pcie_dw *pcie)
1698{
1699	u32 val;
1700	int ret;
1701
1702	if (pcie->ep_state == EP_STATE_DISABLED)
1703		return;
1704
1705	/* Disable LTSSM */
1706	val = appl_readl(pcie, APPL_CTRL);
1707	val &= ~APPL_CTRL_LTSSM_EN;
1708	appl_writel(pcie, val, APPL_CTRL);
1709
1710	ret = readl_poll_timeout(pcie->appl_base + APPL_DEBUG, val,
1711				 ((val & APPL_DEBUG_LTSSM_STATE_MASK) >>
1712				 APPL_DEBUG_LTSSM_STATE_SHIFT) ==
1713				 LTSSM_STATE_PRE_DETECT,
1714				 1, LTSSM_TIMEOUT);
1715	if (ret)
1716		dev_err(pcie->dev, "Failed to go Detect state: %d\n", ret);
1717
1718	reset_control_assert(pcie->core_rst);
1719
1720	tegra_pcie_disable_phy(pcie);
1721
1722	reset_control_assert(pcie->core_apb_rst);
1723
1724	clk_disable_unprepare(pcie->core_clk);
1725
1726	pm_runtime_put_sync(pcie->dev);
1727
1728	if (pcie->enable_ext_refclk) {
1729		ret = tegra_pcie_bpmp_set_pll_state(pcie, false);
1730		if (ret)
1731			dev_err(pcie->dev, "Failed to turn off UPHY: %d\n",
1732				ret);
1733	}
1734
1735	ret = tegra_pcie_bpmp_set_pll_state(pcie, false);
1736	if (ret)
1737		dev_err(pcie->dev, "Failed to turn off UPHY: %d\n", ret);
1738
1739	pcie->ep_state = EP_STATE_DISABLED;
1740	dev_dbg(pcie->dev, "Uninitialization of endpoint is completed\n");
1741}
1742
1743static void pex_ep_event_pex_rst_deassert(struct tegra_pcie_dw *pcie)
1744{
1745	struct dw_pcie *pci = &pcie->pci;
1746	struct dw_pcie_ep *ep = &pci->ep;
1747	struct device *dev = pcie->dev;
1748	u32 val;
1749	int ret;
1750	u16 val_16;
1751
1752	if (pcie->ep_state == EP_STATE_ENABLED)
1753		return;
1754
1755	ret = pm_runtime_resume_and_get(dev);
1756	if (ret < 0) {
1757		dev_err(dev, "Failed to get runtime sync for PCIe dev: %d\n",
1758			ret);
1759		return;
1760	}
1761
1762	ret = tegra_pcie_bpmp_set_ctrl_state(pcie, true);
1763	if (ret) {
1764		dev_err(pcie->dev, "Failed to enable controller %u: %d\n",
1765			pcie->cid, ret);
1766		goto fail_set_ctrl_state;
1767	}
1768
1769	if (pcie->enable_ext_refclk) {
1770		ret = tegra_pcie_bpmp_set_pll_state(pcie, true);
1771		if (ret) {
1772			dev_err(dev, "Failed to init UPHY for PCIe EP: %d\n",
1773				ret);
1774			goto fail_pll_init;
1775		}
1776	}
1777
1778	ret = clk_prepare_enable(pcie->core_clk);
1779	if (ret) {
1780		dev_err(dev, "Failed to enable core clock: %d\n", ret);
1781		goto fail_core_clk_enable;
1782	}
1783
1784	ret = reset_control_deassert(pcie->core_apb_rst);
1785	if (ret) {
1786		dev_err(dev, "Failed to deassert core APB reset: %d\n", ret);
1787		goto fail_core_apb_rst;
1788	}
1789
1790	ret = tegra_pcie_enable_phy(pcie);
1791	if (ret) {
1792		dev_err(dev, "Failed to enable PHY: %d\n", ret);
1793		goto fail_phy;
1794	}
1795
1796	/* Clear any stale interrupt statuses */
1797	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L0);
1798	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_0_0);
1799	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_1);
1800	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_2);
1801	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_3);
1802	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_6);
1803	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_7);
1804	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_8_0);
1805	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_9);
1806	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_10);
1807	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_11);
1808	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_13);
1809	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_14);
1810	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_15);
1811	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_17);
1812
1813	/* configure this core for EP mode operation */
1814	val = appl_readl(pcie, APPL_DM_TYPE);
1815	val &= ~APPL_DM_TYPE_MASK;
1816	val |= APPL_DM_TYPE_EP;
1817	appl_writel(pcie, val, APPL_DM_TYPE);
1818
1819	appl_writel(pcie, 0x0, APPL_CFG_SLCG_OVERRIDE);
1820
1821	val = appl_readl(pcie, APPL_CTRL);
1822	val |= APPL_CTRL_SYS_PRE_DET_STATE;
1823	val |= APPL_CTRL_HW_HOT_RST_EN;
1824	appl_writel(pcie, val, APPL_CTRL);
1825
1826	val = appl_readl(pcie, APPL_CFG_MISC);
1827	val |= APPL_CFG_MISC_SLV_EP_MODE;
1828	val |= (APPL_CFG_MISC_ARCACHE_VAL << APPL_CFG_MISC_ARCACHE_SHIFT);
1829	appl_writel(pcie, val, APPL_CFG_MISC);
1830
1831	val = appl_readl(pcie, APPL_PINMUX);
1832	val |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN;
1833	val |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE;
1834	appl_writel(pcie, val, APPL_PINMUX);
1835
1836	appl_writel(pcie, pcie->dbi_res->start & APPL_CFG_BASE_ADDR_MASK,
1837		    APPL_CFG_BASE_ADDR);
1838
1839	appl_writel(pcie, pcie->atu_dma_res->start &
1840		    APPL_CFG_IATU_DMA_BASE_ADDR_MASK,
1841		    APPL_CFG_IATU_DMA_BASE_ADDR);
1842
1843	val = appl_readl(pcie, APPL_INTR_EN_L0_0);
1844	val |= APPL_INTR_EN_L0_0_SYS_INTR_EN;
1845	val |= APPL_INTR_EN_L0_0_LINK_STATE_INT_EN;
1846	val |= APPL_INTR_EN_L0_0_PCI_CMD_EN_INT_EN;
1847	appl_writel(pcie, val, APPL_INTR_EN_L0_0);
1848
1849	val = appl_readl(pcie, APPL_INTR_EN_L1_0_0);
1850	val |= APPL_INTR_EN_L1_0_0_HOT_RESET_DONE_INT_EN;
1851	val |= APPL_INTR_EN_L1_0_0_RDLH_LINK_UP_INT_EN;
1852	appl_writel(pcie, val, APPL_INTR_EN_L1_0_0);
1853
1854	reset_control_deassert(pcie->core_rst);
1855
1856	if (pcie->update_fc_fixup) {
1857		val = dw_pcie_readl_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF);
1858		val |= 0x1 << CFG_TIMER_CTRL_ACK_NAK_SHIFT;
1859		dw_pcie_writel_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF, val);
1860	}
1861
1862	config_gen3_gen4_eq_presets(pcie);
1863
1864	init_host_aspm(pcie);
1865
1866	/* Disable ASPM-L1SS advertisement if there is no CLKREQ routing */
1867	if (!pcie->supports_clkreq) {
1868		disable_aspm_l11(pcie);
1869		disable_aspm_l12(pcie);
1870	}
1871
1872	if (!pcie->of_data->has_l1ss_exit_fix) {
1873		val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
1874		val &= ~GEN3_RELATED_OFF_GEN3_ZRXDC_NONCOMPL;
1875		dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
1876	}
1877
1878	pcie->pcie_cap_base = dw_pcie_find_capability(&pcie->pci,
1879						      PCI_CAP_ID_EXP);
1880
1881	/* Clear Slot Clock Configuration bit if SRNS configuration */
1882	if (pcie->enable_srns) {
1883		val_16 = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
1884					   PCI_EXP_LNKSTA);
1885		val_16 &= ~PCI_EXP_LNKSTA_SLC;
1886		dw_pcie_writew_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA,
1887				   val_16);
1888	}
1889
1890	clk_set_rate(pcie->core_clk, GEN4_CORE_CLK_FREQ);
1891
1892	val = (ep->msi_mem_phys & MSIX_ADDR_MATCH_LOW_OFF_MASK);
1893	val |= MSIX_ADDR_MATCH_LOW_OFF_EN;
1894	dw_pcie_writel_dbi(pci, MSIX_ADDR_MATCH_LOW_OFF, val);
1895	val = (upper_32_bits(ep->msi_mem_phys) & MSIX_ADDR_MATCH_HIGH_OFF_MASK);
1896	dw_pcie_writel_dbi(pci, MSIX_ADDR_MATCH_HIGH_OFF, val);
1897
1898	ret = dw_pcie_ep_init_complete(ep);
1899	if (ret) {
1900		dev_err(dev, "Failed to complete initialization: %d\n", ret);
1901		goto fail_init_complete;
1902	}
1903
1904	dw_pcie_ep_init_notify(ep);
1905
1906	/* Program the private control to allow sending LTR upstream */
1907	if (pcie->of_data->has_ltr_req_fix) {
1908		val = appl_readl(pcie, APPL_LTR_MSG_2);
1909		val |= APPL_LTR_MSG_2_LTR_MSG_REQ_STATE;
1910		appl_writel(pcie, val, APPL_LTR_MSG_2);
1911	}
1912
1913	/* Enable LTSSM */
1914	val = appl_readl(pcie, APPL_CTRL);
1915	val |= APPL_CTRL_LTSSM_EN;
1916	appl_writel(pcie, val, APPL_CTRL);
1917
1918	pcie->ep_state = EP_STATE_ENABLED;
1919	dev_dbg(dev, "Initialization of endpoint is completed\n");
1920
1921	return;
1922
1923fail_init_complete:
1924	reset_control_assert(pcie->core_rst);
1925	tegra_pcie_disable_phy(pcie);
1926fail_phy:
1927	reset_control_assert(pcie->core_apb_rst);
1928fail_core_apb_rst:
1929	clk_disable_unprepare(pcie->core_clk);
1930fail_core_clk_enable:
1931	tegra_pcie_bpmp_set_pll_state(pcie, false);
1932fail_pll_init:
1933	tegra_pcie_bpmp_set_ctrl_state(pcie, false);
1934fail_set_ctrl_state:
1935	pm_runtime_put_sync(dev);
1936}
1937
1938static irqreturn_t tegra_pcie_ep_pex_rst_irq(int irq, void *arg)
1939{
1940	struct tegra_pcie_dw *pcie = arg;
1941
1942	if (gpiod_get_value(pcie->pex_rst_gpiod))
1943		pex_ep_event_pex_rst_assert(pcie);
1944	else
1945		pex_ep_event_pex_rst_deassert(pcie);
1946
1947	return IRQ_HANDLED;
1948}
1949
1950static int tegra_pcie_ep_raise_intx_irq(struct tegra_pcie_dw *pcie, u16 irq)
1951{
1952	/* Tegra194 supports only INTA */
1953	if (irq > 1)
1954		return -EINVAL;
1955
1956	appl_writel(pcie, 1, APPL_LEGACY_INTX);
1957	usleep_range(1000, 2000);
1958	appl_writel(pcie, 0, APPL_LEGACY_INTX);
1959	return 0;
1960}
1961
1962static int tegra_pcie_ep_raise_msi_irq(struct tegra_pcie_dw *pcie, u16 irq)
1963{
1964	if (unlikely(irq > 31))
1965		return -EINVAL;
1966
1967	appl_writel(pcie, BIT(irq), APPL_MSI_CTRL_1);
1968
1969	return 0;
1970}
1971
1972static int tegra_pcie_ep_raise_msix_irq(struct tegra_pcie_dw *pcie, u16 irq)
1973{
1974	struct dw_pcie_ep *ep = &pcie->pci.ep;
1975
1976	writel(irq, ep->msi_mem);
1977
1978	return 0;
1979}
1980
1981static int tegra_pcie_ep_raise_irq(struct dw_pcie_ep *ep, u8 func_no,
1982				   unsigned int type, u16 interrupt_num)
1983{
1984	struct dw_pcie *pci = to_dw_pcie_from_ep(ep);
1985	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
1986
1987	switch (type) {
1988	case PCI_IRQ_INTX:
1989		return tegra_pcie_ep_raise_intx_irq(pcie, interrupt_num);
1990
1991	case PCI_IRQ_MSI:
1992		return tegra_pcie_ep_raise_msi_irq(pcie, interrupt_num);
1993
1994	case PCI_IRQ_MSIX:
1995		return tegra_pcie_ep_raise_msix_irq(pcie, interrupt_num);
1996
1997	default:
1998		dev_err(pci->dev, "Unknown IRQ type\n");
1999		return -EPERM;
2000	}
2001
2002	return 0;
2003}
2004
2005static const struct pci_epc_features tegra_pcie_epc_features = {
2006	.linkup_notifier = true,
2007	.core_init_notifier = true,
2008	.msi_capable = false,
2009	.msix_capable = false,
2010	.reserved_bar = 1 << BAR_2 | 1 << BAR_3 | 1 << BAR_4 | 1 << BAR_5,
2011	.bar_fixed_64bit = 1 << BAR_0,
2012	.bar_fixed_size[0] = SZ_1M,
2013};
2014
2015static const struct pci_epc_features*
2016tegra_pcie_ep_get_features(struct dw_pcie_ep *ep)
2017{
2018	return &tegra_pcie_epc_features;
2019}
2020
2021static const struct dw_pcie_ep_ops pcie_ep_ops = {
2022	.raise_irq = tegra_pcie_ep_raise_irq,
2023	.get_features = tegra_pcie_ep_get_features,
2024};
2025
2026static int tegra_pcie_config_ep(struct tegra_pcie_dw *pcie,
2027				struct platform_device *pdev)
2028{
2029	struct dw_pcie *pci = &pcie->pci;
2030	struct device *dev = pcie->dev;
2031	struct dw_pcie_ep *ep;
2032	char *name;
2033	int ret;
2034
2035	ep = &pci->ep;
2036	ep->ops = &pcie_ep_ops;
2037
2038	ep->page_size = SZ_64K;
2039
2040	ret = gpiod_set_debounce(pcie->pex_rst_gpiod, PERST_DEBOUNCE_TIME);
2041	if (ret < 0) {
2042		dev_err(dev, "Failed to set PERST GPIO debounce time: %d\n",
2043			ret);
2044		return ret;
2045	}
2046
2047	ret = gpiod_to_irq(pcie->pex_rst_gpiod);
2048	if (ret < 0) {
2049		dev_err(dev, "Failed to get IRQ for PERST GPIO: %d\n", ret);
2050		return ret;
2051	}
2052	pcie->pex_rst_irq = (unsigned int)ret;
2053
2054	name = devm_kasprintf(dev, GFP_KERNEL, "tegra_pcie_%u_pex_rst_irq",
2055			      pcie->cid);
2056	if (!name) {
2057		dev_err(dev, "Failed to create PERST IRQ string\n");
2058		return -ENOMEM;
2059	}
2060
2061	irq_set_status_flags(pcie->pex_rst_irq, IRQ_NOAUTOEN);
2062
2063	pcie->ep_state = EP_STATE_DISABLED;
2064
2065	ret = devm_request_threaded_irq(dev, pcie->pex_rst_irq, NULL,
2066					tegra_pcie_ep_pex_rst_irq,
2067					IRQF_TRIGGER_RISING |
2068					IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
2069					name, (void *)pcie);
2070	if (ret < 0) {
2071		dev_err(dev, "Failed to request IRQ for PERST: %d\n", ret);
2072		return ret;
2073	}
2074
2075	pm_runtime_enable(dev);
2076
2077	ret = dw_pcie_ep_init(ep);
2078	if (ret) {
2079		dev_err(dev, "Failed to initialize DWC Endpoint subsystem: %d\n",
2080			ret);
2081		pm_runtime_disable(dev);
2082		return ret;
2083	}
2084
2085	return 0;
2086}
2087
2088static int tegra_pcie_dw_probe(struct platform_device *pdev)
2089{
2090	const struct tegra_pcie_dw_of_data *data;
2091	struct device *dev = &pdev->dev;
2092	struct resource *atu_dma_res;
2093	struct tegra_pcie_dw *pcie;
2094	struct dw_pcie_rp *pp;
 
2095	struct dw_pcie *pci;
2096	struct phy **phys;
2097	char *name;
2098	int ret;
2099	u32 i;
2100
2101	data = of_device_get_match_data(dev);
2102
2103	pcie = devm_kzalloc(dev, sizeof(*pcie), GFP_KERNEL);
2104	if (!pcie)
2105		return -ENOMEM;
2106
2107	pci = &pcie->pci;
2108	pci->dev = &pdev->dev;
2109	pci->ops = &tegra_dw_pcie_ops;
2110	pcie->dev = &pdev->dev;
2111	pcie->of_data = (struct tegra_pcie_dw_of_data *)data;
2112	pci->n_fts[0] = pcie->of_data->n_fts[0];
2113	pci->n_fts[1] = pcie->of_data->n_fts[1];
2114	pp = &pci->pp;
2115	pp->num_vectors = MAX_MSI_IRQS;
2116
2117	ret = tegra_pcie_dw_parse_dt(pcie);
2118	if (ret < 0) {
2119		const char *level = KERN_ERR;
2120
2121		if (ret == -EPROBE_DEFER)
2122			level = KERN_DEBUG;
2123
2124		dev_printk(level, dev,
2125			   dev_fmt("Failed to parse device tree: %d\n"),
2126			   ret);
2127		return ret;
2128	}
2129
2130	ret = tegra_pcie_get_slot_regulators(pcie);
2131	if (ret < 0) {
2132		const char *level = KERN_ERR;
2133
2134		if (ret == -EPROBE_DEFER)
2135			level = KERN_DEBUG;
2136
2137		dev_printk(level, dev,
2138			   dev_fmt("Failed to get slot regulators: %d\n"),
2139			   ret);
2140		return ret;
2141	}
2142
2143	if (pcie->pex_refclk_sel_gpiod)
2144		gpiod_set_value(pcie->pex_refclk_sel_gpiod, 1);
2145
2146	pcie->pex_ctl_supply = devm_regulator_get(dev, "vddio-pex-ctl");
2147	if (IS_ERR(pcie->pex_ctl_supply)) {
2148		ret = PTR_ERR(pcie->pex_ctl_supply);
2149		if (ret != -EPROBE_DEFER)
2150			dev_err(dev, "Failed to get regulator: %ld\n",
2151				PTR_ERR(pcie->pex_ctl_supply));
2152		return ret;
2153	}
2154
2155	pcie->core_clk = devm_clk_get(dev, "core");
2156	if (IS_ERR(pcie->core_clk)) {
2157		dev_err(dev, "Failed to get core clock: %ld\n",
2158			PTR_ERR(pcie->core_clk));
2159		return PTR_ERR(pcie->core_clk);
2160	}
2161
2162	pcie->appl_res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
2163						      "appl");
2164	if (!pcie->appl_res) {
2165		dev_err(dev, "Failed to find \"appl\" region\n");
2166		return -ENODEV;
2167	}
2168
2169	pcie->appl_base = devm_ioremap_resource(dev, pcie->appl_res);
2170	if (IS_ERR(pcie->appl_base))
2171		return PTR_ERR(pcie->appl_base);
2172
2173	pcie->core_apb_rst = devm_reset_control_get(dev, "apb");
2174	if (IS_ERR(pcie->core_apb_rst)) {
2175		dev_err(dev, "Failed to get APB reset: %ld\n",
2176			PTR_ERR(pcie->core_apb_rst));
2177		return PTR_ERR(pcie->core_apb_rst);
2178	}
2179
2180	phys = devm_kcalloc(dev, pcie->phy_count, sizeof(*phys), GFP_KERNEL);
2181	if (!phys)
2182		return -ENOMEM;
2183
2184	for (i = 0; i < pcie->phy_count; i++) {
2185		name = kasprintf(GFP_KERNEL, "p2u-%u", i);
2186		if (!name) {
2187			dev_err(dev, "Failed to create P2U string\n");
2188			return -ENOMEM;
2189		}
2190		phys[i] = devm_phy_get(dev, name);
2191		kfree(name);
2192		if (IS_ERR(phys[i])) {
2193			ret = PTR_ERR(phys[i]);
2194			if (ret != -EPROBE_DEFER)
2195				dev_err(dev, "Failed to get PHY: %d\n", ret);
2196			return ret;
2197		}
2198	}
2199
2200	pcie->phys = phys;
2201
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2202	atu_dma_res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
2203						   "atu_dma");
2204	if (!atu_dma_res) {
2205		dev_err(dev, "Failed to find \"atu_dma\" region\n");
2206		return -ENODEV;
2207	}
2208	pcie->atu_dma_res = atu_dma_res;
2209
2210	pci->atu_size = resource_size(atu_dma_res);
2211	pci->atu_base = devm_ioremap_resource(dev, atu_dma_res);
2212	if (IS_ERR(pci->atu_base))
2213		return PTR_ERR(pci->atu_base);
2214
2215	pcie->core_rst = devm_reset_control_get(dev, "core");
2216	if (IS_ERR(pcie->core_rst)) {
2217		dev_err(dev, "Failed to get core reset: %ld\n",
2218			PTR_ERR(pcie->core_rst));
2219		return PTR_ERR(pcie->core_rst);
2220	}
2221
2222	pp->irq = platform_get_irq_byname(pdev, "intr");
2223	if (pp->irq < 0)
2224		return pp->irq;
2225
2226	pcie->bpmp = tegra_bpmp_get(dev);
2227	if (IS_ERR(pcie->bpmp))
2228		return PTR_ERR(pcie->bpmp);
2229
2230	platform_set_drvdata(pdev, pcie);
2231
2232	pcie->icc_path = devm_of_icc_get(&pdev->dev, "write");
2233	ret = PTR_ERR_OR_ZERO(pcie->icc_path);
2234	if (ret) {
2235		tegra_bpmp_put(pcie->bpmp);
2236		dev_err_probe(&pdev->dev, ret, "failed to get write interconnect\n");
2237		return ret;
2238	}
2239
2240	switch (pcie->of_data->mode) {
2241	case DW_PCIE_RC_TYPE:
2242		ret = devm_request_irq(dev, pp->irq, tegra_pcie_rp_irq_handler,
2243				       IRQF_SHARED, "tegra-pcie-intr", pcie);
2244		if (ret) {
2245			dev_err(dev, "Failed to request IRQ %d: %d\n", pp->irq,
2246				ret);
2247			goto fail;
2248		}
2249
2250		ret = tegra_pcie_config_rp(pcie);
2251		if (ret && ret != -ENOMEDIUM)
2252			goto fail;
2253		else
2254			return 0;
2255		break;
2256
2257	case DW_PCIE_EP_TYPE:
2258		ret = devm_request_threaded_irq(dev, pp->irq,
2259						tegra_pcie_ep_hard_irq,
2260						tegra_pcie_ep_irq_thread,
2261						IRQF_SHARED | IRQF_ONESHOT,
2262						"tegra-pcie-ep-intr", pcie);
2263		if (ret) {
2264			dev_err(dev, "Failed to request IRQ %d: %d\n", pp->irq,
2265				ret);
2266			goto fail;
2267		}
2268
2269		ret = tegra_pcie_config_ep(pcie, pdev);
2270		if (ret < 0)
2271			goto fail;
2272		break;
2273
2274	default:
2275		dev_err(dev, "Invalid PCIe device type %d\n",
2276			pcie->of_data->mode);
2277	}
 
2278
2279fail:
2280	tegra_bpmp_put(pcie->bpmp);
2281	return ret;
2282}
2283
2284static void tegra_pcie_dw_remove(struct platform_device *pdev)
2285{
2286	struct tegra_pcie_dw *pcie = platform_get_drvdata(pdev);
2287
2288	if (pcie->of_data->mode == DW_PCIE_RC_TYPE) {
2289		if (!pcie->link_state)
2290			return;
2291
2292		debugfs_remove_recursive(pcie->debugfs);
2293		tegra_pcie_deinit_controller(pcie);
2294		pm_runtime_put_sync(pcie->dev);
2295	} else {
2296		disable_irq(pcie->pex_rst_irq);
2297		pex_ep_event_pex_rst_assert(pcie);
2298	}
2299
 
 
 
2300	pm_runtime_disable(pcie->dev);
2301	tegra_bpmp_put(pcie->bpmp);
2302	if (pcie->pex_refclk_sel_gpiod)
2303		gpiod_set_value(pcie->pex_refclk_sel_gpiod, 0);
2304}
2305
2306static int tegra_pcie_dw_suspend_late(struct device *dev)
2307{
2308	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
2309	u32 val;
2310
2311	if (pcie->of_data->mode == DW_PCIE_EP_TYPE) {
2312		dev_err(dev, "Failed to Suspend as Tegra PCIe is in EP mode\n");
2313		return -EPERM;
2314	}
2315
2316	if (!pcie->link_state)
2317		return 0;
2318
2319	/* Enable HW_HOT_RST mode */
2320	if (!pcie->of_data->has_sbr_reset_fix) {
2321		val = appl_readl(pcie, APPL_CTRL);
2322		val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK <<
2323			 APPL_CTRL_HW_HOT_RST_MODE_SHIFT);
2324		val |= APPL_CTRL_HW_HOT_RST_EN;
2325		appl_writel(pcie, val, APPL_CTRL);
2326	}
2327
2328	return 0;
2329}
2330
2331static int tegra_pcie_dw_suspend_noirq(struct device *dev)
2332{
2333	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
2334
2335	if (!pcie->link_state)
2336		return 0;
2337
 
 
 
2338	tegra_pcie_downstream_dev_to_D0(pcie);
2339	tegra_pcie_dw_pme_turnoff(pcie);
2340	tegra_pcie_unconfig_controller(pcie);
2341
2342	return 0;
2343}
2344
2345static int tegra_pcie_dw_resume_noirq(struct device *dev)
2346{
2347	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
2348	int ret;
2349
2350	if (!pcie->link_state)
2351		return 0;
2352
2353	ret = tegra_pcie_config_controller(pcie, true);
2354	if (ret < 0)
2355		return ret;
2356
2357	ret = tegra_pcie_dw_host_init(&pcie->pci.pp);
2358	if (ret < 0) {
2359		dev_err(dev, "Failed to init host: %d\n", ret);
2360		goto fail_host_init;
2361	}
2362
2363	dw_pcie_setup_rc(&pcie->pci.pp);
2364
2365	ret = tegra_pcie_dw_start_link(&pcie->pci);
2366	if (ret < 0)
2367		goto fail_host_init;
2368
2369	return 0;
2370
2371fail_host_init:
2372	tegra_pcie_unconfig_controller(pcie);
2373	return ret;
2374}
2375
2376static int tegra_pcie_dw_resume_early(struct device *dev)
2377{
2378	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
2379	u32 val;
2380
2381	if (pcie->of_data->mode == DW_PCIE_EP_TYPE) {
2382		dev_err(dev, "Suspend is not supported in EP mode");
2383		return -ENOTSUPP;
2384	}
2385
2386	if (!pcie->link_state)
2387		return 0;
2388
2389	/* Disable HW_HOT_RST mode */
2390	if (!pcie->of_data->has_sbr_reset_fix) {
2391		val = appl_readl(pcie, APPL_CTRL);
2392		val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK <<
2393			 APPL_CTRL_HW_HOT_RST_MODE_SHIFT);
2394		val |= APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST <<
2395		       APPL_CTRL_HW_HOT_RST_MODE_SHIFT;
2396		val &= ~APPL_CTRL_HW_HOT_RST_EN;
2397		appl_writel(pcie, val, APPL_CTRL);
2398	}
2399
2400	return 0;
2401}
2402
2403static void tegra_pcie_dw_shutdown(struct platform_device *pdev)
2404{
2405	struct tegra_pcie_dw *pcie = platform_get_drvdata(pdev);
2406
2407	if (pcie->of_data->mode == DW_PCIE_RC_TYPE) {
2408		if (!pcie->link_state)
2409			return;
2410
2411		debugfs_remove_recursive(pcie->debugfs);
2412		tegra_pcie_downstream_dev_to_D0(pcie);
2413
2414		disable_irq(pcie->pci.pp.irq);
2415		if (IS_ENABLED(CONFIG_PCI_MSI))
2416			disable_irq(pcie->pci.pp.msi_irq[0]);
2417
2418		tegra_pcie_dw_pme_turnoff(pcie);
2419		tegra_pcie_unconfig_controller(pcie);
2420		pm_runtime_put_sync(pcie->dev);
2421	} else {
2422		disable_irq(pcie->pex_rst_irq);
2423		pex_ep_event_pex_rst_assert(pcie);
2424	}
2425}
2426
2427static const struct tegra_pcie_dw_of_data tegra194_pcie_dw_rc_of_data = {
2428	.version = TEGRA194_DWC_IP_VER,
2429	.mode = DW_PCIE_RC_TYPE,
2430	.cdm_chk_int_en_bit = BIT(19),
2431	/* Gen4 - 5, 6, 8 and 9 presets enabled */
2432	.gen4_preset_vec = 0x360,
2433	.n_fts = { 52, 52 },
2434};
2435
2436static const struct tegra_pcie_dw_of_data tegra194_pcie_dw_ep_of_data = {
2437	.version = TEGRA194_DWC_IP_VER,
2438	.mode = DW_PCIE_EP_TYPE,
2439	.cdm_chk_int_en_bit = BIT(19),
2440	/* Gen4 - 5, 6, 8 and 9 presets enabled */
2441	.gen4_preset_vec = 0x360,
2442	.n_fts = { 52, 52 },
2443};
2444
2445static const struct tegra_pcie_dw_of_data tegra234_pcie_dw_rc_of_data = {
2446	.version = TEGRA234_DWC_IP_VER,
2447	.mode = DW_PCIE_RC_TYPE,
2448	.has_msix_doorbell_access_fix = true,
2449	.has_sbr_reset_fix = true,
2450	.has_l1ss_exit_fix = true,
2451	.cdm_chk_int_en_bit = BIT(18),
2452	/* Gen4 - 6, 8 and 9 presets enabled */
2453	.gen4_preset_vec = 0x340,
2454	.n_fts = { 52, 80 },
2455};
2456
2457static const struct tegra_pcie_dw_of_data tegra234_pcie_dw_ep_of_data = {
2458	.version = TEGRA234_DWC_IP_VER,
2459	.mode = DW_PCIE_EP_TYPE,
2460	.has_l1ss_exit_fix = true,
2461	.has_ltr_req_fix = true,
2462	.cdm_chk_int_en_bit = BIT(18),
2463	/* Gen4 - 6, 8 and 9 presets enabled */
2464	.gen4_preset_vec = 0x340,
2465	.n_fts = { 52, 80 },
2466};
2467
2468static const struct of_device_id tegra_pcie_dw_of_match[] = {
2469	{
2470		.compatible = "nvidia,tegra194-pcie",
2471		.data = &tegra194_pcie_dw_rc_of_data,
2472	},
2473	{
2474		.compatible = "nvidia,tegra194-pcie-ep",
2475		.data = &tegra194_pcie_dw_ep_of_data,
2476	},
2477	{
2478		.compatible = "nvidia,tegra234-pcie",
2479		.data = &tegra234_pcie_dw_rc_of_data,
2480	},
2481	{
2482		.compatible = "nvidia,tegra234-pcie-ep",
2483		.data = &tegra234_pcie_dw_ep_of_data,
2484	},
2485	{}
2486};
2487
2488static const struct dev_pm_ops tegra_pcie_dw_pm_ops = {
2489	.suspend_late = tegra_pcie_dw_suspend_late,
2490	.suspend_noirq = tegra_pcie_dw_suspend_noirq,
2491	.resume_noirq = tegra_pcie_dw_resume_noirq,
2492	.resume_early = tegra_pcie_dw_resume_early,
2493};
2494
2495static struct platform_driver tegra_pcie_dw_driver = {
2496	.probe = tegra_pcie_dw_probe,
2497	.remove_new = tegra_pcie_dw_remove,
2498	.shutdown = tegra_pcie_dw_shutdown,
2499	.driver = {
2500		.name	= "tegra194-pcie",
2501		.pm = &tegra_pcie_dw_pm_ops,
2502		.of_match_table = tegra_pcie_dw_of_match,
2503	},
2504};
2505module_platform_driver(tegra_pcie_dw_driver);
2506
2507MODULE_DEVICE_TABLE(of, tegra_pcie_dw_of_match);
2508
2509MODULE_AUTHOR("Vidya Sagar <vidyas@nvidia.com>");
2510MODULE_DESCRIPTION("NVIDIA PCIe host controller driver");
2511MODULE_LICENSE("GPL v2");
v5.4
   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * PCIe host controller driver for Tegra194 SoC
 
 
   4 *
   5 * Copyright (C) 2019 NVIDIA Corporation.
   6 *
   7 * Author: Vidya Sagar <vidyas@nvidia.com>
   8 */
   9
 
  10#include <linux/clk.h>
  11#include <linux/debugfs.h>
  12#include <linux/delay.h>
  13#include <linux/gpio.h>
 
 
  14#include <linux/interrupt.h>
  15#include <linux/iopoll.h>
  16#include <linux/kernel.h>
  17#include <linux/module.h>
  18#include <linux/of.h>
  19#include <linux/of_device.h>
  20#include <linux/of_gpio.h>
  21#include <linux/of_irq.h>
  22#include <linux/of_pci.h>
  23#include <linux/pci.h>
  24#include <linux/phy/phy.h>
  25#include <linux/pinctrl/consumer.h>
  26#include <linux/platform_device.h>
  27#include <linux/pm_runtime.h>
  28#include <linux/random.h>
  29#include <linux/reset.h>
  30#include <linux/resource.h>
  31#include <linux/types.h>
  32#include "pcie-designware.h"
  33#include <soc/tegra/bpmp.h>
  34#include <soc/tegra/bpmp-abi.h>
  35#include "../../pci.h"
  36
 
 
 
  37#define APPL_PINMUX				0x0
  38#define APPL_PINMUX_PEX_RST			BIT(0)
  39#define APPL_PINMUX_CLKREQ_OVERRIDE_EN		BIT(2)
  40#define APPL_PINMUX_CLKREQ_OVERRIDE		BIT(3)
  41#define APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN	BIT(4)
  42#define APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE	BIT(5)
  43#define APPL_PINMUX_CLKREQ_OUT_OVRD_EN		BIT(9)
  44#define APPL_PINMUX_CLKREQ_OUT_OVRD		BIT(10)
  45
  46#define APPL_CTRL				0x4
  47#define APPL_CTRL_SYS_PRE_DET_STATE		BIT(6)
  48#define APPL_CTRL_LTSSM_EN			BIT(7)
  49#define APPL_CTRL_HW_HOT_RST_EN			BIT(20)
  50#define APPL_CTRL_HW_HOT_RST_MODE_MASK		GENMASK(1, 0)
  51#define APPL_CTRL_HW_HOT_RST_MODE_SHIFT		22
  52#define APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST	0x1
 
  53
  54#define APPL_INTR_EN_L0_0			0x8
  55#define APPL_INTR_EN_L0_0_LINK_STATE_INT_EN	BIT(0)
  56#define APPL_INTR_EN_L0_0_MSI_RCV_INT_EN	BIT(4)
  57#define APPL_INTR_EN_L0_0_INT_INT_EN		BIT(8)
 
  58#define APPL_INTR_EN_L0_0_CDM_REG_CHK_INT_EN	BIT(19)
  59#define APPL_INTR_EN_L0_0_SYS_INTR_EN		BIT(30)
  60#define APPL_INTR_EN_L0_0_SYS_MSI_INTR_EN	BIT(31)
  61
  62#define APPL_INTR_STATUS_L0			0xC
  63#define APPL_INTR_STATUS_L0_LINK_STATE_INT	BIT(0)
  64#define APPL_INTR_STATUS_L0_INT_INT		BIT(8)
 
 
  65#define APPL_INTR_STATUS_L0_CDM_REG_CHK_INT	BIT(18)
  66
  67#define APPL_INTR_EN_L1_0_0				0x1C
  68#define APPL_INTR_EN_L1_0_0_LINK_REQ_RST_NOT_INT_EN	BIT(1)
 
 
  69
  70#define APPL_INTR_STATUS_L1_0_0				0x20
  71#define APPL_INTR_STATUS_L1_0_0_LINK_REQ_RST_NOT_CHGED	BIT(1)
 
 
  72
  73#define APPL_INTR_STATUS_L1_1			0x2C
  74#define APPL_INTR_STATUS_L1_2			0x30
  75#define APPL_INTR_STATUS_L1_3			0x34
  76#define APPL_INTR_STATUS_L1_6			0x3C
  77#define APPL_INTR_STATUS_L1_7			0x40
 
  78
  79#define APPL_INTR_EN_L1_8_0			0x44
  80#define APPL_INTR_EN_L1_8_BW_MGT_INT_EN		BIT(2)
  81#define APPL_INTR_EN_L1_8_AUTO_BW_INT_EN	BIT(3)
  82#define APPL_INTR_EN_L1_8_INTX_EN		BIT(11)
  83#define APPL_INTR_EN_L1_8_AER_INT_EN		BIT(15)
  84
  85#define APPL_INTR_STATUS_L1_8_0			0x4C
  86#define APPL_INTR_STATUS_L1_8_0_EDMA_INT_MASK	GENMASK(11, 6)
  87#define APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS	BIT(2)
  88#define APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS	BIT(3)
  89
  90#define APPL_INTR_STATUS_L1_9			0x54
  91#define APPL_INTR_STATUS_L1_10			0x58
  92#define APPL_INTR_STATUS_L1_11			0x64
  93#define APPL_INTR_STATUS_L1_13			0x74
  94#define APPL_INTR_STATUS_L1_14			0x78
  95#define APPL_INTR_STATUS_L1_15			0x7C
  96#define APPL_INTR_STATUS_L1_17			0x88
  97
  98#define APPL_INTR_EN_L1_18				0x90
  99#define APPL_INTR_EN_L1_18_CDM_REG_CHK_CMPLT		BIT(2)
 100#define APPL_INTR_EN_L1_18_CDM_REG_CHK_CMP_ERR		BIT(1)
 101#define APPL_INTR_EN_L1_18_CDM_REG_CHK_LOGIC_ERR	BIT(0)
 102
 103#define APPL_INTR_STATUS_L1_18				0x94
 104#define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMPLT	BIT(2)
 105#define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMP_ERR	BIT(1)
 106#define APPL_INTR_STATUS_L1_18_CDM_REG_CHK_LOGIC_ERR	BIT(0)
 107
 
 
 108#define APPL_MSI_CTRL_2				0xB0
 109
 
 
 110#define APPL_LTR_MSG_1				0xC4
 111#define LTR_MSG_REQ				BIT(15)
 112#define LTR_MST_NO_SNOOP_SHIFT			16
 113
 114#define APPL_LTR_MSG_2				0xC8
 115#define APPL_LTR_MSG_2_LTR_MSG_REQ_STATE	BIT(3)
 116
 117#define APPL_LINK_STATUS			0xCC
 118#define APPL_LINK_STATUS_RDLH_LINK_UP		BIT(0)
 119
 120#define APPL_DEBUG				0xD0
 121#define APPL_DEBUG_PM_LINKST_IN_L2_LAT		BIT(21)
 122#define APPL_DEBUG_PM_LINKST_IN_L0		0x11
 123#define APPL_DEBUG_LTSSM_STATE_MASK		GENMASK(8, 3)
 124#define APPL_DEBUG_LTSSM_STATE_SHIFT		3
 125#define LTSSM_STATE_PRE_DETECT			5
 126
 127#define APPL_RADM_STATUS			0xE4
 128#define APPL_PM_XMT_TURNOFF_STATE		BIT(0)
 129
 130#define APPL_DM_TYPE				0x100
 131#define APPL_DM_TYPE_MASK			GENMASK(3, 0)
 132#define APPL_DM_TYPE_RP				0x4
 133#define APPL_DM_TYPE_EP				0x0
 134
 135#define APPL_CFG_BASE_ADDR			0x104
 136#define APPL_CFG_BASE_ADDR_MASK			GENMASK(31, 12)
 137
 138#define APPL_CFG_IATU_DMA_BASE_ADDR		0x108
 139#define APPL_CFG_IATU_DMA_BASE_ADDR_MASK	GENMASK(31, 18)
 140
 141#define APPL_CFG_MISC				0x110
 142#define APPL_CFG_MISC_SLV_EP_MODE		BIT(14)
 143#define APPL_CFG_MISC_ARCACHE_MASK		GENMASK(13, 10)
 144#define APPL_CFG_MISC_ARCACHE_SHIFT		10
 145#define APPL_CFG_MISC_ARCACHE_VAL		3
 146
 147#define APPL_CFG_SLCG_OVERRIDE			0x114
 148#define APPL_CFG_SLCG_OVERRIDE_SLCG_EN_MASTER	BIT(0)
 149
 150#define APPL_CAR_RESET_OVRD				0x12C
 151#define APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N	BIT(0)
 152
 153#define IO_BASE_IO_DECODE				BIT(0)
 154#define IO_BASE_IO_DECODE_BIT8				BIT(8)
 155
 156#define CFG_PREF_MEM_LIMIT_BASE_MEM_DECODE		BIT(0)
 157#define CFG_PREF_MEM_LIMIT_BASE_MEM_LIMIT_DECODE	BIT(16)
 158
 159#define CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF	0x718
 160#define CFG_TIMER_CTRL_ACK_NAK_SHIFT	(19)
 161
 162#define EVENT_COUNTER_ALL_CLEAR		0x3
 163#define EVENT_COUNTER_ENABLE_ALL	0x7
 164#define EVENT_COUNTER_ENABLE_SHIFT	2
 165#define EVENT_COUNTER_EVENT_SEL_MASK	GENMASK(7, 0)
 166#define EVENT_COUNTER_EVENT_SEL_SHIFT	16
 167#define EVENT_COUNTER_EVENT_Tx_L0S	0x2
 168#define EVENT_COUNTER_EVENT_Rx_L0S	0x3
 169#define EVENT_COUNTER_EVENT_L1		0x5
 170#define EVENT_COUNTER_EVENT_L1_1	0x7
 171#define EVENT_COUNTER_EVENT_L1_2	0x8
 172#define EVENT_COUNTER_GROUP_SEL_SHIFT	24
 173#define EVENT_COUNTER_GROUP_5		0x5
 174
 175#define PORT_LOGIC_ACK_F_ASPM_CTRL			0x70C
 176#define ENTER_ASPM					BIT(30)
 177#define L0S_ENTRANCE_LAT_SHIFT				24
 178#define L0S_ENTRANCE_LAT_MASK				GENMASK(26, 24)
 179#define L1_ENTRANCE_LAT_SHIFT				27
 180#define L1_ENTRANCE_LAT_MASK				GENMASK(29, 27)
 181#define N_FTS_SHIFT					8
 182#define N_FTS_MASK					GENMASK(7, 0)
 183#define N_FTS_VAL					52
 184
 185#define PORT_LOGIC_GEN2_CTRL				0x80C
 186#define PORT_LOGIC_GEN2_CTRL_DIRECT_SPEED_CHANGE	BIT(17)
 187#define FTS_MASK					GENMASK(7, 0)
 188#define FTS_VAL						52
 189
 190#define PORT_LOGIC_MSI_CTRL_INT_0_EN		0x828
 191
 192#define GEN3_EQ_CONTROL_OFF			0x8a8
 193#define GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT	8
 194#define GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK	GENMASK(23, 8)
 195#define GEN3_EQ_CONTROL_OFF_FB_MODE_MASK	GENMASK(3, 0)
 196
 197#define GEN3_RELATED_OFF			0x890
 198#define GEN3_RELATED_OFF_GEN3_ZRXDC_NONCOMPL	BIT(0)
 199#define GEN3_RELATED_OFF_GEN3_EQ_DISABLE	BIT(16)
 200#define GEN3_RELATED_OFF_RATE_SHADOW_SEL_SHIFT	24
 201#define GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK	GENMASK(25, 24)
 202
 203#define PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT	0x8D0
 204#define AMBA_ERROR_RESPONSE_CRS_SHIFT		3
 205#define AMBA_ERROR_RESPONSE_CRS_MASK		GENMASK(1, 0)
 206#define AMBA_ERROR_RESPONSE_CRS_OKAY		0
 207#define AMBA_ERROR_RESPONSE_CRS_OKAY_FFFFFFFF	1
 208#define AMBA_ERROR_RESPONSE_CRS_OKAY_FFFF0001	2
 209
 
 
 
 
 
 
 
 210#define PORT_LOGIC_MSIX_DOORBELL			0x948
 211
 212#define CAP_SPCIE_CAP_OFF			0x154
 213#define CAP_SPCIE_CAP_OFF_DSP_TX_PRESET0_MASK	GENMASK(3, 0)
 214#define CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_MASK	GENMASK(11, 8)
 215#define CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_SHIFT	8
 216
 217#define PME_ACK_TIMEOUT 10000
 218
 219#define LTSSM_TIMEOUT 50000	/* 50ms */
 220
 221#define GEN3_GEN4_EQ_PRESET_INIT	5
 222
 223#define GEN1_CORE_CLK_FREQ	62500000
 224#define GEN2_CORE_CLK_FREQ	125000000
 225#define GEN3_CORE_CLK_FREQ	250000000
 226#define GEN4_CORE_CLK_FREQ	500000000
 227
 
 
 
 
 
 
 
 228static const unsigned int pcie_gen_freq[] = {
 
 229	GEN1_CORE_CLK_FREQ,
 230	GEN2_CORE_CLK_FREQ,
 231	GEN3_CORE_CLK_FREQ,
 232	GEN4_CORE_CLK_FREQ
 233};
 234
 235static const u32 event_cntr_ctrl_offset[] = {
 236	0x1d8,
 237	0x1a8,
 238	0x1a8,
 239	0x1a8,
 240	0x1c4,
 241	0x1d8
 242};
 243
 244static const u32 event_cntr_data_offset[] = {
 245	0x1dc,
 246	0x1ac,
 247	0x1ac,
 248	0x1ac,
 249	0x1c8,
 250	0x1dc
 251};
 252
 253struct tegra_pcie_dw {
 254	struct device *dev;
 255	struct resource *appl_res;
 256	struct resource *dbi_res;
 257	struct resource *atu_dma_res;
 258	void __iomem *appl_base;
 259	struct clk *core_clk;
 260	struct reset_control *core_apb_rst;
 261	struct reset_control *core_rst;
 262	struct dw_pcie pci;
 263	struct tegra_bpmp *bpmp;
 264
 
 
 265	bool supports_clkreq;
 266	bool enable_cdm_check;
 
 267	bool link_state;
 268	bool update_fc_fixup;
 
 269	u8 init_link_width;
 270	u32 msi_ctrl_int;
 271	u32 num_lanes;
 272	u32 max_speed;
 273	u32 cid;
 274	u32 cfg_link_cap_l1sub;
 
 275	u32 pcie_cap_base;
 276	u32 aspm_cmrt;
 277	u32 aspm_pwr_on_t;
 278	u32 aspm_l0s_enter_lat;
 279
 280	struct regulator *pex_ctl_supply;
 281	struct regulator *slot_ctl_3v3;
 282	struct regulator *slot_ctl_12v;
 283
 284	unsigned int phy_count;
 285	struct phy **phys;
 286
 287	struct dentry *debugfs;
 
 
 
 
 
 
 
 
 288};
 289
 290static inline struct tegra_pcie_dw *to_tegra_pcie(struct dw_pcie *pci)
 291{
 292	return container_of(pci, struct tegra_pcie_dw, pci);
 293}
 294
 295static inline void appl_writel(struct tegra_pcie_dw *pcie, const u32 value,
 296			       const u32 reg)
 297{
 298	writel_relaxed(value, pcie->appl_base + reg);
 299}
 300
 301static inline u32 appl_readl(struct tegra_pcie_dw *pcie, const u32 reg)
 302{
 303	return readl_relaxed(pcie->appl_base + reg);
 304}
 305
 306struct tegra_pcie_soc {
 307	enum dw_pcie_device_mode mode;
 308};
 309
 310static void apply_bad_link_workaround(struct pcie_port *pp)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 311{
 312	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 313	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 314	u32 current_link_width;
 315	u16 val;
 316
 317	/*
 318	 * NOTE:- Since this scenario is uncommon and link as such is not
 319	 * stable anyway, not waiting to confirm if link is really
 320	 * transitioning to Gen-2 speed
 321	 */
 322	val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA);
 323	if (val & PCI_EXP_LNKSTA_LBMS) {
 324		current_link_width = (val & PCI_EXP_LNKSTA_NLW) >>
 325				     PCI_EXP_LNKSTA_NLW_SHIFT;
 326		if (pcie->init_link_width > current_link_width) {
 327			dev_warn(pci->dev, "PCIe link is bad, width reduced\n");
 328			val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 329						PCI_EXP_LNKCTL2);
 330			val &= ~PCI_EXP_LNKCTL2_TLS;
 331			val |= PCI_EXP_LNKCTL2_TLS_2_5GT;
 332			dw_pcie_writew_dbi(pci, pcie->pcie_cap_base +
 333					   PCI_EXP_LNKCTL2, val);
 334
 335			val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 336						PCI_EXP_LNKCTL);
 337			val |= PCI_EXP_LNKCTL_RL;
 338			dw_pcie_writew_dbi(pci, pcie->pcie_cap_base +
 339					   PCI_EXP_LNKCTL, val);
 340		}
 341	}
 342}
 343
 344static irqreturn_t tegra_pcie_rp_irq_handler(struct tegra_pcie_dw *pcie)
 345{
 
 346	struct dw_pcie *pci = &pcie->pci;
 347	struct pcie_port *pp = &pci->pp;
 348	u32 val, tmp;
 349	u16 val_w;
 350
 351	val = appl_readl(pcie, APPL_INTR_STATUS_L0);
 352	if (val & APPL_INTR_STATUS_L0_LINK_STATE_INT) {
 353		val = appl_readl(pcie, APPL_INTR_STATUS_L1_0_0);
 354		if (val & APPL_INTR_STATUS_L1_0_0_LINK_REQ_RST_NOT_CHGED) {
 355			appl_writel(pcie, val, APPL_INTR_STATUS_L1_0_0);
 356
 357			/* SBR & Surprise Link Down WAR */
 358			val = appl_readl(pcie, APPL_CAR_RESET_OVRD);
 359			val &= ~APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N;
 360			appl_writel(pcie, val, APPL_CAR_RESET_OVRD);
 361			udelay(1);
 362			val = appl_readl(pcie, APPL_CAR_RESET_OVRD);
 363			val |= APPL_CAR_RESET_OVRD_CYA_OVERRIDE_CORE_RST_N;
 364			appl_writel(pcie, val, APPL_CAR_RESET_OVRD);
 365
 366			val = dw_pcie_readl_dbi(pci, PORT_LOGIC_GEN2_CTRL);
 367			val |= PORT_LOGIC_GEN2_CTRL_DIRECT_SPEED_CHANGE;
 368			dw_pcie_writel_dbi(pci, PORT_LOGIC_GEN2_CTRL, val);
 369		}
 370	}
 371
 372	if (val & APPL_INTR_STATUS_L0_INT_INT) {
 373		val = appl_readl(pcie, APPL_INTR_STATUS_L1_8_0);
 374		if (val & APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS) {
 375			appl_writel(pcie,
 376				    APPL_INTR_STATUS_L1_8_0_AUTO_BW_INT_STS,
 377				    APPL_INTR_STATUS_L1_8_0);
 378			apply_bad_link_workaround(pp);
 379		}
 380		if (val & APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS) {
 
 
 
 
 
 
 381			appl_writel(pcie,
 382				    APPL_INTR_STATUS_L1_8_0_BW_MGT_INT_STS,
 383				    APPL_INTR_STATUS_L1_8_0);
 384
 385			val_w = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base +
 386						  PCI_EXP_LNKSTA);
 387			dev_dbg(pci->dev, "Link Speed : Gen-%u\n", val_w &
 388				PCI_EXP_LNKSTA_CLS);
 389		}
 390	}
 391
 392	val = appl_readl(pcie, APPL_INTR_STATUS_L0);
 393	if (val & APPL_INTR_STATUS_L0_CDM_REG_CHK_INT) {
 394		val = appl_readl(pcie, APPL_INTR_STATUS_L1_18);
 395		tmp = dw_pcie_readl_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS);
 396		if (val & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMPLT) {
 397			dev_info(pci->dev, "CDM check complete\n");
 398			tmp |= PCIE_PL_CHK_REG_CHK_REG_COMPLETE;
 399		}
 400		if (val & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_CMP_ERR) {
 401			dev_err(pci->dev, "CDM comparison mismatch\n");
 402			tmp |= PCIE_PL_CHK_REG_CHK_REG_COMPARISON_ERROR;
 403		}
 404		if (val & APPL_INTR_STATUS_L1_18_CDM_REG_CHK_LOGIC_ERR) {
 405			dev_err(pci->dev, "CDM Logic error\n");
 406			tmp |= PCIE_PL_CHK_REG_CHK_REG_LOGIC_ERROR;
 407		}
 408		dw_pcie_writel_dbi(pci, PCIE_PL_CHK_REG_CONTROL_STATUS, tmp);
 409		tmp = dw_pcie_readl_dbi(pci, PCIE_PL_CHK_REG_ERR_ADDR);
 410		dev_err(pci->dev, "CDM Error Address Offset = 0x%08X\n", tmp);
 411	}
 412
 413	return IRQ_HANDLED;
 414}
 415
 416static irqreturn_t tegra_pcie_irq_handler(int irq, void *arg)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 417{
 418	struct tegra_pcie_dw *pcie = arg;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 419
 420	return tegra_pcie_rp_irq_handler(pcie);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 421}
 422
 423static int tegra_pcie_dw_rd_own_conf(struct pcie_port *pp, int where, int size,
 424				     u32 *val)
 425{
 
 426	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 
 427
 428	/*
 429	 * This is an endpoint mode specific register happen to appear even
 430	 * when controller is operating in root port mode and system hangs
 431	 * when it is accessed with link being in ASPM-L1 state.
 432	 * So skip accessing it altogether
 433	 */
 434	if (where == PORT_LOGIC_MSIX_DOORBELL) {
 
 435		*val = 0x00000000;
 436		return PCIBIOS_SUCCESSFUL;
 437	}
 438
 439	return dw_pcie_read(pci->dbi_base + where, size, val);
 440}
 441
 442static int tegra_pcie_dw_wr_own_conf(struct pcie_port *pp, int where, int size,
 443				     u32 val)
 444{
 
 445	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 
 446
 447	/*
 448	 * This is an endpoint mode specific register happen to appear even
 449	 * when controller is operating in root port mode and system hangs
 450	 * when it is accessed with link being in ASPM-L1 state.
 451	 * So skip accessing it altogether
 452	 */
 453	if (where == PORT_LOGIC_MSIX_DOORBELL)
 
 454		return PCIBIOS_SUCCESSFUL;
 455
 456	return dw_pcie_write(pci->dbi_base + where, size, val);
 457}
 458
 
 
 
 
 
 
 459#if defined(CONFIG_PCIEASPM)
 460static void disable_aspm_l11(struct tegra_pcie_dw *pcie)
 461{
 462	u32 val;
 463
 464	val = dw_pcie_readl_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub);
 465	val &= ~PCI_L1SS_CAP_ASPM_L1_1;
 466	dw_pcie_writel_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub, val);
 467}
 468
 469static void disable_aspm_l12(struct tegra_pcie_dw *pcie)
 470{
 471	u32 val;
 472
 473	val = dw_pcie_readl_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub);
 474	val &= ~PCI_L1SS_CAP_ASPM_L1_2;
 475	dw_pcie_writel_dbi(&pcie->pci, pcie->cfg_link_cap_l1sub, val);
 476}
 477
 478static inline u32 event_counter_prog(struct tegra_pcie_dw *pcie, u32 event)
 479{
 480	u32 val;
 481
 482	val = dw_pcie_readl_dbi(&pcie->pci, event_cntr_ctrl_offset[pcie->cid]);
 
 483	val &= ~(EVENT_COUNTER_EVENT_SEL_MASK << EVENT_COUNTER_EVENT_SEL_SHIFT);
 484	val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT;
 485	val |= event << EVENT_COUNTER_EVENT_SEL_SHIFT;
 486	val |= EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT;
 487	dw_pcie_writel_dbi(&pcie->pci, event_cntr_ctrl_offset[pcie->cid], val);
 488	val = dw_pcie_readl_dbi(&pcie->pci, event_cntr_data_offset[pcie->cid]);
 
 
 489
 490	return val;
 491}
 492
 493static int aspm_state_cnt(struct seq_file *s, void *data)
 494{
 495	struct tegra_pcie_dw *pcie = (struct tegra_pcie_dw *)
 496				     dev_get_drvdata(s->private);
 497	u32 val;
 498
 499	seq_printf(s, "Tx L0s entry count : %u\n",
 500		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_Tx_L0S));
 501
 502	seq_printf(s, "Rx L0s entry count : %u\n",
 503		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_Rx_L0S));
 504
 505	seq_printf(s, "Link L1 entry count : %u\n",
 506		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1));
 507
 508	seq_printf(s, "Link L1.1 entry count : %u\n",
 509		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1_1));
 510
 511	seq_printf(s, "Link L1.2 entry count : %u\n",
 512		   event_counter_prog(pcie, EVENT_COUNTER_EVENT_L1_2));
 513
 514	/* Clear all counters */
 515	dw_pcie_writel_dbi(&pcie->pci, event_cntr_ctrl_offset[pcie->cid],
 
 516			   EVENT_COUNTER_ALL_CLEAR);
 517
 518	/* Re-enable counting */
 519	val = EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT;
 520	val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT;
 521	dw_pcie_writel_dbi(&pcie->pci, event_cntr_ctrl_offset[pcie->cid], val);
 
 522
 523	return 0;
 524}
 525
 526static void init_host_aspm(struct tegra_pcie_dw *pcie)
 527{
 528	struct dw_pcie *pci = &pcie->pci;
 529	u32 val;
 530
 531	val = dw_pcie_find_ext_capability(pci, PCI_EXT_CAP_ID_L1SS);
 532	pcie->cfg_link_cap_l1sub = val + PCI_L1SS_CAP;
 533
 
 
 
 534	/* Enable ASPM counters */
 535	val = EVENT_COUNTER_ENABLE_ALL << EVENT_COUNTER_ENABLE_SHIFT;
 536	val |= EVENT_COUNTER_GROUP_5 << EVENT_COUNTER_GROUP_SEL_SHIFT;
 537	dw_pcie_writel_dbi(pci, event_cntr_ctrl_offset[pcie->cid], val);
 
 538
 539	/* Program T_cmrt and T_pwr_on values */
 540	val = dw_pcie_readl_dbi(pci, pcie->cfg_link_cap_l1sub);
 541	val &= ~(PCI_L1SS_CAP_CM_RESTORE_TIME | PCI_L1SS_CAP_P_PWR_ON_VALUE);
 542	val |= (pcie->aspm_cmrt << 8);
 543	val |= (pcie->aspm_pwr_on_t << 19);
 544	dw_pcie_writel_dbi(pci, pcie->cfg_link_cap_l1sub, val);
 545
 546	/* Program L0s and L1 entrance latencies */
 547	val = dw_pcie_readl_dbi(pci, PORT_LOGIC_ACK_F_ASPM_CTRL);
 548	val &= ~L0S_ENTRANCE_LAT_MASK;
 549	val |= (pcie->aspm_l0s_enter_lat << L0S_ENTRANCE_LAT_SHIFT);
 550	val |= ENTER_ASPM;
 551	dw_pcie_writel_dbi(pci, PORT_LOGIC_ACK_F_ASPM_CTRL, val);
 552}
 553
 554static int init_debugfs(struct tegra_pcie_dw *pcie)
 555{
 556	struct dentry *d;
 557
 558	d = debugfs_create_devm_seqfile(pcie->dev, "aspm_state_cnt",
 559					pcie->debugfs, aspm_state_cnt);
 560	if (IS_ERR_OR_NULL(d))
 561		dev_err(pcie->dev,
 562			"Failed to create debugfs file \"aspm_state_cnt\"\n");
 563
 564	return 0;
 565}
 566#else
 567static inline void disable_aspm_l12(struct tegra_pcie_dw *pcie) { return; }
 568static inline void disable_aspm_l11(struct tegra_pcie_dw *pcie) { return; }
 569static inline void init_host_aspm(struct tegra_pcie_dw *pcie) { return; }
 570static inline int init_debugfs(struct tegra_pcie_dw *pcie) { return 0; }
 571#endif
 572
 573static void tegra_pcie_enable_system_interrupts(struct pcie_port *pp)
 574{
 575	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 576	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 577	u32 val;
 578	u16 val_w;
 579
 580	val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 581	val |= APPL_INTR_EN_L0_0_LINK_STATE_INT_EN;
 582	appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 583
 584	val = appl_readl(pcie, APPL_INTR_EN_L1_0_0);
 585	val |= APPL_INTR_EN_L1_0_0_LINK_REQ_RST_NOT_INT_EN;
 586	appl_writel(pcie, val, APPL_INTR_EN_L1_0_0);
 
 
 587
 588	if (pcie->enable_cdm_check) {
 589		val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 590		val |= APPL_INTR_EN_L0_0_CDM_REG_CHK_INT_EN;
 591		appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 592
 593		val = appl_readl(pcie, APPL_INTR_EN_L1_18);
 594		val |= APPL_INTR_EN_L1_18_CDM_REG_CHK_CMP_ERR;
 595		val |= APPL_INTR_EN_L1_18_CDM_REG_CHK_LOGIC_ERR;
 596		appl_writel(pcie, val, APPL_INTR_EN_L1_18);
 597	}
 598
 599	val_w = dw_pcie_readw_dbi(&pcie->pci, pcie->pcie_cap_base +
 600				  PCI_EXP_LNKSTA);
 601	pcie->init_link_width = (val_w & PCI_EXP_LNKSTA_NLW) >>
 602				PCI_EXP_LNKSTA_NLW_SHIFT;
 603
 604	val_w = dw_pcie_readw_dbi(&pcie->pci, pcie->pcie_cap_base +
 605				  PCI_EXP_LNKCTL);
 606	val_w |= PCI_EXP_LNKCTL_LBMIE;
 607	dw_pcie_writew_dbi(&pcie->pci, pcie->pcie_cap_base + PCI_EXP_LNKCTL,
 608			   val_w);
 609}
 610
 611static void tegra_pcie_enable_legacy_interrupts(struct pcie_port *pp)
 612{
 613	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 614	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 615	u32 val;
 616
 617	/* Enable legacy interrupt generation */
 618	val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 619	val |= APPL_INTR_EN_L0_0_SYS_INTR_EN;
 620	val |= APPL_INTR_EN_L0_0_INT_INT_EN;
 621	appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 622
 623	val = appl_readl(pcie, APPL_INTR_EN_L1_8_0);
 624	val |= APPL_INTR_EN_L1_8_INTX_EN;
 625	val |= APPL_INTR_EN_L1_8_AUTO_BW_INT_EN;
 626	val |= APPL_INTR_EN_L1_8_BW_MGT_INT_EN;
 627	if (IS_ENABLED(CONFIG_PCIEAER))
 628		val |= APPL_INTR_EN_L1_8_AER_INT_EN;
 629	appl_writel(pcie, val, APPL_INTR_EN_L1_8_0);
 630}
 631
 632static void tegra_pcie_enable_msi_interrupts(struct pcie_port *pp)
 633{
 634	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 635	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 636	u32 val;
 637
 638	dw_pcie_msi_init(pp);
 639
 640	/* Enable MSI interrupt generation */
 641	val = appl_readl(pcie, APPL_INTR_EN_L0_0);
 642	val |= APPL_INTR_EN_L0_0_SYS_MSI_INTR_EN;
 643	val |= APPL_INTR_EN_L0_0_MSI_RCV_INT_EN;
 644	appl_writel(pcie, val, APPL_INTR_EN_L0_0);
 645}
 646
 647static void tegra_pcie_enable_interrupts(struct pcie_port *pp)
 648{
 649	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 650	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 651
 652	/* Clear interrupt statuses before enabling interrupts */
 653	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L0);
 654	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_0_0);
 655	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_1);
 656	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_2);
 657	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_3);
 658	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_6);
 659	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_7);
 660	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_8_0);
 661	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_9);
 662	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_10);
 663	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_11);
 664	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_13);
 665	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_14);
 666	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_15);
 667	appl_writel(pcie, 0xFFFFFFFF, APPL_INTR_STATUS_L1_17);
 668
 669	tegra_pcie_enable_system_interrupts(pp);
 670	tegra_pcie_enable_legacy_interrupts(pp);
 671	if (IS_ENABLED(CONFIG_PCI_MSI))
 672		tegra_pcie_enable_msi_interrupts(pp);
 673}
 674
 675static void config_gen3_gen4_eq_presets(struct tegra_pcie_dw *pcie)
 676{
 677	struct dw_pcie *pci = &pcie->pci;
 678	u32 val, offset, i;
 679
 680	/* Program init preset */
 681	for (i = 0; i < pcie->num_lanes; i++) {
 682		dw_pcie_read(pci->dbi_base + CAP_SPCIE_CAP_OFF
 683				 + (i * 2), 2, &val);
 684		val &= ~CAP_SPCIE_CAP_OFF_DSP_TX_PRESET0_MASK;
 685		val |= GEN3_GEN4_EQ_PRESET_INIT;
 686		val &= ~CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_MASK;
 687		val |= (GEN3_GEN4_EQ_PRESET_INIT <<
 688			   CAP_SPCIE_CAP_OFF_USP_TX_PRESET0_SHIFT);
 689		dw_pcie_write(pci->dbi_base + CAP_SPCIE_CAP_OFF
 690				 + (i * 2), 2, val);
 691
 692		offset = dw_pcie_find_ext_capability(pci,
 693						     PCI_EXT_CAP_ID_PL_16GT) +
 694				PCI_PL_16GT_LE_CTRL;
 695		dw_pcie_read(pci->dbi_base + offset + i, 1, &val);
 696		val &= ~PCI_PL_16GT_LE_CTRL_DSP_TX_PRESET_MASK;
 697		val |= GEN3_GEN4_EQ_PRESET_INIT;
 698		val &= ~PCI_PL_16GT_LE_CTRL_USP_TX_PRESET_MASK;
 699		val |= (GEN3_GEN4_EQ_PRESET_INIT <<
 700			PCI_PL_16GT_LE_CTRL_USP_TX_PRESET_SHIFT);
 701		dw_pcie_write(pci->dbi_base + offset + i, 1, val);
 702	}
 703
 704	val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 705	val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK;
 706	dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 707
 708	val = dw_pcie_readl_dbi(pci, GEN3_EQ_CONTROL_OFF);
 709	val &= ~GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK;
 710	val |= (0x3ff << GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT);
 711	val &= ~GEN3_EQ_CONTROL_OFF_FB_MODE_MASK;
 712	dw_pcie_writel_dbi(pci, GEN3_EQ_CONTROL_OFF, val);
 713
 714	val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 715	val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK;
 716	val |= (0x1 << GEN3_RELATED_OFF_RATE_SHADOW_SEL_SHIFT);
 717	dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 718
 719	val = dw_pcie_readl_dbi(pci, GEN3_EQ_CONTROL_OFF);
 720	val &= ~GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_MASK;
 721	val |= (0x360 << GEN3_EQ_CONTROL_OFF_PSET_REQ_VEC_SHIFT);
 
 722	val &= ~GEN3_EQ_CONTROL_OFF_FB_MODE_MASK;
 723	dw_pcie_writel_dbi(pci, GEN3_EQ_CONTROL_OFF, val);
 724
 725	val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 726	val &= ~GEN3_RELATED_OFF_RATE_SHADOW_SEL_MASK;
 727	dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 728}
 729
 730static void tegra_pcie_prepare_host(struct pcie_port *pp)
 731{
 732	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 733	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 734	u32 val;
 
 
 
 
 
 
 
 735
 736	val = dw_pcie_readl_dbi(pci, PCI_IO_BASE);
 737	val &= ~(IO_BASE_IO_DECODE | IO_BASE_IO_DECODE_BIT8);
 738	dw_pcie_writel_dbi(pci, PCI_IO_BASE, val);
 739
 740	val = dw_pcie_readl_dbi(pci, PCI_PREF_MEMORY_BASE);
 741	val |= CFG_PREF_MEM_LIMIT_BASE_MEM_DECODE;
 742	val |= CFG_PREF_MEM_LIMIT_BASE_MEM_LIMIT_DECODE;
 743	dw_pcie_writel_dbi(pci, PCI_PREF_MEMORY_BASE, val);
 744
 745	dw_pcie_writel_dbi(pci, PCI_BASE_ADDRESS_0, 0);
 746
 747	/* Configure FTS */
 748	val = dw_pcie_readl_dbi(pci, PORT_LOGIC_ACK_F_ASPM_CTRL);
 749	val &= ~(N_FTS_MASK << N_FTS_SHIFT);
 750	val |= N_FTS_VAL << N_FTS_SHIFT;
 751	dw_pcie_writel_dbi(pci, PORT_LOGIC_ACK_F_ASPM_CTRL, val);
 752
 753	val = dw_pcie_readl_dbi(pci, PORT_LOGIC_GEN2_CTRL);
 754	val &= ~FTS_MASK;
 755	val |= FTS_VAL;
 756	dw_pcie_writel_dbi(pci, PORT_LOGIC_GEN2_CTRL, val);
 757
 758	/* Enable as 0xFFFF0001 response for CRS */
 759	val = dw_pcie_readl_dbi(pci, PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT);
 760	val &= ~(AMBA_ERROR_RESPONSE_CRS_MASK << AMBA_ERROR_RESPONSE_CRS_SHIFT);
 761	val |= (AMBA_ERROR_RESPONSE_CRS_OKAY_FFFF0001 <<
 762		AMBA_ERROR_RESPONSE_CRS_SHIFT);
 763	dw_pcie_writel_dbi(pci, PORT_LOGIC_AMBA_ERROR_RESPONSE_DEFAULT, val);
 764
 765	/* Configure Max Speed from DT */
 766	if (pcie->max_speed && pcie->max_speed != -EINVAL) {
 767		val = dw_pcie_readl_dbi(pci, pcie->pcie_cap_base +
 768					PCI_EXP_LNKCAP);
 769		val &= ~PCI_EXP_LNKCAP_SLS;
 770		val |= pcie->max_speed;
 771		dw_pcie_writel_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKCAP,
 772				   val);
 773	}
 774
 775	/* Configure Max lane width from DT */
 776	val = dw_pcie_readl_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKCAP);
 777	val &= ~PCI_EXP_LNKCAP_MLW;
 778	val |= (pcie->num_lanes << PCI_EXP_LNKSTA_NLW_SHIFT);
 779	dw_pcie_writel_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKCAP, val);
 780
 781	config_gen3_gen4_eq_presets(pcie);
 782
 783	init_host_aspm(pcie);
 784
 785	val = dw_pcie_readl_dbi(pci, GEN3_RELATED_OFF);
 786	val &= ~GEN3_RELATED_OFF_GEN3_ZRXDC_NONCOMPL;
 787	dw_pcie_writel_dbi(pci, GEN3_RELATED_OFF, val);
 
 
 
 
 
 
 
 
 788
 789	if (pcie->update_fc_fixup) {
 790		val = dw_pcie_readl_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF);
 791		val |= 0x1 << CFG_TIMER_CTRL_ACK_NAK_SHIFT;
 792		dw_pcie_writel_dbi(pci, CFG_TIMER_CTRL_MAX_FUNC_NUM_OFF, val);
 793	}
 794
 795	dw_pcie_setup_rc(pp);
 
 
 
 796
 797	clk_set_rate(pcie->core_clk, GEN4_CORE_CLK_FREQ);
 
 
 
 
 
 
 
 
 
 
 798
 
 799	/* Assert RST */
 800	val = appl_readl(pcie, APPL_PINMUX);
 801	val &= ~APPL_PINMUX_PEX_RST;
 802	appl_writel(pcie, val, APPL_PINMUX);
 803
 804	usleep_range(100, 200);
 805
 806	/* Enable LTSSM */
 807	val = appl_readl(pcie, APPL_CTRL);
 808	val |= APPL_CTRL_LTSSM_EN;
 809	appl_writel(pcie, val, APPL_CTRL);
 810
 811	/* De-assert RST */
 812	val = appl_readl(pcie, APPL_PINMUX);
 813	val |= APPL_PINMUX_PEX_RST;
 814	appl_writel(pcie, val, APPL_PINMUX);
 815
 816	msleep(100);
 817}
 818
 819static int tegra_pcie_dw_host_init(struct pcie_port *pp)
 820{
 821	struct dw_pcie *pci = to_dw_pcie_from_pp(pp);
 822	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 823	u32 val, tmp, offset, speed;
 824
 825	tegra_pcie_prepare_host(pp);
 826
 827	if (dw_pcie_wait_for_link(pci)) {
 
 
 828		/*
 829		 * There are some endpoints which can't get the link up if
 830		 * root port has Data Link Feature (DLF) enabled.
 831		 * Refer Spec rev 4.0 ver 1.0 sec 3.4.2 & 7.7.4 for more info
 832		 * on Scaled Flow Control and DLF.
 833		 * So, need to confirm that is indeed the case here and attempt
 834		 * link up once again with DLF disabled.
 835		 */
 836		val = appl_readl(pcie, APPL_DEBUG);
 837		val &= APPL_DEBUG_LTSSM_STATE_MASK;
 838		val >>= APPL_DEBUG_LTSSM_STATE_SHIFT;
 839		tmp = appl_readl(pcie, APPL_LINK_STATUS);
 840		tmp &= APPL_LINK_STATUS_RDLH_LINK_UP;
 841		if (!(val == 0x11 && !tmp)) {
 842			/* Link is down for all good reasons */
 843			return 0;
 844		}
 845
 846		dev_info(pci->dev, "Link is down in DLL");
 847		dev_info(pci->dev, "Trying again with DLFE disabled\n");
 848		/* Disable LTSSM */
 849		val = appl_readl(pcie, APPL_CTRL);
 850		val &= ~APPL_CTRL_LTSSM_EN;
 851		appl_writel(pcie, val, APPL_CTRL);
 852
 853		reset_control_assert(pcie->core_rst);
 854		reset_control_deassert(pcie->core_rst);
 855
 856		offset = dw_pcie_find_ext_capability(pci, PCI_EXT_CAP_ID_DLF);
 857		val = dw_pcie_readl_dbi(pci, offset + PCI_DLF_CAP);
 858		val &= ~PCI_DLF_EXCHANGE_ENABLE;
 859		dw_pcie_writel_dbi(pci, offset, val);
 860
 861		tegra_pcie_prepare_host(pp);
 
 862
 863		if (dw_pcie_wait_for_link(pci))
 864			return 0;
 865	}
 866
 867	speed = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA) &
 868		PCI_EXP_LNKSTA_CLS;
 869	clk_set_rate(pcie->core_clk, pcie_gen_freq[speed - 1]);
 870
 871	tegra_pcie_enable_interrupts(pp);
 872
 873	return 0;
 874}
 875
 876static int tegra_pcie_dw_link_up(struct dw_pcie *pci)
 877{
 878	struct tegra_pcie_dw *pcie = to_tegra_pcie(pci);
 879	u32 val = dw_pcie_readw_dbi(pci, pcie->pcie_cap_base + PCI_EXP_LNKSTA);
 880
 881	return !!(val & PCI_EXP_LNKSTA_DLLLA);
 882}
 883
 884static void tegra_pcie_set_msi_vec_num(struct pcie_port *pp)
 885{
 886	pp->num_vectors = MAX_MSI_IRQS;
 
 
 887}
 888
 889static const struct dw_pcie_ops tegra_dw_pcie_ops = {
 890	.link_up = tegra_pcie_dw_link_up,
 
 
 891};
 892
 893static struct dw_pcie_host_ops tegra_pcie_dw_host_ops = {
 894	.rd_own_conf = tegra_pcie_dw_rd_own_conf,
 895	.wr_own_conf = tegra_pcie_dw_wr_own_conf,
 896	.host_init = tegra_pcie_dw_host_init,
 897	.set_num_vectors = tegra_pcie_set_msi_vec_num,
 898};
 899
 900static void tegra_pcie_disable_phy(struct tegra_pcie_dw *pcie)
 901{
 902	unsigned int phy_count = pcie->phy_count;
 903
 904	while (phy_count--) {
 905		phy_power_off(pcie->phys[phy_count]);
 906		phy_exit(pcie->phys[phy_count]);
 907	}
 908}
 909
 910static int tegra_pcie_enable_phy(struct tegra_pcie_dw *pcie)
 911{
 912	unsigned int i;
 913	int ret;
 914
 915	for (i = 0; i < pcie->phy_count; i++) {
 916		ret = phy_init(pcie->phys[i]);
 917		if (ret < 0)
 918			goto phy_power_off;
 919
 920		ret = phy_power_on(pcie->phys[i]);
 921		if (ret < 0)
 922			goto phy_exit;
 923	}
 924
 925	return 0;
 926
 927phy_power_off:
 928	while (i--) {
 929		phy_power_off(pcie->phys[i]);
 930phy_exit:
 931		phy_exit(pcie->phys[i]);
 932	}
 933
 934	return ret;
 935}
 936
 937static int tegra_pcie_dw_parse_dt(struct tegra_pcie_dw *pcie)
 938{
 
 939	struct device_node *np = pcie->dev->of_node;
 940	int ret;
 941
 
 
 
 
 
 
 942	ret = of_property_read_u32(np, "nvidia,aspm-cmrt-us", &pcie->aspm_cmrt);
 943	if (ret < 0) {
 944		dev_info(pcie->dev, "Failed to read ASPM T_cmrt: %d\n", ret);
 945		return ret;
 946	}
 947
 948	ret = of_property_read_u32(np, "nvidia,aspm-pwr-on-t-us",
 949				   &pcie->aspm_pwr_on_t);
 950	if (ret < 0)
 951		dev_info(pcie->dev, "Failed to read ASPM Power On time: %d\n",
 952			 ret);
 953
 954	ret = of_property_read_u32(np, "nvidia,aspm-l0s-entrance-latency-us",
 955				   &pcie->aspm_l0s_enter_lat);
 956	if (ret < 0)
 957		dev_info(pcie->dev,
 958			 "Failed to read ASPM L0s Entrance latency: %d\n", ret);
 959
 960	ret = of_property_read_u32(np, "num-lanes", &pcie->num_lanes);
 961	if (ret < 0) {
 962		dev_err(pcie->dev, "Failed to read num-lanes: %d\n", ret);
 963		return ret;
 964	}
 965
 966	pcie->max_speed = of_pci_get_max_link_speed(np);
 967
 968	ret = of_property_read_u32_index(np, "nvidia,bpmp", 1, &pcie->cid);
 969	if (ret) {
 970		dev_err(pcie->dev, "Failed to read Controller-ID: %d\n", ret);
 971		return ret;
 972	}
 973
 974	ret = of_property_count_strings(np, "phy-names");
 975	if (ret < 0) {
 976		dev_err(pcie->dev, "Failed to find PHY entries: %d\n",
 977			ret);
 978		return ret;
 979	}
 980	pcie->phy_count = ret;
 981
 982	if (of_property_read_bool(np, "nvidia,update-fc-fixup"))
 983		pcie->update_fc_fixup = true;
 984
 
 
 
 
 
 
 
 
 
 
 985	pcie->supports_clkreq =
 986		of_property_read_bool(pcie->dev->of_node, "supports-clkreq");
 987
 988	pcie->enable_cdm_check =
 989		of_property_read_bool(np, "snps,enable-cdm-check");
 990
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 991	return 0;
 992}
 993
 994static int tegra_pcie_bpmp_set_ctrl_state(struct tegra_pcie_dw *pcie,
 995					  bool enable)
 996{
 997	struct mrq_uphy_response resp;
 998	struct tegra_bpmp_message msg;
 999	struct mrq_uphy_request req;
1000
1001	/* Controller-5 doesn't need to have its state set by BPMP-FW */
1002	if (pcie->cid == 5)
 
 
 
1003		return 0;
1004
1005	memset(&req, 0, sizeof(req));
1006	memset(&resp, 0, sizeof(resp));
1007
1008	req.cmd = CMD_UPHY_PCIE_CONTROLLER_STATE;
1009	req.controller_state.pcie_controller = pcie->cid;
1010	req.controller_state.enable = enable;
1011
1012	memset(&msg, 0, sizeof(msg));
1013	msg.mrq = MRQ_UPHY;
1014	msg.tx.data = &req;
1015	msg.tx.size = sizeof(req);
1016	msg.rx.data = &resp;
1017	msg.rx.size = sizeof(resp);
1018
1019	return tegra_bpmp_transfer(pcie->bpmp, &msg);
1020}
1021
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1022static void tegra_pcie_downstream_dev_to_D0(struct tegra_pcie_dw *pcie)
1023{
1024	struct pcie_port *pp = &pcie->pci.pp;
1025	struct pci_bus *child, *root_bus = NULL;
1026	struct pci_dev *pdev;
1027
1028	/*
1029	 * link doesn't go into L2 state with some of the endpoints with Tegra
1030	 * if they are not in D0 state. So, need to make sure that immediate
1031	 * downstream devices are in D0 state before sending PME_TurnOff to put
1032	 * link into L2 state.
1033	 * This is as per PCI Express Base r4.0 v1.0 September 27-2017,
1034	 * 5.2 Link State Power Management (Page #428).
1035	 */
1036
1037	list_for_each_entry(child, &pp->root_bus->children, node) {
1038		/* Bring downstream devices to D0 if they are not already in */
1039		if (child->parent == pp->root_bus) {
1040			root_bus = child;
1041			break;
1042		}
1043	}
1044
1045	if (!root_bus) {
1046		dev_err(pcie->dev, "Failed to find downstream devices\n");
1047		return;
1048	}
1049
1050	list_for_each_entry(pdev, &root_bus->devices, bus_list) {
1051		if (PCI_SLOT(pdev->devfn) == 0) {
1052			if (pci_set_power_state(pdev, PCI_D0))
1053				dev_err(pcie->dev,
1054					"Failed to transition %s to D0 state\n",
1055					dev_name(&pdev->dev));
1056		}
1057	}
1058}
1059
1060static int tegra_pcie_get_slot_regulators(struct tegra_pcie_dw *pcie)
1061{
1062	pcie->slot_ctl_3v3 = devm_regulator_get_optional(pcie->dev, "vpcie3v3");
1063	if (IS_ERR(pcie->slot_ctl_3v3)) {
1064		if (PTR_ERR(pcie->slot_ctl_3v3) != -ENODEV)
1065			return PTR_ERR(pcie->slot_ctl_3v3);
1066
1067		pcie->slot_ctl_3v3 = NULL;
1068	}
1069
1070	pcie->slot_ctl_12v = devm_regulator_get_optional(pcie->dev, "vpcie12v");
1071	if (IS_ERR(pcie->slot_ctl_12v)) {
1072		if (PTR_ERR(pcie->slot_ctl_12v) != -ENODEV)
1073			return PTR_ERR(pcie->slot_ctl_12v);
1074
1075		pcie->slot_ctl_12v = NULL;
1076	}
1077
1078	return 0;
1079}
1080
1081static int tegra_pcie_enable_slot_regulators(struct tegra_pcie_dw *pcie)
1082{
1083	int ret;
1084
1085	if (pcie->slot_ctl_3v3) {
1086		ret = regulator_enable(pcie->slot_ctl_3v3);
1087		if (ret < 0) {
1088			dev_err(pcie->dev,
1089				"Failed to enable 3.3V slot supply: %d\n", ret);
1090			return ret;
1091		}
1092	}
1093
1094	if (pcie->slot_ctl_12v) {
1095		ret = regulator_enable(pcie->slot_ctl_12v);
1096		if (ret < 0) {
1097			dev_err(pcie->dev,
1098				"Failed to enable 12V slot supply: %d\n", ret);
1099			goto fail_12v_enable;
1100		}
1101	}
1102
1103	/*
1104	 * According to PCI Express Card Electromechanical Specification
1105	 * Revision 1.1, Table-2.4, T_PVPERL (Power stable to PERST# inactive)
1106	 * should be a minimum of 100ms.
1107	 */
1108	if (pcie->slot_ctl_3v3 || pcie->slot_ctl_12v)
1109		msleep(100);
1110
1111	return 0;
1112
1113fail_12v_enable:
1114	if (pcie->slot_ctl_3v3)
1115		regulator_disable(pcie->slot_ctl_3v3);
1116	return ret;
1117}
1118
1119static void tegra_pcie_disable_slot_regulators(struct tegra_pcie_dw *pcie)
1120{
1121	if (pcie->slot_ctl_12v)
1122		regulator_disable(pcie->slot_ctl_12v);
1123	if (pcie->slot_ctl_3v3)
1124		regulator_disable(pcie->slot_ctl_3v3);
1125}
1126
1127static int tegra_pcie_config_controller(struct tegra_pcie_dw *pcie,
1128					bool en_hw_hot_rst)
1129{
1130	int ret;
1131	u32 val;
1132
1133	ret = tegra_pcie_bpmp_set_ctrl_state(pcie, true);
1134	if (ret) {
1135		dev_err(pcie->dev,
1136			"Failed to enable controller %u: %d\n", pcie->cid, ret);
1137		return ret;
1138	}
1139
 
 
 
 
 
 
 
 
1140	ret = tegra_pcie_enable_slot_regulators(pcie);
1141	if (ret < 0)
1142		goto fail_slot_reg_en;
1143
1144	ret = regulator_enable(pcie->pex_ctl_supply);
1145	if (ret < 0) {
1146		dev_err(pcie->dev, "Failed to enable regulator: %d\n", ret);
1147		goto fail_reg_en;
1148	}
1149
1150	ret = clk_prepare_enable(pcie->core_clk);
1151	if (ret) {
1152		dev_err(pcie->dev, "Failed to enable core clock: %d\n", ret);
1153		goto fail_core_clk;
1154	}
1155
1156	ret = reset_control_deassert(pcie->core_apb_rst);
1157	if (ret) {
1158		dev_err(pcie->dev, "Failed to deassert core APB reset: %d\n",
1159			ret);
1160		goto fail_core_apb_rst;
1161	}
1162
1163	if (en_hw_hot_rst) {
1164		/* Enable HW_HOT_RST mode */
1165		val = appl_readl(pcie, APPL_CTRL);
1166		val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK <<
1167			 APPL_CTRL_HW_HOT_RST_MODE_SHIFT);
 
 
1168		val |= APPL_CTRL_HW_HOT_RST_EN;
1169		appl_writel(pcie, val, APPL_CTRL);
1170	}
1171
1172	ret = tegra_pcie_enable_phy(pcie);
1173	if (ret) {
1174		dev_err(pcie->dev, "Failed to enable PHY: %d\n", ret);
1175		goto fail_phy;
1176	}
1177
1178	/* Update CFG base address */
1179	appl_writel(pcie, pcie->dbi_res->start & APPL_CFG_BASE_ADDR_MASK,
1180		    APPL_CFG_BASE_ADDR);
1181
1182	/* Configure this core for RP mode operation */
1183	appl_writel(pcie, APPL_DM_TYPE_RP, APPL_DM_TYPE);
1184
1185	appl_writel(pcie, 0x0, APPL_CFG_SLCG_OVERRIDE);
1186
1187	val = appl_readl(pcie, APPL_CTRL);
1188	appl_writel(pcie, val | APPL_CTRL_SYS_PRE_DET_STATE, APPL_CTRL);
1189
1190	val = appl_readl(pcie, APPL_CFG_MISC);
1191	val |= (APPL_CFG_MISC_ARCACHE_VAL << APPL_CFG_MISC_ARCACHE_SHIFT);
1192	appl_writel(pcie, val, APPL_CFG_MISC);
1193
 
 
 
 
 
 
 
 
 
 
 
 
 
1194	if (!pcie->supports_clkreq) {
1195		val = appl_readl(pcie, APPL_PINMUX);
1196		val |= APPL_PINMUX_CLKREQ_OUT_OVRD_EN;
1197		val |= APPL_PINMUX_CLKREQ_OUT_OVRD;
1198		appl_writel(pcie, val, APPL_PINMUX);
1199	}
1200
1201	/* Update iATU_DMA base address */
1202	appl_writel(pcie,
1203		    pcie->atu_dma_res->start & APPL_CFG_IATU_DMA_BASE_ADDR_MASK,
1204		    APPL_CFG_IATU_DMA_BASE_ADDR);
1205
1206	reset_control_deassert(pcie->core_rst);
1207
1208	pcie->pcie_cap_base = dw_pcie_find_capability(&pcie->pci,
1209						      PCI_CAP_ID_EXP);
1210
1211	/* Disable ASPM-L1SS advertisement as there is no CLKREQ routing */
1212	if (!pcie->supports_clkreq) {
1213		disable_aspm_l11(pcie);
1214		disable_aspm_l12(pcie);
1215	}
1216
1217	return ret;
1218
1219fail_phy:
1220	reset_control_assert(pcie->core_apb_rst);
1221fail_core_apb_rst:
1222	clk_disable_unprepare(pcie->core_clk);
1223fail_core_clk:
1224	regulator_disable(pcie->pex_ctl_supply);
1225fail_reg_en:
1226	tegra_pcie_disable_slot_regulators(pcie);
1227fail_slot_reg_en:
 
 
 
1228	tegra_pcie_bpmp_set_ctrl_state(pcie, false);
1229
1230	return ret;
1231}
1232
1233static int __deinit_controller(struct tegra_pcie_dw *pcie)
1234{
1235	int ret;
1236
1237	ret = reset_control_assert(pcie->core_rst);
1238	if (ret) {
1239		dev_err(pcie->dev, "Failed to assert \"core\" reset: %d\n",
1240			ret);
1241		return ret;
1242	}
1243
1244	tegra_pcie_disable_phy(pcie);
1245
1246	ret = reset_control_assert(pcie->core_apb_rst);
1247	if (ret) {
1248		dev_err(pcie->dev, "Failed to assert APB reset: %d\n", ret);
1249		return ret;
1250	}
1251
1252	clk_disable_unprepare(pcie->core_clk);
1253
1254	ret = regulator_disable(pcie->pex_ctl_supply);
1255	if (ret) {
1256		dev_err(pcie->dev, "Failed to disable regulator: %d\n", ret);
1257		return ret;
1258	}
1259
1260	tegra_pcie_disable_slot_regulators(pcie);
1261
 
 
 
 
 
 
1262	ret = tegra_pcie_bpmp_set_ctrl_state(pcie, false);
1263	if (ret) {
1264		dev_err(pcie->dev, "Failed to disable controller %d: %d\n",
1265			pcie->cid, ret);
1266		return ret;
1267	}
1268
1269	return ret;
1270}
1271
1272static int tegra_pcie_init_controller(struct tegra_pcie_dw *pcie)
1273{
1274	struct dw_pcie *pci = &pcie->pci;
1275	struct pcie_port *pp = &pci->pp;
1276	int ret;
1277
1278	ret = tegra_pcie_config_controller(pcie, false);
1279	if (ret < 0)
1280		return ret;
1281
1282	pp->ops = &tegra_pcie_dw_host_ops;
1283
1284	ret = dw_pcie_host_init(pp);
1285	if (ret < 0) {
1286		dev_err(pcie->dev, "Failed to add PCIe port: %d\n", ret);
1287		goto fail_host_init;
1288	}
1289
1290	return 0;
1291
1292fail_host_init:
1293	return __deinit_controller(pcie);
 
1294}
1295
1296static int tegra_pcie_try_link_l2(struct tegra_pcie_dw *pcie)
1297{
1298	u32 val;
1299
1300	if (!tegra_pcie_dw_link_up(&pcie->pci))
1301		return 0;
1302
1303	val = appl_readl(pcie, APPL_RADM_STATUS);
1304	val |= APPL_PM_XMT_TURNOFF_STATE;
1305	appl_writel(pcie, val, APPL_RADM_STATUS);
1306
1307	return readl_poll_timeout_atomic(pcie->appl_base + APPL_DEBUG, val,
1308				 val & APPL_DEBUG_PM_LINKST_IN_L2_LAT,
1309				 1, PME_ACK_TIMEOUT);
1310}
1311
1312static void tegra_pcie_dw_pme_turnoff(struct tegra_pcie_dw *pcie)
1313{
1314	u32 data;
1315	int err;
1316
1317	if (!tegra_pcie_dw_link_up(&pcie->pci)) {
1318		dev_dbg(pcie->dev, "PCIe link is not up...!\n");
1319		return;
1320	}
1321
 
 
 
 
 
 
 
 
 
 
1322	if (tegra_pcie_try_link_l2(pcie)) {
1323		dev_info(pcie->dev, "Link didn't transition to L2 state\n");
1324		/*
1325		 * TX lane clock freq will reset to Gen1 only if link is in L2
1326		 * or detect state.
1327		 * So apply pex_rst to end point to force RP to go into detect
1328		 * state
1329		 */
1330		data = appl_readl(pcie, APPL_PINMUX);
1331		data &= ~APPL_PINMUX_PEX_RST;
1332		appl_writel(pcie, data, APPL_PINMUX);
1333
 
 
 
 
 
 
 
 
1334		err = readl_poll_timeout_atomic(pcie->appl_base + APPL_DEBUG,
1335						data,
1336						((data &
1337						APPL_DEBUG_LTSSM_STATE_MASK) >>
1338						APPL_DEBUG_LTSSM_STATE_SHIFT) ==
1339						LTSSM_STATE_PRE_DETECT,
1340						1, LTSSM_TIMEOUT);
1341		if (err) {
1342			dev_info(pcie->dev, "Link didn't go to detect state\n");
1343		} else {
1344			/* Disable LTSSM after link is in detect state */
1345			data = appl_readl(pcie, APPL_CTRL);
1346			data &= ~APPL_CTRL_LTSSM_EN;
1347			appl_writel(pcie, data, APPL_CTRL);
1348		}
1349	}
1350	/*
1351	 * DBI registers may not be accessible after this as PLL-E would be
1352	 * down depending on how CLKREQ is pulled by end point
1353	 */
1354	data = appl_readl(pcie, APPL_PINMUX);
1355	data |= (APPL_PINMUX_CLKREQ_OVERRIDE_EN | APPL_PINMUX_CLKREQ_OVERRIDE);
1356	/* Cut REFCLK to slot */
1357	data |= APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE_EN;
1358	data &= ~APPL_PINMUX_CLK_OUTPUT_IN_OVERRIDE;
1359	appl_writel(pcie, data, APPL_PINMUX);
1360}
1361
1362static int tegra_pcie_deinit_controller(struct tegra_pcie_dw *pcie)
1363{
1364	tegra_pcie_downstream_dev_to_D0(pcie);
1365	dw_pcie_host_deinit(&pcie->pci.pp);
1366	tegra_pcie_dw_pme_turnoff(pcie);
1367
1368	return __deinit_controller(pcie);
1369}
1370
1371static int tegra_pcie_config_rp(struct tegra_pcie_dw *pcie)
1372{
1373	struct pcie_port *pp = &pcie->pci.pp;
1374	struct device *dev = pcie->dev;
1375	char *name;
1376	int ret;
1377
1378	if (IS_ENABLED(CONFIG_PCI_MSI)) {
1379		pp->msi_irq = of_irq_get_byname(dev->of_node, "msi");
1380		if (!pp->msi_irq) {
1381			dev_err(dev, "Failed to get MSI interrupt\n");
1382			return -ENODEV;
1383		}
1384	}
1385
1386	pm_runtime_enable(dev);
1387
1388	ret = pm_runtime_get_sync(dev);
1389	if (ret < 0) {
1390		dev_err(dev, "Failed to get runtime sync for PCIe dev: %d\n",
1391			ret);
1392		goto fail_pm_get_sync;
1393	}
1394
1395	ret = pinctrl_pm_select_default_state(dev);
1396	if (ret < 0) {
1397		dev_err(dev, "Failed to configure sideband pins: %d\n", ret);
1398		goto fail_pinctrl;
1399	}
1400
1401	tegra_pcie_init_controller(pcie);
 
 
 
 
1402
1403	pcie->link_state = tegra_pcie_dw_link_up(&pcie->pci);
1404	if (!pcie->link_state) {
1405		ret = -ENOMEDIUM;
1406		goto fail_host_init;
1407	}
1408
1409	name = devm_kasprintf(dev, GFP_KERNEL, "%pOFP", dev->of_node);
1410	if (!name) {
1411		ret = -ENOMEM;
1412		goto fail_host_init;
1413	}
1414
1415	pcie->debugfs = debugfs_create_dir(name, NULL);
1416	if (!pcie->debugfs)
1417		dev_err(dev, "Failed to create debugfs\n");
1418	else
1419		init_debugfs(pcie);
1420
1421	return ret;
1422
1423fail_host_init:
1424	tegra_pcie_deinit_controller(pcie);
1425fail_pinctrl:
1426	pm_runtime_put_sync(dev);
1427fail_pm_get_sync:
1428	pm_runtime_disable(dev);
1429	return ret;
1430}
1431
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1432static int tegra_pcie_dw_probe(struct platform_device *pdev)
1433{
 
1434	struct device *dev = &pdev->dev;
1435	struct resource *atu_dma_res;
1436	struct tegra_pcie_dw *pcie;
1437	struct resource *dbi_res;
1438	struct pcie_port *pp;
1439	struct dw_pcie *pci;
1440	struct phy **phys;
1441	char *name;
1442	int ret;
1443	u32 i;
1444
 
 
1445	pcie = devm_kzalloc(dev, sizeof(*pcie), GFP_KERNEL);
1446	if (!pcie)
1447		return -ENOMEM;
1448
1449	pci = &pcie->pci;
1450	pci->dev = &pdev->dev;
1451	pci->ops = &tegra_dw_pcie_ops;
 
 
 
 
1452	pp = &pci->pp;
1453	pcie->dev = &pdev->dev;
1454
1455	ret = tegra_pcie_dw_parse_dt(pcie);
1456	if (ret < 0) {
1457		dev_err(dev, "Failed to parse device tree: %d\n", ret);
 
 
 
 
 
 
 
1458		return ret;
1459	}
1460
1461	ret = tegra_pcie_get_slot_regulators(pcie);
1462	if (ret < 0) {
1463		dev_err(dev, "Failed to get slot regulators: %d\n", ret);
 
 
 
 
 
 
 
1464		return ret;
1465	}
1466
 
 
 
1467	pcie->pex_ctl_supply = devm_regulator_get(dev, "vddio-pex-ctl");
1468	if (IS_ERR(pcie->pex_ctl_supply)) {
1469		ret = PTR_ERR(pcie->pex_ctl_supply);
1470		if (ret != -EPROBE_DEFER)
1471			dev_err(dev, "Failed to get regulator: %ld\n",
1472				PTR_ERR(pcie->pex_ctl_supply));
1473		return ret;
1474	}
1475
1476	pcie->core_clk = devm_clk_get(dev, "core");
1477	if (IS_ERR(pcie->core_clk)) {
1478		dev_err(dev, "Failed to get core clock: %ld\n",
1479			PTR_ERR(pcie->core_clk));
1480		return PTR_ERR(pcie->core_clk);
1481	}
1482
1483	pcie->appl_res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
1484						      "appl");
1485	if (!pcie->appl_res) {
1486		dev_err(dev, "Failed to find \"appl\" region\n");
1487		return -ENODEV;
1488	}
1489
1490	pcie->appl_base = devm_ioremap_resource(dev, pcie->appl_res);
1491	if (IS_ERR(pcie->appl_base))
1492		return PTR_ERR(pcie->appl_base);
1493
1494	pcie->core_apb_rst = devm_reset_control_get(dev, "apb");
1495	if (IS_ERR(pcie->core_apb_rst)) {
1496		dev_err(dev, "Failed to get APB reset: %ld\n",
1497			PTR_ERR(pcie->core_apb_rst));
1498		return PTR_ERR(pcie->core_apb_rst);
1499	}
1500
1501	phys = devm_kcalloc(dev, pcie->phy_count, sizeof(*phys), GFP_KERNEL);
1502	if (!phys)
1503		return -ENOMEM;
1504
1505	for (i = 0; i < pcie->phy_count; i++) {
1506		name = kasprintf(GFP_KERNEL, "p2u-%u", i);
1507		if (!name) {
1508			dev_err(dev, "Failed to create P2U string\n");
1509			return -ENOMEM;
1510		}
1511		phys[i] = devm_phy_get(dev, name);
1512		kfree(name);
1513		if (IS_ERR(phys[i])) {
1514			ret = PTR_ERR(phys[i]);
1515			if (ret != -EPROBE_DEFER)
1516				dev_err(dev, "Failed to get PHY: %d\n", ret);
1517			return ret;
1518		}
1519	}
1520
1521	pcie->phys = phys;
1522
1523	dbi_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dbi");
1524	if (!dbi_res) {
1525		dev_err(dev, "Failed to find \"dbi\" region\n");
1526		return -ENODEV;
1527	}
1528	pcie->dbi_res = dbi_res;
1529
1530	pci->dbi_base = devm_ioremap_resource(dev, dbi_res);
1531	if (IS_ERR(pci->dbi_base))
1532		return PTR_ERR(pci->dbi_base);
1533
1534	/* Tegra HW locates DBI2 at a fixed offset from DBI */
1535	pci->dbi_base2 = pci->dbi_base + 0x1000;
1536
1537	atu_dma_res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
1538						   "atu_dma");
1539	if (!atu_dma_res) {
1540		dev_err(dev, "Failed to find \"atu_dma\" region\n");
1541		return -ENODEV;
1542	}
1543	pcie->atu_dma_res = atu_dma_res;
1544
 
1545	pci->atu_base = devm_ioremap_resource(dev, atu_dma_res);
1546	if (IS_ERR(pci->atu_base))
1547		return PTR_ERR(pci->atu_base);
1548
1549	pcie->core_rst = devm_reset_control_get(dev, "core");
1550	if (IS_ERR(pcie->core_rst)) {
1551		dev_err(dev, "Failed to get core reset: %ld\n",
1552			PTR_ERR(pcie->core_rst));
1553		return PTR_ERR(pcie->core_rst);
1554	}
1555
1556	pp->irq = platform_get_irq_byname(pdev, "intr");
1557	if (!pp->irq) {
1558		dev_err(dev, "Failed to get \"intr\" interrupt\n");
1559		return -ENODEV;
1560	}
 
 
 
 
1561
1562	ret = devm_request_irq(dev, pp->irq, tegra_pcie_irq_handler,
1563			       IRQF_SHARED, "tegra-pcie-intr", pcie);
1564	if (ret) {
1565		dev_err(dev, "Failed to request IRQ %d: %d\n", pp->irq, ret);
 
1566		return ret;
1567	}
1568
1569	pcie->bpmp = tegra_bpmp_get(dev);
1570	if (IS_ERR(pcie->bpmp))
1571		return PTR_ERR(pcie->bpmp);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1572
1573	platform_set_drvdata(pdev, pcie);
 
 
 
1574
1575	ret = tegra_pcie_config_rp(pcie);
1576	if (ret && ret != -ENOMEDIUM)
1577		goto fail;
1578	else
1579		return 0;
1580
1581fail:
1582	tegra_bpmp_put(pcie->bpmp);
1583	return ret;
1584}
1585
1586static int tegra_pcie_dw_remove(struct platform_device *pdev)
1587{
1588	struct tegra_pcie_dw *pcie = platform_get_drvdata(pdev);
1589
1590	if (!pcie->link_state)
1591		return 0;
 
 
 
 
 
 
 
 
 
1592
1593	debugfs_remove_recursive(pcie->debugfs);
1594	tegra_pcie_deinit_controller(pcie);
1595	pm_runtime_put_sync(pcie->dev);
1596	pm_runtime_disable(pcie->dev);
1597	tegra_bpmp_put(pcie->bpmp);
1598
1599	return 0;
1600}
1601
1602static int tegra_pcie_dw_suspend_late(struct device *dev)
1603{
1604	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
1605	u32 val;
1606
 
 
 
 
 
1607	if (!pcie->link_state)
1608		return 0;
1609
1610	/* Enable HW_HOT_RST mode */
1611	val = appl_readl(pcie, APPL_CTRL);
1612	val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK <<
1613		 APPL_CTRL_HW_HOT_RST_MODE_SHIFT);
1614	val |= APPL_CTRL_HW_HOT_RST_EN;
1615	appl_writel(pcie, val, APPL_CTRL);
 
 
1616
1617	return 0;
1618}
1619
1620static int tegra_pcie_dw_suspend_noirq(struct device *dev)
1621{
1622	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
1623
1624	if (!pcie->link_state)
1625		return 0;
1626
1627	/* Save MSI interrupt vector */
1628	pcie->msi_ctrl_int = dw_pcie_readl_dbi(&pcie->pci,
1629					       PORT_LOGIC_MSI_CTRL_INT_0_EN);
1630	tegra_pcie_downstream_dev_to_D0(pcie);
1631	tegra_pcie_dw_pme_turnoff(pcie);
 
1632
1633	return __deinit_controller(pcie);
1634}
1635
1636static int tegra_pcie_dw_resume_noirq(struct device *dev)
1637{
1638	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
1639	int ret;
1640
1641	if (!pcie->link_state)
1642		return 0;
1643
1644	ret = tegra_pcie_config_controller(pcie, true);
1645	if (ret < 0)
1646		return ret;
1647
1648	ret = tegra_pcie_dw_host_init(&pcie->pci.pp);
1649	if (ret < 0) {
1650		dev_err(dev, "Failed to init host: %d\n", ret);
1651		goto fail_host_init;
1652	}
1653
1654	/* Restore MSI interrupt vector */
1655	dw_pcie_writel_dbi(&pcie->pci, PORT_LOGIC_MSI_CTRL_INT_0_EN,
1656			   pcie->msi_ctrl_int);
 
 
1657
1658	return 0;
1659
1660fail_host_init:
1661	return __deinit_controller(pcie);
 
1662}
1663
1664static int tegra_pcie_dw_resume_early(struct device *dev)
1665{
1666	struct tegra_pcie_dw *pcie = dev_get_drvdata(dev);
1667	u32 val;
1668
 
 
 
 
 
1669	if (!pcie->link_state)
1670		return 0;
1671
1672	/* Disable HW_HOT_RST mode */
1673	val = appl_readl(pcie, APPL_CTRL);
1674	val &= ~(APPL_CTRL_HW_HOT_RST_MODE_MASK <<
1675		 APPL_CTRL_HW_HOT_RST_MODE_SHIFT);
1676	val |= APPL_CTRL_HW_HOT_RST_MODE_IMDT_RST <<
1677	       APPL_CTRL_HW_HOT_RST_MODE_SHIFT;
1678	val &= ~APPL_CTRL_HW_HOT_RST_EN;
1679	appl_writel(pcie, val, APPL_CTRL);
 
 
1680
1681	return 0;
1682}
1683
1684static void tegra_pcie_dw_shutdown(struct platform_device *pdev)
1685{
1686	struct tegra_pcie_dw *pcie = platform_get_drvdata(pdev);
1687
1688	if (!pcie->link_state)
1689		return;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1690
1691	debugfs_remove_recursive(pcie->debugfs);
1692	tegra_pcie_downstream_dev_to_D0(pcie);
 
 
 
 
 
 
1693
1694	disable_irq(pcie->pci.pp.irq);
1695	if (IS_ENABLED(CONFIG_PCI_MSI))
1696		disable_irq(pcie->pci.pp.msi_irq);
 
 
 
 
 
 
 
 
1697
1698	tegra_pcie_dw_pme_turnoff(pcie);
1699	__deinit_controller(pcie);
1700}
 
 
 
 
 
 
 
1701
1702static const struct of_device_id tegra_pcie_dw_of_match[] = {
1703	{
1704		.compatible = "nvidia,tegra194-pcie",
 
 
 
 
 
 
 
 
 
 
 
 
 
1705	},
1706	{},
1707};
1708
1709static const struct dev_pm_ops tegra_pcie_dw_pm_ops = {
1710	.suspend_late = tegra_pcie_dw_suspend_late,
1711	.suspend_noirq = tegra_pcie_dw_suspend_noirq,
1712	.resume_noirq = tegra_pcie_dw_resume_noirq,
1713	.resume_early = tegra_pcie_dw_resume_early,
1714};
1715
1716static struct platform_driver tegra_pcie_dw_driver = {
1717	.probe = tegra_pcie_dw_probe,
1718	.remove = tegra_pcie_dw_remove,
1719	.shutdown = tegra_pcie_dw_shutdown,
1720	.driver = {
1721		.name	= "tegra194-pcie",
1722		.pm = &tegra_pcie_dw_pm_ops,
1723		.of_match_table = tegra_pcie_dw_of_match,
1724	},
1725};
1726module_platform_driver(tegra_pcie_dw_driver);
1727
1728MODULE_DEVICE_TABLE(of, tegra_pcie_dw_of_match);
1729
1730MODULE_AUTHOR("Vidya Sagar <vidyas@nvidia.com>");
1731MODULE_DESCRIPTION("NVIDIA PCIe host controller driver");
1732MODULE_LICENSE("GPL v2");