From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received-SPF: None (no SPF record) identity=mailfrom; client-ip=2a00:1450:4010:c07::242; helo=mail-lf0-x242.google.com; envelope-from=mw@semihalf.com; receiver=edk2-devel@lists.01.org Received: from mail-lf0-x242.google.com (mail-lf0-x242.google.com [IPv6:2a00:1450:4010:c07::242]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by ml01.01.org (Postfix) with ESMTPS id 173722096AEE1 for ; Wed, 9 May 2018 06:51:42 -0700 (PDT) Received: by mail-lf0-x242.google.com with SMTP id y72-v6so37309332lfd.2 for ; Wed, 09 May 2018 06:51:42 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=semihalf-com.20150623.gappssmtp.com; s=20150623; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=njZe5aH6uTYG3Rni+5qQ56SAREFAGXoIjviLCJDq1So=; b=BgLrZw1zyL7cLITro6k7fHg37PzB5MYcrAhGhrReA1bywaolml2xBIItKwnp/KHfz8 DGTvIq73gXjTbNZp/tn+AWamKNoaXm7NWIM7fDyFUfOPcPTIuntdb3PHkL1urCi7Vcvq 2QXXHwbDGPHZUenUzZRBDeBH18frCFZkXUlbYleCwe1nIA3H6sd4efVpuzZ1Rl4Gmlvb QE0VHH10nPXJt9Zt4CV4vfm88xNyTbUbO+1R4k6DQPMtj6jxG22i7hLQrwUwLJg8XeD0 D6Y2X4Gi7vYQwdD9C94DkhCCxVvbD5nC0fhkEQOCQOhjoqmbptWDHt8JIrx4q+fAuEC8 CrMQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=njZe5aH6uTYG3Rni+5qQ56SAREFAGXoIjviLCJDq1So=; b=IqGm89oydMDeTiSVfFsRI9ZDWhZVrF76J9fqEqTTORVHWBN3orPwdeXdwfTFydE/bo l4q0OH7U47083imSzpWun0fUQ71LaZyoO2tUGc0XrkFaIXNY5zs3Ila0IY3o8iqMQCqa K4omr0Ys4YiXCoOdsLDtjEcwEXR19/JKQ58Xaq845GIl5m2grdIvDjmc75Hiagc8o/8g byV0iLaHZ7TvzWkwpQzN/mOg9h8ERa5NLT8SwT+AIQsBjVBeX7ePPJROgaB/TE2Khh2y 8C6RmrlkcpGZbkus/ovYHnudWsk7vdgddWeu5IgmwTP8EoNInd40upYAd7eX5Y/iy3E5 qSCQ== X-Gm-Message-State: ALQs6tBWrnXLmeXr7JPMQgcRrunUHVe2n0g1AVHlTEgf3LUezSIbci8R VX3I4Ou9pX8E0iCFTud6en7mM4NaFB0= X-Google-Smtp-Source: AB8JxZplMj+MelYL57dLJ1Z97bCe574LLH+Sxo4e3pFndMhN4DH0zW+d5xN9pjV0CB+3CV6IQEJXkQ== X-Received: by 2002:a2e:760a:: with SMTP id r10-v6mr30310165ljc.144.1525873899882; Wed, 09 May 2018 06:51:39 -0700 (PDT) Received: from gilgamesh.semihalf.com (31-172-191-173.noc.fibertech.net.pl. [31.172.191.173]) by smtp.gmail.com with ESMTPSA id r11-v6sm1612908ljg.37.2018.05.09.06.51.38 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Wed, 09 May 2018 06:51:39 -0700 (PDT) From: Marcin Wojtas To: edk2-devel@lists.01.org Cc: leif.lindholm@linaro.org, ard.biesheuvel@linaro.org, mw@semihalf.com, jsd@semihalf.com, jinghua@marvell.com, jaz@semihalf.com, Evan Wang Date: Wed, 9 May 2018 15:51:11 +0200 Message-Id: <1525873871-799-5-git-send-email-mw@semihalf.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1525873871-799-1-git-send-email-mw@semihalf.com> References: <1525873871-799-1-git-send-email-mw@semihalf.com> Subject: [platforms PATCH v2 4/4] Marvell/Library: ComPhyLib: Fix configuration for PCIE x4 and x2 X-BeenThere: edk2-devel@lists.01.org X-Mailman-Version: 2.1.26 Precedence: list List-Id: EDK II Development List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , X-List-Received-Date: Wed, 09 May 2018 13:51:42 -0000 From: Evan Wang PCIE clock direction (input/output) has implications on comphy settings. There are 2 PCIe clocks in CP110: - Ref clock 0 for lanes 1,2 and 3 - Ref clock 1 for lanes 4 and 5 A proper handling of above had to be added, using newly introduced sample at reset library class for Marvell SoCs. Other than that, update HPIPE settings and the reset sequence, which differ from one used in x1 link. This patch fixes PCIE x4 and x2 configuration, which helps to overcome link establishing issue for multi-lane end points. Contributed-under: TianoCore Contribution Agreement 1.1 Signed-off-by: Evan Wang Signed-off-by: Marcin Wojtas --- Silicon/Marvell/Armada7k8k/Armada7k8k.dsc.inc | 1 + Silicon/Marvell/Library/ComPhyLib/ComPhyCp110.c | 216 +++++++++++++++----- Silicon/Marvell/Library/ComPhyLib/ComPhyLib.c | 1 + Silicon/Marvell/Library/ComPhyLib/ComPhyLib.h | 36 ++++ Silicon/Marvell/Library/ComPhyLib/ComPhyLib.inf | 1 + 5 files changed, 203 insertions(+), 52 deletions(-) diff --git a/Silicon/Marvell/Armada7k8k/Armada7k8k.dsc.inc b/Silicon/Marvell/Armada7k8k/Armada7k8k.dsc.inc index a147b6e..4129742 100644 --- a/Silicon/Marvell/Armada7k8k/Armada7k8k.dsc.inc +++ b/Silicon/Marvell/Armada7k8k/Armada7k8k.dsc.inc @@ -36,6 +36,7 @@ ComPhyLib|Silicon/Marvell/Library/ComPhyLib/ComPhyLib.inf MppLib|Silicon/Marvell/Library/MppLib/MppLib.inf NorFlashInfoLib|EmbeddedPkg/Library/NorFlashInfoLib/NorFlashInfoLib.inf + SampleAtResetLib|Silicon/Marvell/Armada7k8k/Library/Armada7k8kSampleAtResetLib/Armada7k8kSampleAtResetLib.inf UtmiPhyLib|Silicon/Marvell/Library/UtmiPhyLib/UtmiPhyLib.inf DebugLib|MdePkg/Library/BaseDebugLibSerialPort/BaseDebugLibSerialPort.inf diff --git a/Silicon/Marvell/Library/ComPhyLib/ComPhyCp110.c b/Silicon/Marvell/Library/ComPhyLib/ComPhyCp110.c index 40a7b99..5c7e769 100755 --- a/Silicon/Marvell/Library/ComPhyLib/ComPhyCp110.c +++ b/Silicon/Marvell/Library/ComPhyLib/ComPhyCp110.c @@ -34,6 +34,7 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. #include "ComPhyLib.h" #include +#include #define SD_LANE_ADDR_WIDTH 0x1000 #define HPIPE_ADDR_OFFSET 0x800 @@ -42,6 +43,9 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. #define HPIPE_ADDR(base, Lane) (SD_ADDR(base, Lane) + HPIPE_ADDR_OFFSET) #define COMPHY_ADDR(base, Lane) (base + COMPHY_ADDR_LANE_WIDTH * Lane) +#define CP110_PCIE_REF_CLK_TYPE0 0 +#define CP110_PCIE_REF_CLK_TYPE12 1 + DECLARE_A7K8K_NONDISCOVERABLE_TEMPLATE; /* @@ -99,11 +103,26 @@ COMPHY_MUX_DATA Cp110ComPhyPipeMuxData[] = { STATIC VOID ComPhyPcieRFUConfiguration ( + IN UINT32 Lane, + IN UINT32 PcieWidth, IN EFI_PHYSICAL_ADDRESS ComPhyAddr ) { UINT32 Mask, Data; + /* Enable PCIe by4 and by2 */ + if (Lane == 0) { + if (PcieWidth == 4) { + RegSet (ComPhyAddr + COMMON_PHY_SD_CTRL1, + COMMON_PHY_SD_CTRL1_PCIE_X4_EN, + COMMON_PHY_SD_CTRL1_PCIE_X4_EN_MASK); + } else if (PcieWidth == 2) { + RegSet (ComPhyAddr + COMMON_PHY_SD_CTRL1, + COMMON_PHY_SD_CTRL1_PCIE_X2_EN, + COMMON_PHY_SD_CTRL1_PCIE_X2_EN_MASK); + } + } + /* RFU configurations - hard reset ComPhy */ Mask = COMMON_PHY_CFG1_PWR_UP_MASK; Data = 0x1 << COMMON_PHY_CFG1_PWR_UP_OFFSET; @@ -132,11 +151,14 @@ ComPhyPcieRFUConfiguration ( STATIC VOID ComPhyPciePhyConfiguration ( + IN UINT32 Lane, + IN UINT32 PcieWidth, + IN UINT32 PcieClk, IN EFI_PHYSICAL_ADDRESS ComPhyAddr, IN EFI_PHYSICAL_ADDRESS HpipeAddr ) { - UINT32 Mask, Data, PcieClk = 0; + UINT32 Mask, Data; /* Set PIPE soft reset */ Mask = HPIPE_RST_CLK_CTRL_PIPE_RST_MASK; @@ -156,13 +178,31 @@ ComPhyPciePhyConfiguration ( RegSet (HpipeAddr + HPIPE_RST_CLK_CTRL_REG, Data, Mask); /* Set PLL ready delay for 0x2 */ - RegSet (HpipeAddr + HPIPE_CLK_SRC_LO_REG, - 0x2 << HPIPE_CLK_SRC_LO_PLL_RDY_DL_OFFSET, - HPIPE_CLK_SRC_LO_PLL_RDY_DL_MASK); + Data = HPIPE_CLK_SRC_LO_PLL_RDY_DL_DEFAULT; + Mask = HPIPE_CLK_SRC_LO_PLL_RDY_DL_MASK; + if (PcieWidth != 1) { + Data |= HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SEL_DEFAULT | + HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SCALE_DEFAULT; + Mask |= HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SEL_MASK | + HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SCALE_MASK; + } + RegSet (HpipeAddr + HPIPE_CLK_SRC_LO_REG, Data, Mask); /* Set PIPE mode interface to PCIe3 - 0x1 */ - RegSet (HpipeAddr + HPIPE_CLK_SRC_HI_REG, - 0x1 << HPIPE_CLK_SRC_HI_MODE_PIPE_OFFSET, HPIPE_CLK_SRC_HI_MODE_PIPE_MASK); + Data = HPIPE_CLK_SRC_HI_MODE_PIPE_EN; + Mask = HPIPE_CLK_SRC_HI_MODE_PIPE_MASK; + if (PcieWidth != 1) { + Mask |= HPIPE_CLK_SRC_HI_LANE_STRT_MASK | + HPIPE_CLK_SRC_HI_LANE_MASTER_MASK | + HPIPE_CLK_SRC_HI_LANE_BREAK_MASK; + if (Lane == 0) { + Data |= HPIPE_CLK_SRC_HI_LANE_STRT_EN | + HPIPE_CLK_SRC_HI_LANE_MASTER_EN; + } else if (Lane == (PcieWidth - 1)) { + Data |= HPIPE_CLK_SRC_HI_LANE_BREAK_EN; + } + } + RegSet (HpipeAddr + HPIPE_CLK_SRC_HI_REG, Data, Mask); /* Config update polarity equalization */ RegSet (HpipeAddr + HPIPE_LANE_EQ_CFG1_REG, @@ -172,19 +212,21 @@ ComPhyPciePhyConfiguration ( RegSet (HpipeAddr + HPIPE_DFE_CTRL_28_REG, 0x1 << HPIPE_DFE_CTRL_28_PIPE4_OFFSET, HPIPE_DFE_CTRL_28_PIPE4_MASK); - /* Enable PIN clock 100M_125M */ - Mask = HPIPE_MISC_CLK100M_125M_MASK; - Data = 0x1 << HPIPE_MISC_CLK100M_125M_OFFSET; - /* Set PIN_TXDCLK_2X Clock Frequency Selection for outputs 500MHz clock */ - Mask |= HPIPE_MISC_TXDCLK_2X_MASK; - Data |= 0x0 << HPIPE_MISC_TXDCLK_2X_OFFSET; + Mask = HPIPE_MISC_TXDCLK_2X_MASK; + Data = HPIPE_MISC_TXDCLK_2X_500MHZ; /* Enable 500MHz Clock */ Mask |= HPIPE_MISC_CLK500_EN_MASK; Data |= 0x1 << HPIPE_MISC_CLK500_EN_OFFSET; if (PcieClk) { + /* + * Enable PIN clock 100M_125M + * Only if clock is output, configure the clock-source mux + */ + Mask |= HPIPE_MISC_CLK100M_125M_MASK; + Data |= HPIPE_MISC_CLK100M_125M_EN; /* Set reference clock comes from group 1 */ Mask |= HPIPE_MISC_REFCLK_SEL_MASK; Data |= 0x0 << HPIPE_MISC_REFCLK_SEL_OFFSET; @@ -214,6 +256,13 @@ ComPhyPciePhyConfiguration ( Data |= 0x3 << HPIPE_PWR_PLL_PHY_MODE_OFFSET; RegSet (HpipeAddr + HPIPE_PWR_PLL_REG, Data, Mask); + /* Ref clock alignment */ + if (PcieWidth != 1) { + RegSet (HpipeAddr + HPIPE_LANE_ALIGN_REG, + HPIPE_LANE_ALIGN_OFF, + HPIPE_LANE_ALIGN_OFF_MASK); + } + /* * Set the amount of time spent in the LoZ state - set * for 0x7 only if the PCIe clock is output @@ -396,7 +445,7 @@ ComPhyPcieSetAnalogParameters ( HPIPE_LANE_CFG_FOM_PRESET_VECTOR_MASK; Data = (0x1 << HPIPE_LANE_CFG_FOM_DIRN_OVERRIDE_OFFSET) | (0x1 << HPIPE_LANE_CFG_FOM_ONLY_MODE_OFFFSET) | - (0x2 << HPIPE_LANE_CFG_FOM_PRESET_VECTOR_OFFSET); + (HPIPE_LANE_CFG_FOM_PRESET_VECTOR_DEFAULT); MmioAndThenOr32 (HpipeAddr + HPIPE_LANE_EQ_REMOTE_SETTING_REG, ~Mask, Data); /* Set phy in root complex mode */ @@ -404,37 +453,82 @@ ComPhyPcieSetAnalogParameters ( } STATIC -VOID -ComPhyPciePhyPowerUp ( - IN EFI_PHYSICAL_ADDRESS HpipeAddr -) -{ - /* Release from PIPE soft reset */ - RegSet (HpipeAddr + HPIPE_RST_CLK_CTRL_REG, - 0x0 << HPIPE_RST_CLK_CTRL_PIPE_RST_OFFSET, - HPIPE_RST_CLK_CTRL_PIPE_RST_MASK); - - /* Wait 15ms - for ComPhy calibration done */ - MicroSecondDelay (15000); - MemoryFence (); -} - -STATIC EFI_STATUS -ComPhyPcieCheckPll ( - IN EFI_PHYSICAL_ADDRESS HpipeAddr +ComPhyPciePhyPowerUp ( + IN UINT32 Lane, + IN UINT32 PcieWidth, + IN EFI_PHYSICAL_ADDRESS ComPhyBase, + IN EFI_PHYSICAL_ADDRESS HpipeBase ) { EFI_STATUS Status = EFI_SUCCESS; + UINT8 StartLane, EndLane, Loop; UINT32 Data; - /* Read Lane status */ - Data = MmioRead32 (HpipeAddr + HPIPE_LANE_STATUS0_REG); - if ((Data & HPIPE_LANE_STATUS0_PCLK_EN_MASK) == 0) { - DEBUG((DEBUG_INFO, "ComPhy: Read from reg = %p - value = 0x%x\n", - HpipeAddr + HPIPE_LANE_STATUS0_REG, Data)); - DEBUG((DEBUG_INFO, "ComPhy: HPIPE_LANE_STATUS0_PCLK_EN_MASK is 0\n")); - Status = EFI_D_ERROR; + /* + * For PCIe by4 or by2 - release from reset only after finish to + * configure all lanes + */ + if ((PcieWidth == 1) || (Lane == (PcieWidth - 1))) { + if (PcieWidth != 1) { + /* Allows writing to all lanes in one write */ + RegSet (ComPhyBase + COMMON_PHY_SD_CTRL1, + COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_WR_ENABLE, + COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_MASK); + StartLane = 0; + EndLane = PcieWidth; + + /* + * Release from PIPE soft reset + * for PCIe by4 or by2 - release from soft reset + * all lanes - can't use read modify write + */ + RegSet (HPIPE_ADDR (HpipeBase, 0) + HPIPE_RST_CLK_CTRL_REG, + HPIPE_RST_CLK_CTRL_FIXED_PCLK_WIDTH_8 | HPIPE_RST_CLK_CTRL_MODE_REFDIV_4, + HPIPE_RST_CLK_CTRL_CLR_ALL_MASK); + } else { + StartLane = Lane; + EndLane = Lane + 1; + + /* + * Release from PIPE soft reset + * for PCIe by4 or by2 - release from soft reset + * all lanes + */ + RegSet (HPIPE_ADDR (HpipeBase, Lane) + HPIPE_RST_CLK_CTRL_REG, + HPIPE_RST_CLK_CTRL_PIPE_RST_DISABLE, + HPIPE_RST_CLK_CTRL_PIPE_RST_MASK); + } + + if (PcieWidth != 1) { + /* Disable writing to all lanes with one write */ + RegSet (ComPhyBase + COMMON_PHY_SD_CTRL1, + COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_WR_DISABLE, + COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_MASK); + } + MemoryFence (); + + /* Wait 20ms until status of all lanes stabilize */ + MicroSecondDelay (20000); + + /* Make sure all lanes are UP */ + for (Loop = StartLane; Loop < EndLane; Loop++) { + Data = MmioRead32 (HPIPE_ADDR (HpipeBase, Loop) + HPIPE_LANE_STATUS0_REG); + + if ((Data & HPIPE_LANE_STATUS0_PCLK_EN_MASK) == 0) { + DEBUG ((DEBUG_ERROR, + "%a: Read from lane%d, reg = %p - value = 0x%x\n", + __FUNCTION__, + Loop, + HPIPE_ADDR (HpipeBase, Loop) + HPIPE_LANE_STATUS0_REG, + Data)); + DEBUG ((DEBUG_ERROR, + "%a: HPIPE_LANE_STATUS1_PCLK_EN_MASK is 0\n", + __FUNCTION__)); + Status = EFI_D_ERROR; + break; + } + } } return Status; @@ -443,8 +537,9 @@ ComPhyPcieCheckPll ( STATIC EFI_STATUS ComPhyPciePowerUp ( + IN UINT8 ChipId, IN UINT32 Lane, - IN UINT32 PcieBy4, + IN UINT32 PcieWidth, IN EFI_PHYSICAL_ADDRESS HpipeBase, IN EFI_PHYSICAL_ADDRESS ComPhyBase ) @@ -452,26 +547,36 @@ ComPhyPciePowerUp ( EFI_STATUS Status = EFI_SUCCESS; EFI_PHYSICAL_ADDRESS HpipeAddr = HPIPE_ADDR(HpipeBase, Lane); EFI_PHYSICAL_ADDRESS ComPhyAddr = COMPHY_ADDR(ComPhyBase, Lane); + UINT32 PcieClk; + + /* + * Obtain clock direction from sample-at-reset configuration. + * 4th and 5th SerDes lanes can belong only to PCIE Port1 and + * Port2, which use different clock type specifier than Port0. + */ + if (Lane == 4 || Lane == 5) { + PcieClk = SampleAtResetGetPcieClockDirection (ChipId, CP110_PCIE_REF_CLK_TYPE12); + } else { + PcieClk = SampleAtResetGetPcieClockDirection (ChipId, CP110_PCIE_REF_CLK_TYPE0); + } + + DEBUG ((DEBUG_INFO, "%a: ChipId: %d PcieClk:%d\n", __FUNCTION__, ChipId, PcieClk)); DEBUG((DEBUG_INFO, "ComPhy: stage: RFU configurations - hard reset ComPhy\n")); - ComPhyPcieRFUConfiguration (ComPhyAddr); + ComPhyPcieRFUConfiguration (Lane, PcieWidth, ComPhyAddr); DEBUG((DEBUG_INFO, "ComPhy: stage: ComPhy configuration\n")); - ComPhyPciePhyConfiguration (ComPhyAddr, HpipeAddr); + ComPhyPciePhyConfiguration (Lane, PcieWidth, PcieClk, ComPhyAddr, HpipeAddr); DEBUG((DEBUG_INFO, "ComPhy: stage: Set analog paramters\n")); ComPhyPcieSetAnalogParameters (HpipeAddr); - DEBUG((DEBUG_INFO, "ComPhy: stage: ComPhy power up\n")); + DEBUG ((DEBUG_INFO, "%a: stage: ComPhy power up and check PLL\n", __FUNCTION__)); - ComPhyPciePhyPowerUp (HpipeAddr); - - DEBUG((DEBUG_INFO, "ComPhy: stage: Check PLL\n")); - - Status = ComPhyPcieCheckPll (HpipeAddr); + Status = ComPhyPciePhyPowerUp (Lane, PcieWidth, ComPhyBase, HpipeBase); return Status; } @@ -1780,28 +1885,35 @@ ComPhyCp110Init ( COMPHY_MAP *PtrComPhyMap, *SerdesMap; EFI_PHYSICAL_ADDRESS ComPhyBaseAddr, HpipeBaseAddr; UINT32 ComPhyMaxCount, Lane; - UINT32 PcieBy4 = 1; // Indicating if first 4 lanes set to PCIE + UINT32 PcieWidth = 0; + UINT8 ChipId; ComPhyMaxCount = PtrChipCfg->LanesCount; ComPhyBaseAddr = PtrChipCfg->ComPhyBaseAddr; HpipeBaseAddr = PtrChipCfg->Hpipe3BaseAddr; SerdesMap = PtrChipCfg->MapData; + ChipId = PtrChipCfg->ChipId; /* Config Comphy mux configuration */ ComPhyMuxCp110(PtrChipCfg, SerdesMap); /* Check if the first 4 Lanes configured as By-4 */ for (Lane = 0, PtrComPhyMap = SerdesMap; Lane < 4; Lane++, PtrComPhyMap++) { - if (PtrComPhyMap->Type != COMPHY_TYPE_PCIE0) { - PcieBy4 = 0; + if (PtrComPhyMap->Type != COMPHY_TYPE_PCIE0) break; - } + PcieWidth++; } for (Lane = 0, PtrComPhyMap = SerdesMap; Lane < ComPhyMaxCount; Lane++, PtrComPhyMap++) { DEBUG((DEBUG_INFO, "ComPhy: Initialize serdes number %d\n", Lane)); DEBUG((DEBUG_INFO, "ComPhy: Serdes Type = 0x%x\n", PtrComPhyMap->Type)); + + if (Lane >= 4) { + /* PCIe lanes above the first 4 lanes, can be only by1 */ + PcieWidth = 1; + } + switch (PtrComPhyMap->Type) { case COMPHY_TYPE_UNCONNECTED: continue; @@ -1810,7 +1922,7 @@ ComPhyCp110Init ( case COMPHY_TYPE_PCIE1: case COMPHY_TYPE_PCIE2: case COMPHY_TYPE_PCIE3: - Status = ComPhyPciePowerUp(Lane, PcieBy4, HpipeBaseAddr, ComPhyBaseAddr); + Status = ComPhyPciePowerUp (ChipId, Lane, PcieWidth, HpipeBaseAddr, ComPhyBaseAddr); break; case COMPHY_TYPE_SATA0: case COMPHY_TYPE_SATA1: diff --git a/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.c b/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.c index bf21dca..b03bc35 100644 --- a/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.c +++ b/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.c @@ -192,6 +192,7 @@ InitComPhyConfig ( ChipConfig->Hpipe3BaseAddr = Desc->ComPhyHpipe3BaseAddresses[Id]; ChipConfig->LanesCount = Desc->ComPhyLaneCount[Id]; ChipConfig->MuxBitCount = Desc->ComPhyMuxBitCount[Id]; + ChipConfig->ChipId = Id; /* * Below macro contains variable name concatenation (used to form PCD's name). diff --git a/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.h b/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.h index 5899a4a..c675d74 100644 --- a/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.h +++ b/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.h @@ -252,14 +252,17 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. #define HPIPE_LANE_ALIGN_REG 0x124 #define HPIPE_LANE_ALIGN_OFF_OFFSET 12 +#define HPIPE_LANE_ALIGN_OFF (0x0 << HPIPE_LANE_ALIGN_OFF_OFFSET) #define HPIPE_LANE_ALIGN_OFF_MASK (0x1 << HPIPE_LANE_ALIGN_OFF_OFFSET) #define HPIPE_MISC_REG 0x13C #define HPIPE_MISC_CLK100M_125M_OFFSET 4 +#define HPIPE_MISC_CLK100M_125M_EN (0x1 << HPIPE_MISC_CLK100M_125M_OFFSET) #define HPIPE_MISC_CLK100M_125M_MASK (0x1 << HPIPE_MISC_CLK100M_125M_OFFSET) #define HPIPE_MISC_ICP_FORCE_OFFSET 5 #define HPIPE_MISC_ICP_FORCE_MASK (0x1 << HPIPE_MISC_ICP_FORCE_OFFSET) #define HPIPE_MISC_TXDCLK_2X_OFFSET 6 +#define HPIPE_MISC_TXDCLK_2X_500MHZ (0x0 << HPIPE_MISC_TXDCLK_2X_OFFSET) #define HPIPE_MISC_TXDCLK_2X_MASK (0x1 << HPIPE_MISC_TXDCLK_2X_OFFSET) #define HPIPE_MISC_CLK500_EN_OFFSET 7 #define HPIPE_MISC_CLK500_EN_MASK (0x1 << HPIPE_MISC_CLK500_EN_OFFSET) @@ -476,30 +479,52 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. #define HPIPE_LANE_CFG_FOM_ONLY_MODE_OFFFSET 1 #define HPIPE_LANE_CFG_FOM_ONLY_MODE_MASK (0x1 << HPIPE_LANE_CFG_FOM_ONLY_MODE_OFFFSET) #define HPIPE_LANE_CFG_FOM_PRESET_VECTOR_OFFSET 2 +#define HPIPE_LANE_CFG_FOM_PRESET_VECTOR_DEFAULT (0x1 << HPIPE_LANE_CFG_FOM_PRESET_VECTOR_OFFSET) #define HPIPE_LANE_CFG_FOM_PRESET_VECTOR_MASK (0xf << HPIPE_LANE_CFG_FOM_PRESET_VECTOR_OFFSET) #define HPIPE_RST_CLK_CTRL_REG 0x704 +#define HPIPE_RST_CLK_CTRL_CLR_ALL_MASK MAX_UINT32 #define HPIPE_RST_CLK_CTRL_PIPE_RST_OFFSET 0 +#define HPIPE_RST_CLK_CTRL_PIPE_RST_DISABLE (0x0 << HPIPE_RST_CLK_CTRL_PIPE_RST_OFFSET) #define HPIPE_RST_CLK_CTRL_PIPE_RST_MASK (0x1 << HPIPE_RST_CLK_CTRL_PIPE_RST_OFFSET) #define HPIPE_RST_CLK_CTRL_FIXED_PCLK_OFFSET 2 #define HPIPE_RST_CLK_CTRL_FIXED_PCLK_MASK (0x1 << HPIPE_RST_CLK_CTRL_FIXED_PCLK_OFFSET) +#define HPIPE_RST_CLK_CTRL_FIXED_PCLK_WIDTH_8 (0x1 << HPIPE_RST_CLK_CTRL_FIXED_PCLK_OFFSET) +#define HPIPE_RST_CLK_CTRL_FIXED_PCLK_WIDTH_16 (0x0 << HPIPE_RST_CLK_CTRL_FIXED_PCLK_OFFSET) #define HPIPE_RST_CLK_CTRL_PIPE_WIDTH_OFFSET 3 #define HPIPE_RST_CLK_CTRL_PIPE_WIDTH_MASK (0x1 << HPIPE_RST_CLK_CTRL_PIPE_WIDTH_OFFSET) +#define HPIPE_RST_CLK_CTRL_MODE_REFDIV_OFFSET 4 +#define HPIPE_RST_CLK_CTRL_MODE_REFDIV_MASK (0x3 << HPIPE_RST_CLK_CTRL_MODE_REFDIV_OFFSET) +#define HPIPE_RST_CLK_CTRL_MODE_REFDIV_1 (0x0 << HPIPE_RST_CLK_CTRL_MODE_REFDIV_OFFSET) +#define HPIPE_RST_CLK_CTRL_MODE_REFDIV_2 (0x1 << HPIPE_RST_CLK_CTRL_MODE_REFDIV_OFFSET) +#define HPIPE_RST_CLK_CTRL_MODE_REFDIV_4 (0x2 << HPIPE_RST_CLK_CTRL_MODE_REFDIV_OFFSET) +#define HPIPE_RST_CLK_CTRL_MODE_REFDIV_8 (0x3 << HPIPE_RST_CLK_CTRL_MODE_REFDIV_OFFSET) #define HPIPE_RST_CLK_CTRL_CORE_FREQ_SEL_OFFSET 9 #define HPIPE_RST_CLK_CTRL_CORE_FREQ_SEL_MASK (0x1 << HPIPE_RST_CLK_CTRL_CORE_FREQ_SEL_OFFSET) #define HPIPE_CLK_SRC_LO_REG 0x70c +#define HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SEL_OFFSET 1 +#define HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SEL_DEFAULT (0x1 << HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SEL_OFFSET) +#define HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SEL_MASK (0x1 << HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SEL_OFFSET) +#define HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SCALE_OFFSET 2 +#define HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SCALE_DEFAULT (0x1 << HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SCALE_OFFSET) +#define HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SCALE_MASK (0x3 << HPIPE_CLK_SRC_LO_BUNDLE_PERIOD_SCALE_OFFSET) #define HPIPE_CLK_SRC_LO_PLL_RDY_DL_OFFSET 5 +#define HPIPE_CLK_SRC_LO_PLL_RDY_DL_DEFAULT (0x2 << HPIPE_CLK_SRC_LO_PLL_RDY_DL_OFFSET) #define HPIPE_CLK_SRC_LO_PLL_RDY_DL_MASK (0x7 << HPIPE_CLK_SRC_LO_PLL_RDY_DL_OFFSET) #define HPIPE_CLK_SRC_HI_REG 0x710 #define HPIPE_CLK_SRC_HI_LANE_STRT_OFFSET 0 +#define HPIPE_CLK_SRC_HI_LANE_STRT_EN (0x1 << HPIPE_CLK_SRC_HI_LANE_STRT_OFFSET) #define HPIPE_CLK_SRC_HI_LANE_STRT_MASK (0x1 << HPIPE_CLK_SRC_HI_LANE_STRT_OFFSET) #define HPIPE_CLK_SRC_HI_LANE_BREAK_OFFSET 1 +#define HPIPE_CLK_SRC_HI_LANE_BREAK_EN (0x1 << HPIPE_CLK_SRC_HI_LANE_BREAK_OFFSET) #define HPIPE_CLK_SRC_HI_LANE_BREAK_MASK (0x1 << HPIPE_CLK_SRC_HI_LANE_BREAK_OFFSET) #define HPIPE_CLK_SRC_HI_LANE_MASTER_OFFSET 2 +#define HPIPE_CLK_SRC_HI_LANE_MASTER_EN (0x1 << HPIPE_CLK_SRC_HI_LANE_MASTER_OFFSET) #define HPIPE_CLK_SRC_HI_LANE_MASTER_MASK (0x1 << HPIPE_CLK_SRC_HI_LANE_MASTER_OFFSET) #define HPIPE_CLK_SRC_HI_MODE_PIPE_OFFSET 7 +#define HPIPE_CLK_SRC_HI_MODE_PIPE_EN (0x1 << HPIPE_CLK_SRC_HI_MODE_PIPE_OFFSET) #define HPIPE_CLK_SRC_HI_MODE_PIPE_MASK (0x1 << HPIPE_CLK_SRC_HI_MODE_PIPE_OFFSET) #define HPIPE_GLOBAL_MISC_CTRL 0x718 @@ -528,6 +553,16 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. #define COMMON_SELECTOR_PIPE_OFFSET 0x144 #define COMMON_PHY_SD_CTRL1 0x148 +#define COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_OFFSET 0 +#define COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_WR_ENABLE 0x0 +#define COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_WR_DISABLE 0x3210 +#define COMMON_PHY_SD_CTRL1_COMPHY_0_4_PORT_MASK 0xFFFF +#define COMMON_PHY_SD_CTRL1_PCIE_X4_EN_OFFSET 24 +#define COMMON_PHY_SD_CTRL1_PCIE_X4_EN (0x1 << COMMON_PHY_SD_CTRL1_PCIE_X4_EN_OFFSET) +#define COMMON_PHY_SD_CTRL1_PCIE_X4_EN_MASK (0x1 << COMMON_PHY_SD_CTRL1_PCIE_X4_EN_OFFSET) +#define COMMON_PHY_SD_CTRL1_PCIE_X2_EN_OFFSET 25 +#define COMMON_PHY_SD_CTRL1_PCIE_X2_EN (0x1 << COMMON_PHY_SD_CTRL1_PCIE_X2_EN_OFFSET) +#define COMMON_PHY_SD_CTRL1_PCIE_X2_EN_MASK (0x1 << COMMON_PHY_SD_CTRL1_PCIE_X2_EN_OFFSET) #define COMMON_PHY_SD_CTRL1_RXAUI1_OFFSET 26 #define COMMON_PHY_SD_CTRL1_RXAUI1_MASK (0x1 << COMMON_PHY_SD_CTRL1_RXAUI1_OFFSET) #define COMMON_PHY_SD_CTRL1_RXAUI0_OFFSET 27 @@ -594,6 +629,7 @@ struct _CHIP_COMPHY_CONFIG { COMPHY_CHIP_INIT Init; UINT32 LanesCount; UINT32 MuxBitCount; + UINT8 ChipId; }; VOID diff --git a/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.inf b/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.inf index a1584b4..ce0af54 100644 --- a/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.inf +++ b/Silicon/Marvell/Library/ComPhyLib/ComPhyLib.inf @@ -50,6 +50,7 @@ DebugLib MemoryAllocationLib PcdLib + SampleAtResetLib IoLib [Sources.common] -- 2.7.4