|
@@ -0,0 +1,690 @@
|
|
|
|
+/*
|
|
|
|
+ * ***************************************************************************
|
|
|
|
+ * Copyright (C) 2015 Marvell International Ltd.
|
|
|
|
+ * ***************************************************************************
|
|
|
|
+ * This program is free software: you can redistribute it and/or modify it
|
|
|
|
+ * under the terms of the GNU General Public License as published by the Free
|
|
|
|
+ * Software Foundation, either version 2 of the License, or any later version.
|
|
|
|
+ *
|
|
|
|
+ * This program is distributed in the hope that it will be useful,
|
|
|
|
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
+ * GNU General Public License for more details.
|
|
|
|
+ *
|
|
|
|
+ * You should have received a copy of the GNU General Public License
|
|
|
|
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
+ * ***************************************************************************
|
|
|
|
+ */
|
|
|
|
+/* pcie_advk.c
|
|
|
|
+ *
|
|
|
|
+ * Ported from Linux driver - driver/pci/host/pci-aardvark.c
|
|
|
|
+ *
|
|
|
|
+ * Author: Victor Gu <xigu@marvell.com>
|
|
|
|
+ * Hezi Shahmoon <hezi.shahmoon@marvell.com>
|
|
|
|
+ *
|
|
|
|
+ */
|
|
|
|
+
|
|
|
|
+#include <common.h>
|
|
|
|
+#include <dm.h>
|
|
|
|
+#include <pci.h>
|
|
|
|
+#include <asm/io.h>
|
|
|
|
+#include <asm-generic/gpio.h>
|
|
|
|
+#include <linux/ioport.h>
|
|
|
|
+
|
|
|
|
+/* PCIe core registers */
|
|
|
|
+#define PCIE_CORE_CMD_STATUS_REG 0x4
|
|
|
|
+#define PCIE_CORE_CMD_IO_ACCESS_EN BIT(0)
|
|
|
|
+#define PCIE_CORE_CMD_MEM_ACCESS_EN BIT(1)
|
|
|
|
+#define PCIE_CORE_CMD_MEM_IO_REQ_EN BIT(2)
|
|
|
|
+#define PCIE_CORE_DEV_CTRL_STATS_REG 0xc8
|
|
|
|
+#define PCIE_CORE_DEV_CTRL_STATS_RELAX_ORDER_DISABLE (0 << 4)
|
|
|
|
+#define PCIE_CORE_DEV_CTRL_STATS_SNOOP_DISABLE (0 << 11)
|
|
|
|
+#define PCIE_CORE_LINK_CTRL_STAT_REG 0xd0
|
|
|
|
+#define PCIE_CORE_LINK_TRAINING BIT(5)
|
|
|
|
+#define PCIE_CORE_ERR_CAPCTL_REG 0x118
|
|
|
|
+#define PCIE_CORE_ERR_CAPCTL_ECRC_CHK_TX BIT(5)
|
|
|
|
+#define PCIE_CORE_ERR_CAPCTL_ECRC_CHK_TX_EN BIT(6)
|
|
|
|
+#define PCIE_CORE_ERR_CAPCTL_ECRC_CHECK BIT(7)
|
|
|
|
+#define PCIE_CORE_ERR_CAPCTL_ECRC_CHECK_RCV BIT(8)
|
|
|
|
+
|
|
|
|
+/* PIO registers base address and register offsets */
|
|
|
|
+#define PIO_BASE_ADDR 0x4000
|
|
|
|
+#define PIO_CTRL (PIO_BASE_ADDR + 0x0)
|
|
|
|
+#define PIO_CTRL_TYPE_MASK GENMASK(3, 0)
|
|
|
|
+#define PIO_CTRL_ADDR_WIN_DISABLE BIT(24)
|
|
|
|
+#define PIO_STAT (PIO_BASE_ADDR + 0x4)
|
|
|
|
+#define PIO_COMPLETION_STATUS_SHIFT 7
|
|
|
|
+#define PIO_COMPLETION_STATUS_MASK GENMASK(9, 7)
|
|
|
|
+#define PIO_COMPLETION_STATUS_OK 0
|
|
|
|
+#define PIO_COMPLETION_STATUS_UR 1
|
|
|
|
+#define PIO_COMPLETION_STATUS_CRS 2
|
|
|
|
+#define PIO_COMPLETION_STATUS_CA 4
|
|
|
|
+#define PIO_NON_POSTED_REQ BIT(10)
|
|
|
|
+#define PIO_ERR_STATUS BIT(11)
|
|
|
|
+#define PIO_ADDR_LS (PIO_BASE_ADDR + 0x8)
|
|
|
|
+#define PIO_ADDR_MS (PIO_BASE_ADDR + 0xc)
|
|
|
|
+#define PIO_WR_DATA (PIO_BASE_ADDR + 0x10)
|
|
|
|
+#define PIO_WR_DATA_STRB (PIO_BASE_ADDR + 0x14)
|
|
|
|
+#define PIO_RD_DATA (PIO_BASE_ADDR + 0x18)
|
|
|
|
+#define PIO_START (PIO_BASE_ADDR + 0x1c)
|
|
|
|
+#define PIO_ISR (PIO_BASE_ADDR + 0x20)
|
|
|
|
+
|
|
|
|
+/* Aardvark Control registers */
|
|
|
|
+#define CONTROL_BASE_ADDR 0x4800
|
|
|
|
+#define PCIE_CORE_CTRL0_REG (CONTROL_BASE_ADDR + 0x0)
|
|
|
|
+#define PCIE_GEN_SEL_MSK 0x3
|
|
|
|
+#define PCIE_GEN_SEL_SHIFT 0x0
|
|
|
|
+#define SPEED_GEN_1 0
|
|
|
|
+#define SPEED_GEN_2 1
|
|
|
|
+#define SPEED_GEN_3 2
|
|
|
|
+#define IS_RC_MSK 1
|
|
|
|
+#define IS_RC_SHIFT 2
|
|
|
|
+#define LANE_CNT_MSK 0x18
|
|
|
|
+#define LANE_CNT_SHIFT 0x3
|
|
|
|
+#define LANE_COUNT_1 (0 << LANE_CNT_SHIFT)
|
|
|
|
+#define LANE_COUNT_2 (1 << LANE_CNT_SHIFT)
|
|
|
|
+#define LANE_COUNT_4 (2 << LANE_CNT_SHIFT)
|
|
|
|
+#define LANE_COUNT_8 (3 << LANE_CNT_SHIFT)
|
|
|
|
+#define LINK_TRAINING_EN BIT(6)
|
|
|
|
+#define PCIE_CORE_CTRL2_REG (CONTROL_BASE_ADDR + 0x8)
|
|
|
|
+#define PCIE_CORE_CTRL2_RESERVED 0x7
|
|
|
|
+#define PCIE_CORE_CTRL2_TD_ENABLE BIT(4)
|
|
|
|
+#define PCIE_CORE_CTRL2_STRICT_ORDER_ENABLE BIT(5)
|
|
|
|
+#define PCIE_CORE_CTRL2_ADDRWIN_MAP_ENABLE BIT(6)
|
|
|
|
+
|
|
|
|
+/* LMI registers base address and register offsets */
|
|
|
|
+#define LMI_BASE_ADDR 0x6000
|
|
|
|
+#define CFG_REG (LMI_BASE_ADDR + 0x0)
|
|
|
|
+#define LTSSM_SHIFT 24
|
|
|
|
+#define LTSSM_MASK 0x3f
|
|
|
|
+#define LTSSM_L0 0x10
|
|
|
|
+
|
|
|
|
+/* PCIe core controller registers */
|
|
|
|
+#define CTRL_CORE_BASE_ADDR 0x18000
|
|
|
|
+#define CTRL_CONFIG_REG (CTRL_CORE_BASE_ADDR + 0x0)
|
|
|
|
+#define CTRL_MODE_SHIFT 0x0
|
|
|
|
+#define CTRL_MODE_MASK 0x1
|
|
|
|
+#define PCIE_CORE_MODE_DIRECT 0x0
|
|
|
|
+#define PCIE_CORE_MODE_COMMAND 0x1
|
|
|
|
+
|
|
|
|
+/* Transaction types */
|
|
|
|
+#define PCIE_CONFIG_RD_TYPE0 0x8
|
|
|
|
+#define PCIE_CONFIG_RD_TYPE1 0x9
|
|
|
|
+#define PCIE_CONFIG_WR_TYPE0 0xa
|
|
|
|
+#define PCIE_CONFIG_WR_TYPE1 0xb
|
|
|
|
+
|
|
|
|
+/* PCI_BDF shifts 8bit, so we need extra 4bit shift */
|
|
|
|
+#define PCIE_BDF(dev) (dev << 4)
|
|
|
|
+#define PCIE_CONF_BUS(bus) (((bus) & 0xff) << 20)
|
|
|
|
+#define PCIE_CONF_DEV(dev) (((dev) & 0x1f) << 15)
|
|
|
|
+#define PCIE_CONF_FUNC(fun) (((fun) & 0x7) << 12)
|
|
|
|
+#define PCIE_CONF_REG(reg) ((reg) & 0xffc)
|
|
|
|
+#define PCIE_CONF_ADDR(bus, devfn, where) \
|
|
|
|
+ (PCIE_CONF_BUS(bus) | PCIE_CONF_DEV(PCI_SLOT(devfn)) | \
|
|
|
|
+ PCIE_CONF_FUNC(PCI_FUNC(devfn)) | PCIE_CONF_REG(where))
|
|
|
|
+
|
|
|
|
+/* PCIe Retries & Timeout definitions */
|
|
|
|
+#define MAX_RETRIES 10
|
|
|
|
+#define PIO_WAIT_TIMEOUT 100
|
|
|
|
+#define LINK_WAIT_TIMEOUT 100000
|
|
|
|
+
|
|
|
|
+#define CFG_RD_UR_VAL 0xFFFFFFFF
|
|
|
|
+#define CFG_RD_CRS_VAL 0xFFFF0001
|
|
|
|
+
|
|
|
|
+DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * struct pcie_advk - Advk PCIe controller state
|
|
|
|
+ *
|
|
|
|
+ * @reg_base: The base address of the register space.
|
|
|
|
+ * @first_busno: This driver supports multiple PCIe controllers.
|
|
|
|
+ * first_busno stores the bus number of the PCIe root-port
|
|
|
|
+ * number which may vary depending on the PCIe setup
|
|
|
|
+ * (PEX switches etc).
|
|
|
|
+ * @device: The pointer to PCI uclass device.
|
|
|
|
+ */
|
|
|
|
+struct pcie_advk {
|
|
|
|
+ void *base;
|
|
|
|
+ int first_busno;
|
|
|
|
+ struct udevice *dev;
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static inline void advk_writel(struct pcie_advk *pcie, uint val, uint reg)
|
|
|
|
+{
|
|
|
|
+ writel(val, pcie->base + reg);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static inline uint advk_readl(struct pcie_advk *pcie, uint reg)
|
|
|
|
+{
|
|
|
|
+ return readl(pcie->base + reg);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_addr_valid() - Check for valid bus address
|
|
|
|
+ *
|
|
|
|
+ * @bdf: The PCI device to access
|
|
|
|
+ * @first_busno: Bus number of the PCIe controller root complex
|
|
|
|
+ *
|
|
|
|
+ * Return: 1 on valid, 0 on invalid
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_addr_valid(pci_dev_t bdf, int first_busno)
|
|
|
|
+{
|
|
|
|
+ /*
|
|
|
|
+ * In PCIE-E only a single device (0) can exist
|
|
|
|
+ * on the local bus. Beyound the local bus, there might be
|
|
|
|
+ * a Switch and everything is possible.
|
|
|
|
+ */
|
|
|
|
+ if ((PCI_BUS(bdf) == first_busno) && (PCI_DEV(bdf) > 0))
|
|
|
|
+ return 0;
|
|
|
|
+
|
|
|
|
+ return 1;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_wait_pio() - Wait for PIO access to be accomplished
|
|
|
|
+ *
|
|
|
|
+ * @pcie: The PCI device to access
|
|
|
|
+ *
|
|
|
|
+ * Wait up to 1 micro second for PIO access to be accomplished.
|
|
|
|
+ *
|
|
|
|
+ * Return 1 (true) if PIO access is accomplished.
|
|
|
|
+ * Return 0 (false) if PIO access is timed out.
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_wait_pio(struct pcie_advk *pcie)
|
|
|
|
+{
|
|
|
|
+ uint start, isr;
|
|
|
|
+ uint count;
|
|
|
|
+
|
|
|
|
+ for (count = 0; count < MAX_RETRIES; count++) {
|
|
|
|
+ start = advk_readl(pcie, PIO_START);
|
|
|
|
+ isr = advk_readl(pcie, PIO_ISR);
|
|
|
|
+ if (!start && isr)
|
|
|
|
+ return 1;
|
|
|
|
+ /*
|
|
|
|
+ * Do not check the PIO state too frequently,
|
|
|
|
+ * 100us delay is appropriate.
|
|
|
|
+ */
|
|
|
|
+ udelay(PIO_WAIT_TIMEOUT);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ dev_err(pcie->dev, "config read/write timed out\n");
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_check_pio_status() - Validate PIO status and get the read result
|
|
|
|
+ *
|
|
|
|
+ * @pcie: Pointer to the PCI bus
|
|
|
|
+ * @read: Read from or write to configuration space - true(read) false(write)
|
|
|
|
+ * @read_val: Pointer to the read result, only valid when read is true
|
|
|
|
+ *
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_check_pio_status(struct pcie_advk *pcie,
|
|
|
|
+ bool read,
|
|
|
|
+ uint *read_val)
|
|
|
|
+{
|
|
|
|
+ uint reg;
|
|
|
|
+ unsigned int status;
|
|
|
|
+ char *strcomp_status, *str_posted;
|
|
|
|
+
|
|
|
|
+ reg = advk_readl(pcie, PIO_STAT);
|
|
|
|
+ status = (reg & PIO_COMPLETION_STATUS_MASK) >>
|
|
|
|
+ PIO_COMPLETION_STATUS_SHIFT;
|
|
|
|
+
|
|
|
|
+ switch (status) {
|
|
|
|
+ case PIO_COMPLETION_STATUS_OK:
|
|
|
|
+ if (reg & PIO_ERR_STATUS) {
|
|
|
|
+ strcomp_status = "COMP_ERR";
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ /* Get the read result */
|
|
|
|
+ if (read)
|
|
|
|
+ *read_val = advk_readl(pcie, PIO_RD_DATA);
|
|
|
|
+ /* No error */
|
|
|
|
+ strcomp_status = NULL;
|
|
|
|
+ break;
|
|
|
|
+ case PIO_COMPLETION_STATUS_UR:
|
|
|
|
+ if (read) {
|
|
|
|
+ /* For reading, UR is not an error status. */
|
|
|
|
+ *read_val = CFG_RD_UR_VAL;
|
|
|
|
+ strcomp_status = NULL;
|
|
|
|
+ } else {
|
|
|
|
+ strcomp_status = "UR";
|
|
|
|
+ }
|
|
|
|
+ break;
|
|
|
|
+ case PIO_COMPLETION_STATUS_CRS:
|
|
|
|
+ if (read) {
|
|
|
|
+ /* For reading, CRS is not an error status. */
|
|
|
|
+ *read_val = CFG_RD_CRS_VAL;
|
|
|
|
+ strcomp_status = NULL;
|
|
|
|
+ } else {
|
|
|
|
+ strcomp_status = "CRS";
|
|
|
|
+ }
|
|
|
|
+ break;
|
|
|
|
+ case PIO_COMPLETION_STATUS_CA:
|
|
|
|
+ strcomp_status = "CA";
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ strcomp_status = "Unknown";
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (!strcomp_status)
|
|
|
|
+ return 0;
|
|
|
|
+
|
|
|
|
+ if (reg & PIO_NON_POSTED_REQ)
|
|
|
|
+ str_posted = "Non-posted";
|
|
|
|
+ else
|
|
|
|
+ str_posted = "Posted";
|
|
|
|
+
|
|
|
|
+ dev_err(pcie->dev, "%s PIO Response Status: %s, %#x @ %#x\n",
|
|
|
|
+ str_posted, strcomp_status, reg,
|
|
|
|
+ advk_readl(pcie, PIO_ADDR_LS));
|
|
|
|
+
|
|
|
|
+ return -EFAULT;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_read_config() - Read from configuration space
|
|
|
|
+ *
|
|
|
|
+ * @bus: Pointer to the PCI bus
|
|
|
|
+ * @bdf: Identifies the PCIe device to access
|
|
|
|
+ * @offset: The offset into the device's configuration space
|
|
|
|
+ * @valuep: A pointer at which to store the read value
|
|
|
|
+ * @size: Indicates the size of access to perform
|
|
|
|
+ *
|
|
|
|
+ * Read a value of size @size from offset @offset within the configuration
|
|
|
|
+ * space of the device identified by the bus, device & function numbers in @bdf
|
|
|
|
+ * on the PCI bus @bus.
|
|
|
|
+ *
|
|
|
|
+ * Return: 0 on success
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_read_config(struct udevice *bus, pci_dev_t bdf,
|
|
|
|
+ uint offset, ulong *valuep,
|
|
|
|
+ enum pci_size_t size)
|
|
|
|
+{
|
|
|
|
+ struct pcie_advk *pcie = dev_get_priv(bus);
|
|
|
|
+ uint reg;
|
|
|
|
+ int ret;
|
|
|
|
+
|
|
|
|
+ dev_dbg(pcie->dev, "PCIE CFG read: (b,d,f)=(%2d,%2d,%2d) ",
|
|
|
|
+ PCI_BUS(bdf), PCI_DEV(bdf), PCI_FUNC(bdf));
|
|
|
|
+
|
|
|
|
+ if (!pcie_advk_addr_valid(bdf, pcie->first_busno)) {
|
|
|
|
+ dev_dbg(pcie->dev, "- out of range\n");
|
|
|
|
+ *valuep = pci_get_ff(size);
|
|
|
|
+ return 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* Start PIO */
|
|
|
|
+ advk_writel(pcie, 0, PIO_START);
|
|
|
|
+ advk_writel(pcie, 1, PIO_ISR);
|
|
|
|
+
|
|
|
|
+ /* Program the control register */
|
|
|
|
+ reg = advk_readl(pcie, PIO_CTRL);
|
|
|
|
+ reg &= ~PIO_CTRL_TYPE_MASK;
|
|
|
|
+ if (PCI_BUS(bdf) == pcie->first_busno)
|
|
|
|
+ reg |= PCIE_CONFIG_RD_TYPE0;
|
|
|
|
+ else
|
|
|
|
+ reg |= PCIE_CONFIG_RD_TYPE1;
|
|
|
|
+ advk_writel(pcie, reg, PIO_CTRL);
|
|
|
|
+
|
|
|
|
+ /* Program the address registers */
|
|
|
|
+ reg = PCIE_BDF(bdf) | PCIE_CONF_REG(offset);
|
|
|
|
+ advk_writel(pcie, reg, PIO_ADDR_LS);
|
|
|
|
+ advk_writel(pcie, 0, PIO_ADDR_MS);
|
|
|
|
+
|
|
|
|
+ /* Start the transfer */
|
|
|
|
+ advk_writel(pcie, 1, PIO_START);
|
|
|
|
+
|
|
|
|
+ if (!pcie_advk_wait_pio(pcie))
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
|
|
+ /* Check PIO status and get the read result */
|
|
|
|
+ ret = pcie_advk_check_pio_status(pcie, true, ®);
|
|
|
|
+ if (ret)
|
|
|
|
+ return ret;
|
|
|
|
+
|
|
|
|
+ dev_dbg(pcie->dev, "(addr,size,val)=(0x%04x, %d, 0x%08x)\n",
|
|
|
|
+ offset, size, reg);
|
|
|
|
+ *valuep = pci_conv_32_to_size(reg, offset, size);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_calc_datastrobe() - Calculate data strobe
|
|
|
|
+ *
|
|
|
|
+ * @offset: The offset into the device's configuration space
|
|
|
|
+ * @size: Indicates the size of access to perform
|
|
|
|
+ *
|
|
|
|
+ * Calculate data strobe according to offset and size
|
|
|
|
+ *
|
|
|
|
+ */
|
|
|
|
+static uint pcie_calc_datastrobe(uint offset, enum pci_size_t size)
|
|
|
|
+{
|
|
|
|
+ uint bytes, data_strobe;
|
|
|
|
+
|
|
|
|
+ switch (size) {
|
|
|
|
+ case PCI_SIZE_8:
|
|
|
|
+ bytes = 1;
|
|
|
|
+ break;
|
|
|
|
+ case PCI_SIZE_16:
|
|
|
|
+ bytes = 2;
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ bytes = 4;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ data_strobe = GENMASK(bytes - 1, 0) << (offset & 0x3);
|
|
|
|
+
|
|
|
|
+ return data_strobe;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_write_config() - Write to configuration space
|
|
|
|
+ *
|
|
|
|
+ * @bus: Pointer to the PCI bus
|
|
|
|
+ * @bdf: Identifies the PCIe device to access
|
|
|
|
+ * @offset: The offset into the device's configuration space
|
|
|
|
+ * @value: The value to write
|
|
|
|
+ * @size: Indicates the size of access to perform
|
|
|
|
+ *
|
|
|
|
+ * Write the value @value of size @size from offset @offset within the
|
|
|
|
+ * configuration space of the device identified by the bus, device & function
|
|
|
|
+ * numbers in @bdf on the PCI bus @bus.
|
|
|
|
+ *
|
|
|
|
+ * Return: 0 on success
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_write_config(struct udevice *bus, pci_dev_t bdf,
|
|
|
|
+ uint offset, ulong value,
|
|
|
|
+ enum pci_size_t size)
|
|
|
|
+{
|
|
|
|
+ struct pcie_advk *pcie = dev_get_priv(bus);
|
|
|
|
+ uint reg;
|
|
|
|
+
|
|
|
|
+ dev_dbg(pcie->dev, "PCIE CFG write: (b,d,f)=(%2d,%2d,%2d) ",
|
|
|
|
+ PCI_BUS(bdf), PCI_DEV(bdf), PCI_FUNC(bdf));
|
|
|
|
+ dev_dbg(pcie->dev, "(addr,size,val)=(0x%04x, %d, 0x%08lx)\n",
|
|
|
|
+ offset, size, value);
|
|
|
|
+
|
|
|
|
+ if (!pcie_advk_addr_valid(bdf, pcie->first_busno)) {
|
|
|
|
+ dev_dbg(pcie->dev, "- out of range\n");
|
|
|
|
+ return 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* Start PIO */
|
|
|
|
+ advk_writel(pcie, 0, PIO_START);
|
|
|
|
+ advk_writel(pcie, 1, PIO_ISR);
|
|
|
|
+
|
|
|
|
+ /* Program the control register */
|
|
|
|
+ reg = advk_readl(pcie, PIO_CTRL);
|
|
|
|
+ reg &= ~PIO_CTRL_TYPE_MASK;
|
|
|
|
+ if (PCI_BUS(bdf) == pcie->first_busno)
|
|
|
|
+ reg |= PCIE_CONFIG_WR_TYPE0;
|
|
|
|
+ else
|
|
|
|
+ reg |= PCIE_CONFIG_WR_TYPE1;
|
|
|
|
+ advk_writel(pcie, reg, PIO_CTRL);
|
|
|
|
+
|
|
|
|
+ /* Program the address registers */
|
|
|
|
+ reg = PCIE_BDF(bdf) | PCIE_CONF_REG(offset);
|
|
|
|
+ advk_writel(pcie, reg, PIO_ADDR_LS);
|
|
|
|
+ advk_writel(pcie, 0, PIO_ADDR_MS);
|
|
|
|
+ dev_dbg(pcie->dev, "\tPIO req. - addr = 0x%08x\n", reg);
|
|
|
|
+
|
|
|
|
+ /* Program the data register */
|
|
|
|
+ reg = pci_conv_size_to_32(0, value, offset, size);
|
|
|
|
+ advk_writel(pcie, reg, PIO_WR_DATA);
|
|
|
|
+ dev_dbg(pcie->dev, "\tPIO req. - val = 0x%08x\n", reg);
|
|
|
|
+
|
|
|
|
+ /* Program the data strobe */
|
|
|
|
+ reg = pcie_calc_datastrobe(offset, size);
|
|
|
|
+ advk_writel(pcie, reg, PIO_WR_DATA_STRB);
|
|
|
|
+ dev_dbg(pcie->dev, "\tPIO req. - strb = 0x%02x\n", reg);
|
|
|
|
+
|
|
|
|
+ /* Start the transfer */
|
|
|
|
+ advk_writel(pcie, 1, PIO_START);
|
|
|
|
+
|
|
|
|
+ if (!pcie_advk_wait_pio(pcie)) {
|
|
|
|
+ dev_dbg(pcie->dev, "- wait pio timeout\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* Check PIO status */
|
|
|
|
+ pcie_advk_check_pio_status(pcie, false, ®);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_link_up() - Check if PCIe link is up or not
|
|
|
|
+ *
|
|
|
|
+ * @pcie: The PCI device to access
|
|
|
|
+ *
|
|
|
|
+ * Return 1 (true) on link up.
|
|
|
|
+ * Return 0 (false) on link down.
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_link_up(struct pcie_advk *pcie)
|
|
|
|
+{
|
|
|
|
+ u32 val, ltssm_state;
|
|
|
|
+
|
|
|
|
+ val = advk_readl(pcie, CFG_REG);
|
|
|
|
+ ltssm_state = (val >> LTSSM_SHIFT) & LTSSM_MASK;
|
|
|
|
+ return ltssm_state >= LTSSM_L0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_wait_for_link() - Wait for link training to be accomplished
|
|
|
|
+ *
|
|
|
|
+ * @pcie: The PCI device to access
|
|
|
|
+ *
|
|
|
|
+ * Wait up to 1 second for link training to be accomplished.
|
|
|
|
+ *
|
|
|
|
+ * Return 1 (true) if link training ends up with link up success.
|
|
|
|
+ * Return 0 (false) if link training ends up with link up failure.
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_wait_for_link(struct pcie_advk *pcie)
|
|
|
|
+{
|
|
|
|
+ int retries;
|
|
|
|
+
|
|
|
|
+ /* check if the link is up or not */
|
|
|
|
+ for (retries = 0; retries < MAX_RETRIES; retries++) {
|
|
|
|
+ if (pcie_advk_link_up(pcie)) {
|
|
|
|
+ printf("PCIE-%d: Link up\n", pcie->first_busno);
|
|
|
|
+ return 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ udelay(LINK_WAIT_TIMEOUT);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ printf("PCIE-%d: Link down\n", pcie->first_busno);
|
|
|
|
+
|
|
|
|
+ return -ETIMEDOUT;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_setup_hw() - PCIe initailzation
|
|
|
|
+ *
|
|
|
|
+ * @pcie: The PCI device to access
|
|
|
|
+ *
|
|
|
|
+ * Return: 0 on success
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_setup_hw(struct pcie_advk *pcie)
|
|
|
|
+{
|
|
|
|
+ u32 reg;
|
|
|
|
+
|
|
|
|
+ /* Set to Direct mode */
|
|
|
|
+ reg = advk_readl(pcie, CTRL_CONFIG_REG);
|
|
|
|
+ reg &= ~(CTRL_MODE_MASK << CTRL_MODE_SHIFT);
|
|
|
|
+ reg |= ((PCIE_CORE_MODE_DIRECT & CTRL_MODE_MASK) << CTRL_MODE_SHIFT);
|
|
|
|
+ advk_writel(pcie, reg, CTRL_CONFIG_REG);
|
|
|
|
+
|
|
|
|
+ /* Set PCI global control register to RC mode */
|
|
|
|
+ reg = advk_readl(pcie, PCIE_CORE_CTRL0_REG);
|
|
|
|
+ reg |= (IS_RC_MSK << IS_RC_SHIFT);
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_CTRL0_REG);
|
|
|
|
+
|
|
|
|
+ /* Set Advanced Error Capabilities and Control PF0 register */
|
|
|
|
+ reg = PCIE_CORE_ERR_CAPCTL_ECRC_CHK_TX |
|
|
|
|
+ PCIE_CORE_ERR_CAPCTL_ECRC_CHK_TX_EN |
|
|
|
|
+ PCIE_CORE_ERR_CAPCTL_ECRC_CHECK |
|
|
|
|
+ PCIE_CORE_ERR_CAPCTL_ECRC_CHECK_RCV;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_ERR_CAPCTL_REG);
|
|
|
|
+
|
|
|
|
+ /* Set PCIe Device Control and Status 1 PF0 register */
|
|
|
|
+ reg = PCIE_CORE_DEV_CTRL_STATS_RELAX_ORDER_DISABLE |
|
|
|
|
+ PCIE_CORE_DEV_CTRL_STATS_SNOOP_DISABLE;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_DEV_CTRL_STATS_REG);
|
|
|
|
+
|
|
|
|
+ /* Program PCIe Control 2 to disable strict ordering */
|
|
|
|
+ reg = PCIE_CORE_CTRL2_RESERVED |
|
|
|
|
+ PCIE_CORE_CTRL2_TD_ENABLE;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_CTRL2_REG);
|
|
|
|
+
|
|
|
|
+ /* Set GEN2 */
|
|
|
|
+ reg = advk_readl(pcie, PCIE_CORE_CTRL0_REG);
|
|
|
|
+ reg &= ~PCIE_GEN_SEL_MSK;
|
|
|
|
+ reg |= SPEED_GEN_2;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_CTRL0_REG);
|
|
|
|
+
|
|
|
|
+ /* Set lane X1 */
|
|
|
|
+ reg = advk_readl(pcie, PCIE_CORE_CTRL0_REG);
|
|
|
|
+ reg &= ~LANE_CNT_MSK;
|
|
|
|
+ reg |= LANE_COUNT_1;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_CTRL0_REG);
|
|
|
|
+
|
|
|
|
+ /* Enable link training */
|
|
|
|
+ reg = advk_readl(pcie, PCIE_CORE_CTRL0_REG);
|
|
|
|
+ reg |= LINK_TRAINING_EN;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_CTRL0_REG);
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * Enable AXI address window location generation:
|
|
|
|
+ * When it is enabled, the default outbound window
|
|
|
|
+ * configurations (Default User Field: 0xD0074CFC)
|
|
|
|
+ * are used to transparent address translation for
|
|
|
|
+ * the outbound transactions. Thus, PCIe address
|
|
|
|
+ * windows are not required.
|
|
|
|
+ */
|
|
|
|
+ reg = advk_readl(pcie, PCIE_CORE_CTRL2_REG);
|
|
|
|
+ reg |= PCIE_CORE_CTRL2_ADDRWIN_MAP_ENABLE;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_CTRL2_REG);
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * Bypass the address window mapping for PIO:
|
|
|
|
+ * Since PIO access already contains all required
|
|
|
|
+ * info over AXI interface by PIO registers, the
|
|
|
|
+ * address window is not required.
|
|
|
|
+ */
|
|
|
|
+ reg = advk_readl(pcie, PIO_CTRL);
|
|
|
|
+ reg |= PIO_CTRL_ADDR_WIN_DISABLE;
|
|
|
|
+ advk_writel(pcie, reg, PIO_CTRL);
|
|
|
|
+
|
|
|
|
+ /* Start link training */
|
|
|
|
+ reg = advk_readl(pcie, PCIE_CORE_LINK_CTRL_STAT_REG);
|
|
|
|
+ reg |= PCIE_CORE_LINK_TRAINING;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_LINK_CTRL_STAT_REG);
|
|
|
|
+
|
|
|
|
+ /* Wait for PCIe link up */
|
|
|
|
+ if (pcie_advk_wait_for_link(pcie))
|
|
|
|
+ return -ENXIO;
|
|
|
|
+
|
|
|
|
+ reg = advk_readl(pcie, PCIE_CORE_CMD_STATUS_REG);
|
|
|
|
+ reg |= PCIE_CORE_CMD_MEM_ACCESS_EN |
|
|
|
|
+ PCIE_CORE_CMD_IO_ACCESS_EN |
|
|
|
|
+ PCIE_CORE_CMD_MEM_IO_REQ_EN;
|
|
|
|
+ advk_writel(pcie, reg, PCIE_CORE_CMD_STATUS_REG);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_probe() - Probe the PCIe bus for active link
|
|
|
|
+ *
|
|
|
|
+ * @dev: A pointer to the device being operated on
|
|
|
|
+ *
|
|
|
|
+ * Probe for an active link on the PCIe bus and configure the controller
|
|
|
|
+ * to enable this port.
|
|
|
|
+ *
|
|
|
|
+ * Return: 0 on success, else -ENODEV
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_probe(struct udevice *dev)
|
|
|
|
+{
|
|
|
|
+ struct pcie_advk *pcie = dev_get_priv(dev);
|
|
|
|
+
|
|
|
|
+#ifdef CONFIG_DM_GPIO
|
|
|
|
+ struct gpio_desc reset_gpio;
|
|
|
|
+
|
|
|
|
+ gpio_request_by_name(dev, "reset-gpio", 0, &reset_gpio,
|
|
|
|
+ GPIOD_IS_OUT);
|
|
|
|
+ /*
|
|
|
|
+ * Issue reset to add-in card through the dedicated GPIO.
|
|
|
|
+ * Some boards are connecting the card reset pin to common system
|
|
|
|
+ * reset wire and others are using separate GPIO port.
|
|
|
|
+ * In the last case we have to release a reset of the addon card
|
|
|
|
+ * using this GPIO.
|
|
|
|
+ *
|
|
|
|
+ * FIX-ME:
|
|
|
|
+ * The PCIe RESET signal is not supposed to be released along
|
|
|
|
+ * with the SOC RESET signal. It should be lowered as early as
|
|
|
|
+ * possible before PCIe PHY initialization. Moreover, the PCIe
|
|
|
|
+ * clock should be gated as well.
|
|
|
|
+ */
|
|
|
|
+ if (dm_gpio_is_valid(&reset_gpio)) {
|
|
|
|
+ dev_dbg(pcie->dev, "Toggle PCIE Reset GPIO ...\n");
|
|
|
|
+ dm_gpio_set_value(&reset_gpio, 0);
|
|
|
|
+ mdelay(200);
|
|
|
|
+ dm_gpio_set_value(&reset_gpio, 1);
|
|
|
|
+ }
|
|
|
|
+#else
|
|
|
|
+ dev_dbg(pcie->dev, "PCIE Reset on GPIO support is missing\n");
|
|
|
|
+#endif /* CONFIG_DM_GPIO */
|
|
|
|
+
|
|
|
|
+ pcie->first_busno = dev->seq;
|
|
|
|
+ pcie->dev = pci_get_controller(dev);
|
|
|
|
+
|
|
|
|
+ return pcie_advk_setup_hw(pcie);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+/**
|
|
|
|
+ * pcie_advk_ofdata_to_platdata() - Translate from DT to device state
|
|
|
|
+ *
|
|
|
|
+ * @dev: A pointer to the device being operated on
|
|
|
|
+ *
|
|
|
|
+ * Translate relevant data from the device tree pertaining to device @dev into
|
|
|
|
+ * state that the driver will later make use of. This state is stored in the
|
|
|
|
+ * device's private data structure.
|
|
|
|
+ *
|
|
|
|
+ * Return: 0 on success, else -EINVAL
|
|
|
|
+ */
|
|
|
|
+static int pcie_advk_ofdata_to_platdata(struct udevice *dev)
|
|
|
|
+{
|
|
|
|
+ struct pcie_advk *pcie = dev_get_priv(dev);
|
|
|
|
+
|
|
|
|
+ /* Get the register base address */
|
|
|
|
+ pcie->base = (void *)dev_read_addr_index(dev, 0);
|
|
|
|
+ if ((fdt_addr_t)pcie->base == FDT_ADDR_T_NONE)
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const struct dm_pci_ops pcie_advk_ops = {
|
|
|
|
+ .read_config = pcie_advk_read_config,
|
|
|
|
+ .write_config = pcie_advk_write_config,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static const struct udevice_id pcie_advk_ids[] = {
|
|
|
|
+ { .compatible = "marvell,armada-37xx-pcie" },
|
|
|
|
+ { }
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+U_BOOT_DRIVER(pcie_advk) = {
|
|
|
|
+ .name = "pcie_advk",
|
|
|
|
+ .id = UCLASS_PCI,
|
|
|
|
+ .of_match = pcie_advk_ids,
|
|
|
|
+ .ops = &pcie_advk_ops,
|
|
|
|
+ .ofdata_to_platdata = pcie_advk_ofdata_to_platdata,
|
|
|
|
+ .probe = pcie_advk_probe,
|
|
|
|
+ .priv_auto_alloc_size = sizeof(struct pcie_advk),
|
|
|
|
+};
|