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