forked from rrcarlosr/Jetpack
817 lines
21 KiB
C
817 lines
21 KiB
C
/*
|
|
* Copyright 2014-2015 Freescale Semiconductor, Inc.
|
|
* Layerscape PCIe driver
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/arch/fsl_serdes.h>
|
|
#include <pci.h>
|
|
#include <asm/io.h>
|
|
#include <errno.h>
|
|
#include <malloc.h>
|
|
#ifndef CONFIG_LS102XA
|
|
#include <asm/arch/fdt.h>
|
|
#include <asm/arch/soc.h>
|
|
#endif
|
|
|
|
#ifndef CONFIG_SYS_PCI_MEMORY_BUS
|
|
#define CONFIG_SYS_PCI_MEMORY_BUS CONFIG_SYS_SDRAM_BASE
|
|
#endif
|
|
|
|
#ifndef CONFIG_SYS_PCI_MEMORY_PHYS
|
|
#define CONFIG_SYS_PCI_MEMORY_PHYS CONFIG_SYS_SDRAM_BASE
|
|
#endif
|
|
|
|
#ifndef CONFIG_SYS_PCI_MEMORY_SIZE
|
|
#define CONFIG_SYS_PCI_MEMORY_SIZE (2 * 1024 * 1024 * 1024UL) /* 2G */
|
|
#endif
|
|
|
|
#ifndef CONFIG_SYS_PCI_EP_MEMORY_BASE
|
|
#define CONFIG_SYS_PCI_EP_MEMORY_BASE CONFIG_SYS_LOAD_ADDR
|
|
#endif
|
|
|
|
/* iATU registers */
|
|
#define PCIE_ATU_VIEWPORT 0x900
|
|
#define PCIE_ATU_REGION_INBOUND (0x1 << 31)
|
|
#define PCIE_ATU_REGION_OUTBOUND (0x0 << 31)
|
|
#define PCIE_ATU_REGION_INDEX0 (0x0 << 0)
|
|
#define PCIE_ATU_REGION_INDEX1 (0x1 << 0)
|
|
#define PCIE_ATU_REGION_INDEX2 (0x2 << 0)
|
|
#define PCIE_ATU_REGION_INDEX3 (0x3 << 0)
|
|
#define PCIE_ATU_CR1 0x904
|
|
#define PCIE_ATU_TYPE_MEM (0x0 << 0)
|
|
#define PCIE_ATU_TYPE_IO (0x2 << 0)
|
|
#define PCIE_ATU_TYPE_CFG0 (0x4 << 0)
|
|
#define PCIE_ATU_TYPE_CFG1 (0x5 << 0)
|
|
#define PCIE_ATU_CR2 0x908
|
|
#define PCIE_ATU_ENABLE (0x1 << 31)
|
|
#define PCIE_ATU_BAR_MODE_ENABLE (0x1 << 30)
|
|
#define PCIE_ATU_BAR_NUM(bar) ((bar) << 8)
|
|
#define PCIE_ATU_LOWER_BASE 0x90C
|
|
#define PCIE_ATU_UPPER_BASE 0x910
|
|
#define PCIE_ATU_LIMIT 0x914
|
|
#define PCIE_ATU_LOWER_TARGET 0x918
|
|
#define PCIE_ATU_BUS(x) (((x) & 0xff) << 24)
|
|
#define PCIE_ATU_DEV(x) (((x) & 0x1f) << 19)
|
|
#define PCIE_ATU_FUNC(x) (((x) & 0x7) << 16)
|
|
#define PCIE_ATU_UPPER_TARGET 0x91C
|
|
|
|
#define PCIE_DBI_RO_WR_EN 0x8bc
|
|
|
|
#define PCIE_LINK_CAP 0x7c
|
|
#define PCIE_LINK_SPEED_MASK 0xf
|
|
#define PCIE_LINK_STA 0x82
|
|
|
|
#define LTSSM_STATE_MASK 0x3f
|
|
#define LTSSM_PCIE_L0 0x11 /* L0 state */
|
|
|
|
#define PCIE_DBI_SIZE 0x100000 /* 1M */
|
|
|
|
#define PCIE_LCTRL0_CFG2_ENABLE (1 << 31)
|
|
#define PCIE_LCTRL0_VF(vf) ((vf) << 22)
|
|
#define PCIE_LCTRL0_PF(pf) ((pf) << 16)
|
|
#define PCIE_LCTRL0_VF_ACTIVE (1 << 21)
|
|
#define PCIE_LCTRL0_VAL(pf, vf) (PCIE_LCTRL0_PF(pf) | \
|
|
PCIE_LCTRL0_VF(vf) | \
|
|
((vf) == 0 ? 0 : PCIE_LCTRL0_VF_ACTIVE) | \
|
|
PCIE_LCTRL0_CFG2_ENABLE)
|
|
|
|
#define PCIE_NO_SRIOV_BAR_BASE 0x1000
|
|
|
|
#define PCIE_PF_NUM 2
|
|
#define PCIE_VF_NUM 64
|
|
|
|
#define PCIE_BAR0_SIZE (4 * 1024) /* 4K */
|
|
#define PCIE_BAR1_SIZE (8 * 1024) /* 8K for MSIX */
|
|
#define PCIE_BAR2_SIZE (4 * 1024) /* 4K */
|
|
#define PCIE_BAR4_SIZE (1 * 1024 * 1024) /* 1M */
|
|
|
|
struct ls_pcie {
|
|
int idx;
|
|
void __iomem *dbi;
|
|
void __iomem *va_cfg0;
|
|
void __iomem *va_cfg1;
|
|
int next_lut_index;
|
|
struct pci_controller hose;
|
|
};
|
|
|
|
struct ls_pcie_info {
|
|
unsigned long regs;
|
|
int pci_num;
|
|
u64 phys_base;
|
|
u64 cfg0_phys;
|
|
u64 cfg0_size;
|
|
u64 cfg1_phys;
|
|
u64 cfg1_size;
|
|
u64 mem_bus;
|
|
u64 mem_phys;
|
|
u64 mem_size;
|
|
u64 io_bus;
|
|
u64 io_phys;
|
|
u64 io_size;
|
|
};
|
|
|
|
#define SET_LS_PCIE_INFO(x, num) \
|
|
{ \
|
|
x.regs = CONFIG_SYS_PCIE##num##_ADDR; \
|
|
x.phys_base = CONFIG_SYS_PCIE##num##_PHYS_ADDR; \
|
|
x.cfg0_phys = CONFIG_SYS_PCIE_CFG0_PHYS_OFF + \
|
|
CONFIG_SYS_PCIE##num##_PHYS_ADDR; \
|
|
x.cfg0_size = CONFIG_SYS_PCIE_CFG0_SIZE; \
|
|
x.cfg1_phys = CONFIG_SYS_PCIE_CFG1_PHYS_OFF + \
|
|
CONFIG_SYS_PCIE##num##_PHYS_ADDR; \
|
|
x.cfg1_size = CONFIG_SYS_PCIE_CFG1_SIZE; \
|
|
x.mem_bus = CONFIG_SYS_PCIE_MEM_BUS; \
|
|
x.mem_phys = CONFIG_SYS_PCIE_MEM_PHYS_OFF + \
|
|
CONFIG_SYS_PCIE##num##_PHYS_ADDR; \
|
|
x.mem_size = CONFIG_SYS_PCIE_MEM_SIZE; \
|
|
x.io_bus = CONFIG_SYS_PCIE_IO_BUS; \
|
|
x.io_phys = CONFIG_SYS_PCIE_IO_PHYS_OFF + \
|
|
CONFIG_SYS_PCIE##num##_PHYS_ADDR; \
|
|
x.io_size = CONFIG_SYS_PCIE_IO_SIZE; \
|
|
x.pci_num = num; \
|
|
}
|
|
|
|
#ifdef CONFIG_LS102XA
|
|
#include <asm/arch/immap_ls102xa.h>
|
|
|
|
/* PEX1/2 Misc Ports Status Register */
|
|
#define LTSSM_STATE_SHIFT 20
|
|
|
|
static int ls_pcie_link_state(struct ls_pcie *pcie)
|
|
{
|
|
u32 state;
|
|
struct ccsr_scfg *scfg = (struct ccsr_scfg *)CONFIG_SYS_FSL_SCFG_ADDR;
|
|
|
|
state = in_be32(&scfg->pexmscportsr[pcie->idx]);
|
|
state = (state >> LTSSM_STATE_SHIFT) & LTSSM_STATE_MASK;
|
|
if (state < LTSSM_PCIE_L0) {
|
|
debug("....PCIe link error. LTSSM=0x%02x.\n", state);
|
|
return 0;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
#else
|
|
static int ls_pcie_link_state(struct ls_pcie *pcie)
|
|
{
|
|
u32 state;
|
|
|
|
state = pex_lut_in32(pcie->dbi + PCIE_LUT_BASE + PCIE_LUT_DBG) &
|
|
LTSSM_STATE_MASK;
|
|
if (state < LTSSM_PCIE_L0) {
|
|
debug("....PCIe link error. LTSSM=0x%02x.\n", state);
|
|
return 0;
|
|
}
|
|
|
|
return 1;
|
|
}
|
|
#endif
|
|
|
|
static int ls_pcie_link_up(struct ls_pcie *pcie)
|
|
{
|
|
int state;
|
|
u32 cap;
|
|
|
|
state = ls_pcie_link_state(pcie);
|
|
if (state)
|
|
return state;
|
|
|
|
/* Try to download speed to gen1 */
|
|
cap = readl(pcie->dbi + PCIE_LINK_CAP);
|
|
writel((cap & (~PCIE_LINK_SPEED_MASK)) | 1, pcie->dbi + PCIE_LINK_CAP);
|
|
/*
|
|
* Notice: the following delay has critical impact on link training
|
|
* if too short (<30ms) the link doesn't get up.
|
|
*/
|
|
mdelay(100);
|
|
state = ls_pcie_link_state(pcie);
|
|
if (state)
|
|
return state;
|
|
|
|
writel(cap, pcie->dbi + PCIE_LINK_CAP);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ls_pcie_cfg0_set_busdev(struct ls_pcie *pcie, u32 busdev)
|
|
{
|
|
writel(PCIE_ATU_REGION_OUTBOUND | PCIE_ATU_REGION_INDEX0,
|
|
pcie->dbi + PCIE_ATU_VIEWPORT);
|
|
writel(busdev, pcie->dbi + PCIE_ATU_LOWER_TARGET);
|
|
}
|
|
|
|
static void ls_pcie_cfg1_set_busdev(struct ls_pcie *pcie, u32 busdev)
|
|
{
|
|
writel(PCIE_ATU_REGION_OUTBOUND | PCIE_ATU_REGION_INDEX1,
|
|
pcie->dbi + PCIE_ATU_VIEWPORT);
|
|
writel(busdev, pcie->dbi + PCIE_ATU_LOWER_TARGET);
|
|
}
|
|
|
|
static void ls_pcie_iatu_outbound_set(struct ls_pcie *pcie, int idx, int type,
|
|
u64 phys, u64 bus_addr, pci_size_t size)
|
|
{
|
|
writel(PCIE_ATU_REGION_OUTBOUND | idx, pcie->dbi + PCIE_ATU_VIEWPORT);
|
|
writel((u32)phys, pcie->dbi + PCIE_ATU_LOWER_BASE);
|
|
writel(phys >> 32, pcie->dbi + PCIE_ATU_UPPER_BASE);
|
|
writel(phys + size - 1, pcie->dbi + PCIE_ATU_LIMIT);
|
|
writel((u32)bus_addr, pcie->dbi + PCIE_ATU_LOWER_TARGET);
|
|
writel(bus_addr >> 32, pcie->dbi + PCIE_ATU_UPPER_TARGET);
|
|
writel(type, pcie->dbi + PCIE_ATU_CR1);
|
|
writel(PCIE_ATU_ENABLE, pcie->dbi + PCIE_ATU_CR2);
|
|
}
|
|
|
|
/* Use bar match mode and MEM type as default */
|
|
static void ls_pcie_iatu_inbound_set(struct ls_pcie *pcie, int idx,
|
|
int bar, u64 phys)
|
|
{
|
|
writel(PCIE_ATU_REGION_INBOUND | idx, pcie->dbi + PCIE_ATU_VIEWPORT);
|
|
writel((u32)phys, pcie->dbi + PCIE_ATU_LOWER_TARGET);
|
|
writel(phys >> 32, pcie->dbi + PCIE_ATU_UPPER_TARGET);
|
|
writel(PCIE_ATU_TYPE_MEM, pcie->dbi + PCIE_ATU_CR1);
|
|
writel(PCIE_ATU_ENABLE | PCIE_ATU_BAR_MODE_ENABLE |
|
|
PCIE_ATU_BAR_NUM(bar), pcie->dbi + PCIE_ATU_CR2);
|
|
}
|
|
|
|
static void ls_pcie_setup_atu(struct ls_pcie *pcie, struct ls_pcie_info *info)
|
|
{
|
|
#ifdef DEBUG
|
|
int i;
|
|
#endif
|
|
|
|
/* ATU 0 : OUTBOUND : CFG0 */
|
|
ls_pcie_iatu_outbound_set(pcie, PCIE_ATU_REGION_INDEX0,
|
|
PCIE_ATU_TYPE_CFG0,
|
|
info->cfg0_phys,
|
|
0,
|
|
info->cfg0_size);
|
|
/* ATU 1 : OUTBOUND : CFG1 */
|
|
ls_pcie_iatu_outbound_set(pcie, PCIE_ATU_REGION_INDEX1,
|
|
PCIE_ATU_TYPE_CFG1,
|
|
info->cfg1_phys,
|
|
0,
|
|
info->cfg1_size);
|
|
/* ATU 2 : OUTBOUND : MEM */
|
|
ls_pcie_iatu_outbound_set(pcie, PCIE_ATU_REGION_INDEX2,
|
|
PCIE_ATU_TYPE_MEM,
|
|
info->mem_phys,
|
|
info->mem_bus,
|
|
info->mem_size);
|
|
/* ATU 3 : OUTBOUND : IO */
|
|
ls_pcie_iatu_outbound_set(pcie, PCIE_ATU_REGION_INDEX3,
|
|
PCIE_ATU_TYPE_IO,
|
|
info->io_phys,
|
|
info->io_bus,
|
|
info->io_size);
|
|
|
|
#ifdef DEBUG
|
|
for (i = 0; i <= PCIE_ATU_REGION_INDEX3; i++) {
|
|
writel(PCIE_ATU_REGION_OUTBOUND | i,
|
|
pcie->dbi + PCIE_ATU_VIEWPORT);
|
|
debug("iATU%d:\n", i);
|
|
debug("\tLOWER PHYS 0x%08x\n",
|
|
readl(pcie->dbi + PCIE_ATU_LOWER_BASE));
|
|
debug("\tUPPER PHYS 0x%08x\n",
|
|
readl(pcie->dbi + PCIE_ATU_UPPER_BASE));
|
|
debug("\tLOWER BUS 0x%08x\n",
|
|
readl(pcie->dbi + PCIE_ATU_LOWER_TARGET));
|
|
debug("\tUPPER BUS 0x%08x\n",
|
|
readl(pcie->dbi + PCIE_ATU_UPPER_TARGET));
|
|
debug("\tLIMIT 0x%08x\n",
|
|
readl(pcie->dbi + PCIE_ATU_LIMIT));
|
|
debug("\tCR1 0x%08x\n",
|
|
readl(pcie->dbi + PCIE_ATU_CR1));
|
|
debug("\tCR2 0x%08x\n",
|
|
readl(pcie->dbi + PCIE_ATU_CR2));
|
|
}
|
|
#endif
|
|
}
|
|
|
|
int pci_skip_dev(struct pci_controller *hose, pci_dev_t dev)
|
|
{
|
|
/* Do not skip controller */
|
|
return 0;
|
|
}
|
|
|
|
static int ls_pcie_addr_valid(struct pci_controller *hose, pci_dev_t d)
|
|
{
|
|
if (PCI_DEV(d) > 0)
|
|
return -EINVAL;
|
|
|
|
/* Controller does not support multi-function in RC mode */
|
|
if ((PCI_BUS(d) == hose->first_busno) && (PCI_FUNC(d) > 0))
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ls_pcie_read_config(struct pci_controller *hose, pci_dev_t d,
|
|
int where, u32 *val)
|
|
{
|
|
struct ls_pcie *pcie = hose->priv_data;
|
|
u32 busdev, *addr;
|
|
|
|
if (ls_pcie_addr_valid(hose, d)) {
|
|
*val = 0xffffffff;
|
|
return 0;
|
|
}
|
|
|
|
if (PCI_BUS(d) == hose->first_busno) {
|
|
addr = pcie->dbi + (where & ~0x3);
|
|
} else {
|
|
busdev = PCIE_ATU_BUS(PCI_BUS(d)) |
|
|
PCIE_ATU_DEV(PCI_DEV(d)) |
|
|
PCIE_ATU_FUNC(PCI_FUNC(d));
|
|
|
|
if (PCI_BUS(d) == hose->first_busno + 1) {
|
|
ls_pcie_cfg0_set_busdev(pcie, busdev);
|
|
addr = pcie->va_cfg0 + (where & ~0x3);
|
|
} else {
|
|
ls_pcie_cfg1_set_busdev(pcie, busdev);
|
|
addr = pcie->va_cfg1 + (where & ~0x3);
|
|
}
|
|
}
|
|
|
|
*val = readl(addr);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ls_pcie_write_config(struct pci_controller *hose, pci_dev_t d,
|
|
int where, u32 val)
|
|
{
|
|
struct ls_pcie *pcie = hose->priv_data;
|
|
u32 busdev, *addr;
|
|
|
|
if (ls_pcie_addr_valid(hose, d))
|
|
return -EINVAL;
|
|
|
|
if (PCI_BUS(d) == hose->first_busno) {
|
|
addr = pcie->dbi + (where & ~0x3);
|
|
} else {
|
|
busdev = PCIE_ATU_BUS(PCI_BUS(d)) |
|
|
PCIE_ATU_DEV(PCI_DEV(d)) |
|
|
PCIE_ATU_FUNC(PCI_FUNC(d));
|
|
|
|
if (PCI_BUS(d) == hose->first_busno + 1) {
|
|
ls_pcie_cfg0_set_busdev(pcie, busdev);
|
|
addr = pcie->va_cfg0 + (where & ~0x3);
|
|
} else {
|
|
ls_pcie_cfg1_set_busdev(pcie, busdev);
|
|
addr = pcie->va_cfg1 + (where & ~0x3);
|
|
}
|
|
}
|
|
|
|
writel(val, addr);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void ls_pcie_setup_ctrl(struct ls_pcie *pcie,
|
|
struct ls_pcie_info *info)
|
|
{
|
|
struct pci_controller *hose = &pcie->hose;
|
|
pci_dev_t dev = PCI_BDF(hose->first_busno, 0, 0);
|
|
|
|
ls_pcie_setup_atu(pcie, info);
|
|
|
|
pci_hose_write_config_dword(hose, dev, PCI_BASE_ADDRESS_0, 0);
|
|
|
|
/* program correct class for RC */
|
|
writel(1, pcie->dbi + PCIE_DBI_RO_WR_EN);
|
|
pci_hose_write_config_word(hose, dev, PCI_CLASS_DEVICE,
|
|
PCI_CLASS_BRIDGE_PCI);
|
|
#ifndef CONFIG_LS102XA
|
|
writel(0, pcie->dbi + PCIE_DBI_RO_WR_EN);
|
|
#endif
|
|
}
|
|
|
|
static void ls_pcie_ep_setup_atu(struct ls_pcie *pcie,
|
|
struct ls_pcie_info *info)
|
|
{
|
|
u64 phys = CONFIG_SYS_PCI_EP_MEMORY_BASE;
|
|
|
|
/* ATU 0 : INBOUND : map BAR0 */
|
|
ls_pcie_iatu_inbound_set(pcie, PCIE_ATU_REGION_INDEX0, 0, phys);
|
|
/* ATU 1 : INBOUND : map BAR1 */
|
|
phys += PCIE_BAR1_SIZE;
|
|
ls_pcie_iatu_inbound_set(pcie, PCIE_ATU_REGION_INDEX1, 1, phys);
|
|
/* ATU 2 : INBOUND : map BAR2 */
|
|
phys += PCIE_BAR2_SIZE;
|
|
ls_pcie_iatu_inbound_set(pcie, PCIE_ATU_REGION_INDEX2, 2, phys);
|
|
/* ATU 3 : INBOUND : map BAR4 */
|
|
phys = CONFIG_SYS_PCI_EP_MEMORY_BASE + PCIE_BAR4_SIZE;
|
|
ls_pcie_iatu_inbound_set(pcie, PCIE_ATU_REGION_INDEX3, 4, phys);
|
|
|
|
/* ATU 0 : OUTBOUND : map 4G MEM */
|
|
ls_pcie_iatu_outbound_set(pcie, PCIE_ATU_REGION_INDEX0,
|
|
PCIE_ATU_TYPE_MEM,
|
|
info->phys_base,
|
|
0,
|
|
4 * 1024 * 1024 * 1024ULL);
|
|
}
|
|
|
|
/* BAR0 and BAR1 are 32bit BAR2 and BAR4 are 64bit */
|
|
static void ls_pcie_ep_setup_bar(void *bar_base, int bar, u32 size)
|
|
{
|
|
if (size < 4 * 1024)
|
|
return;
|
|
|
|
switch (bar) {
|
|
case 0:
|
|
writel(size - 1, bar_base + PCI_BASE_ADDRESS_0);
|
|
break;
|
|
case 1:
|
|
writel(size - 1, bar_base + PCI_BASE_ADDRESS_1);
|
|
break;
|
|
case 2:
|
|
writel(size - 1, bar_base + PCI_BASE_ADDRESS_2);
|
|
writel(0, bar_base + PCI_BASE_ADDRESS_3);
|
|
break;
|
|
case 4:
|
|
writel(size - 1, bar_base + PCI_BASE_ADDRESS_4);
|
|
writel(0, bar_base + PCI_BASE_ADDRESS_5);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void ls_pcie_ep_setup_bars(void *bar_base)
|
|
{
|
|
/* BAR0 - 32bit - 4K configuration */
|
|
ls_pcie_ep_setup_bar(bar_base, 0, PCIE_BAR0_SIZE);
|
|
/* BAR1 - 32bit - 8K MSIX*/
|
|
ls_pcie_ep_setup_bar(bar_base, 1, PCIE_BAR1_SIZE);
|
|
/* BAR2 - 64bit - 4K MEM desciptor */
|
|
ls_pcie_ep_setup_bar(bar_base, 2, PCIE_BAR2_SIZE);
|
|
/* BAR4 - 64bit - 1M MEM*/
|
|
ls_pcie_ep_setup_bar(bar_base, 4, PCIE_BAR4_SIZE);
|
|
}
|
|
|
|
static void ls_pcie_setup_ep(struct ls_pcie *pcie, struct ls_pcie_info *info)
|
|
{
|
|
struct pci_controller *hose = &pcie->hose;
|
|
pci_dev_t dev = PCI_BDF(hose->first_busno, 0, 0);
|
|
int sriov;
|
|
|
|
sriov = pci_hose_find_ext_capability(hose, dev, PCI_EXT_CAP_ID_SRIOV);
|
|
if (sriov) {
|
|
int pf, vf;
|
|
|
|
for (pf = 0; pf < PCIE_PF_NUM; pf++) {
|
|
for (vf = 0; vf <= PCIE_VF_NUM; vf++) {
|
|
#ifndef CONFIG_LS102XA
|
|
writel(PCIE_LCTRL0_VAL(pf, vf),
|
|
pcie->dbi + PCIE_LUT_BASE +
|
|
PCIE_LUT_LCTRL0);
|
|
#endif
|
|
ls_pcie_ep_setup_bars(pcie->dbi);
|
|
ls_pcie_ep_setup_atu(pcie, info);
|
|
}
|
|
}
|
|
|
|
/* Disable CFG2 */
|
|
#ifndef CONFIG_LS102XA
|
|
writel(0, pcie->dbi + PCIE_LUT_BASE + PCIE_LUT_LCTRL0);
|
|
#endif
|
|
} else {
|
|
ls_pcie_ep_setup_bars(pcie->dbi + PCIE_NO_SRIOV_BAR_BASE);
|
|
ls_pcie_ep_setup_atu(pcie, info);
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_FSL_LSCH3
|
|
/*
|
|
* Return next available LUT index.
|
|
*/
|
|
static int ls_pcie_next_lut_index(struct ls_pcie *pcie)
|
|
{
|
|
if (pcie->next_lut_index < PCIE_LUT_ENTRY_COUNT)
|
|
return pcie->next_lut_index++;
|
|
else
|
|
return -1; /* LUT is full */
|
|
}
|
|
|
|
/*
|
|
* Program a single LUT entry
|
|
*/
|
|
static void ls_pcie_lut_set_mapping(struct ls_pcie *pcie, int index, u32 devid,
|
|
u32 streamid)
|
|
{
|
|
void __iomem *lut;
|
|
|
|
lut = pcie->dbi + PCIE_LUT_BASE;
|
|
|
|
/* leave mask as all zeroes, want to match all bits */
|
|
writel((devid << 16), lut + PCIE_LUT_UDR(index));
|
|
writel(streamid | PCIE_LUT_ENABLE, lut + PCIE_LUT_LDR(index));
|
|
}
|
|
|
|
/* returns the next available streamid */
|
|
static u32 ls_pcie_next_streamid(void)
|
|
{
|
|
static int next_stream_id = FSL_PEX_STREAM_ID_START;
|
|
|
|
if (next_stream_id > FSL_PEX_STREAM_ID_END)
|
|
return 0xffffffff;
|
|
|
|
return next_stream_id++;
|
|
}
|
|
|
|
/*
|
|
* An msi-map is a property to be added to the pci controller
|
|
* node. It is a table, where each entry consists of 4 fields
|
|
* e.g.:
|
|
*
|
|
* msi-map = <[devid] [phandle-to-msi-ctrl] [stream-id] [count]
|
|
* [devid] [phandle-to-msi-ctrl] [stream-id] [count]>;
|
|
*/
|
|
static void fdt_pcie_set_msi_map_entry(void *blob, struct ls_pcie *pcie,
|
|
u32 devid, u32 streamid)
|
|
{
|
|
char pcie_path[19];
|
|
u32 *prop;
|
|
u32 phandle;
|
|
int nodeoffset;
|
|
|
|
/* find pci controller node */
|
|
snprintf(pcie_path, sizeof(pcie_path), "/soc/pcie@%llx",
|
|
(u64)pcie->dbi);
|
|
nodeoffset = fdt_path_offset(blob, pcie_path);
|
|
if (nodeoffset < 0) {
|
|
printf("\n%s: ERROR: unable to update PCIe node: %s\n",
|
|
__func__, pcie_path);
|
|
return;
|
|
}
|
|
|
|
/* get phandle to MSI controller */
|
|
prop = (u32 *)fdt_getprop(blob, nodeoffset, "msi-parent", 0);
|
|
if (prop == NULL) {
|
|
printf("\n%s: ERROR: missing msi-parent: %s\n", __func__,
|
|
pcie_path);
|
|
return;
|
|
}
|
|
phandle = be32_to_cpu(*prop);
|
|
|
|
/* set one msi-map row */
|
|
fdt_appendprop_u32(blob, nodeoffset, "msi-map", devid);
|
|
fdt_appendprop_u32(blob, nodeoffset, "msi-map", phandle);
|
|
fdt_appendprop_u32(blob, nodeoffset, "msi-map", streamid);
|
|
fdt_appendprop_u32(blob, nodeoffset, "msi-map", 1);
|
|
}
|
|
|
|
static void fdt_fixup_pcie(void *blob)
|
|
{
|
|
unsigned int found_multi = 0;
|
|
unsigned char header_type;
|
|
int index;
|
|
u32 streamid;
|
|
pci_dev_t dev, bdf;
|
|
int bus;
|
|
unsigned short id;
|
|
struct pci_controller *hose;
|
|
struct ls_pcie *pcie;
|
|
int i;
|
|
|
|
for (i = 0, hose = pci_get_hose_head(); hose; hose = hose->next, i++) {
|
|
pcie = hose->priv_data;
|
|
for (bus = hose->first_busno; bus <= hose->last_busno; bus++) {
|
|
|
|
for (dev = PCI_BDF(bus, 0, 0);
|
|
dev < PCI_BDF(bus, PCI_MAX_PCI_DEVICES - 1,
|
|
PCI_MAX_PCI_FUNCTIONS - 1);
|
|
dev += PCI_BDF(0, 0, 1)) {
|
|
|
|
if (PCI_FUNC(dev) && !found_multi)
|
|
continue;
|
|
|
|
pci_read_config_word(dev, PCI_VENDOR_ID, &id);
|
|
|
|
pci_read_config_byte(dev, PCI_HEADER_TYPE,
|
|
&header_type);
|
|
|
|
if ((id == 0xFFFF) || (id == 0x0000))
|
|
continue;
|
|
|
|
if (!PCI_FUNC(dev))
|
|
found_multi = header_type & 0x80;
|
|
|
|
streamid = ls_pcie_next_streamid();
|
|
if (streamid == 0xffffffff) {
|
|
printf("ERROR: no stream ids free\n");
|
|
continue;
|
|
}
|
|
|
|
index = ls_pcie_next_lut_index(pcie);
|
|
if (index < 0) {
|
|
printf("ERROR: no LUT indexes free\n");
|
|
continue;
|
|
}
|
|
|
|
/* the DT fixup must be relative to the hose first_busno */
|
|
bdf = dev - PCI_BDF(hose->first_busno, 0, 0);
|
|
|
|
/* map PCI b.d.f to streamID in LUT */
|
|
ls_pcie_lut_set_mapping(pcie, index, bdf >> 8,
|
|
streamid);
|
|
|
|
/* update msi-map in device tree */
|
|
fdt_pcie_set_msi_map_entry(blob, pcie, bdf >> 8,
|
|
streamid);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
int ls_pcie_init_ctrl(int busno, enum srds_prtcl dev, struct ls_pcie_info *info)
|
|
{
|
|
struct ls_pcie *pcie;
|
|
struct pci_controller *hose;
|
|
int num = dev - PCIE1;
|
|
pci_dev_t pdev = PCI_BDF(busno, 0, 0);
|
|
int i, linkup, ep_mode;
|
|
u8 header_type;
|
|
u16 temp16;
|
|
|
|
if (!is_serdes_configured(dev)) {
|
|
printf("PCIe%d: disabled\n", num + 1);
|
|
return busno;
|
|
}
|
|
|
|
pcie = malloc(sizeof(*pcie));
|
|
if (!pcie)
|
|
return busno;
|
|
memset(pcie, 0, sizeof(*pcie));
|
|
|
|
hose = &pcie->hose;
|
|
hose->priv_data = pcie;
|
|
hose->first_busno = busno;
|
|
pcie->idx = num;
|
|
pcie->dbi = map_physmem(info->regs, PCIE_DBI_SIZE, MAP_NOCACHE);
|
|
pcie->va_cfg0 = map_physmem(info->cfg0_phys,
|
|
info->cfg0_size,
|
|
MAP_NOCACHE);
|
|
pcie->va_cfg1 = map_physmem(info->cfg1_phys,
|
|
info->cfg1_size,
|
|
MAP_NOCACHE);
|
|
pcie->next_lut_index = 0;
|
|
|
|
/* outbound memory */
|
|
pci_set_region(&hose->regions[0],
|
|
(pci_size_t)info->mem_bus,
|
|
(phys_size_t)info->mem_phys,
|
|
(pci_size_t)info->mem_size,
|
|
PCI_REGION_MEM);
|
|
|
|
/* outbound io */
|
|
pci_set_region(&hose->regions[1],
|
|
(pci_size_t)info->io_bus,
|
|
(phys_size_t)info->io_phys,
|
|
(pci_size_t)info->io_size,
|
|
PCI_REGION_IO);
|
|
|
|
/* System memory space */
|
|
pci_set_region(&hose->regions[2],
|
|
CONFIG_SYS_PCI_MEMORY_BUS,
|
|
CONFIG_SYS_PCI_MEMORY_PHYS,
|
|
CONFIG_SYS_PCI_MEMORY_SIZE,
|
|
PCI_REGION_SYS_MEMORY);
|
|
|
|
hose->region_count = 3;
|
|
|
|
for (i = 0; i < hose->region_count; i++)
|
|
debug("PCI reg:%d %016llx:%016llx %016llx %08lx\n",
|
|
i,
|
|
(u64)hose->regions[i].phys_start,
|
|
(u64)hose->regions[i].bus_start,
|
|
(u64)hose->regions[i].size,
|
|
hose->regions[i].flags);
|
|
|
|
pci_set_ops(hose,
|
|
pci_hose_read_config_byte_via_dword,
|
|
pci_hose_read_config_word_via_dword,
|
|
ls_pcie_read_config,
|
|
pci_hose_write_config_byte_via_dword,
|
|
pci_hose_write_config_word_via_dword,
|
|
ls_pcie_write_config);
|
|
|
|
pci_hose_read_config_byte(hose, pdev, PCI_HEADER_TYPE, &header_type);
|
|
ep_mode = (header_type & 0x7f) == PCI_HEADER_TYPE_NORMAL;
|
|
printf("PCIe%u: %s ", info->pci_num,
|
|
ep_mode ? "Endpoint" : "Root Complex");
|
|
|
|
if (ep_mode)
|
|
ls_pcie_setup_ep(pcie, info);
|
|
else
|
|
ls_pcie_setup_ctrl(pcie, info);
|
|
|
|
linkup = ls_pcie_link_up(pcie);
|
|
|
|
if (!linkup) {
|
|
/* Let the user know there's no PCIe link */
|
|
printf("no link, regs @ 0x%lx\n", info->regs);
|
|
hose->last_busno = hose->first_busno;
|
|
return busno;
|
|
}
|
|
|
|
/* Print the negotiated PCIe link width */
|
|
pci_hose_read_config_word(hose, pdev, PCIE_LINK_STA, &temp16);
|
|
printf("x%d gen%d, regs @ 0x%lx\n", (temp16 & 0x3f0) >> 4,
|
|
(temp16 & 0xf), info->regs);
|
|
|
|
if (ep_mode)
|
|
return busno;
|
|
|
|
pci_register_hose(hose);
|
|
|
|
hose->last_busno = pci_hose_scan(hose);
|
|
|
|
printf("PCIe%x: Bus %02x - %02x\n",
|
|
info->pci_num, hose->first_busno, hose->last_busno);
|
|
|
|
return hose->last_busno + 1;
|
|
}
|
|
|
|
int ls_pcie_init_board(int busno)
|
|
{
|
|
struct ls_pcie_info info;
|
|
|
|
#ifdef CONFIG_PCIE1
|
|
SET_LS_PCIE_INFO(info, 1);
|
|
busno = ls_pcie_init_ctrl(busno, PCIE1, &info);
|
|
#endif
|
|
|
|
#ifdef CONFIG_PCIE2
|
|
SET_LS_PCIE_INFO(info, 2);
|
|
busno = ls_pcie_init_ctrl(busno, PCIE2, &info);
|
|
#endif
|
|
|
|
#ifdef CONFIG_PCIE3
|
|
SET_LS_PCIE_INFO(info, 3);
|
|
busno = ls_pcie_init_ctrl(busno, PCIE3, &info);
|
|
#endif
|
|
|
|
#ifdef CONFIG_PCIE4
|
|
SET_LS_PCIE_INFO(info, 4);
|
|
busno = ls_pcie_init_ctrl(busno, PCIE4, &info);
|
|
#endif
|
|
|
|
return busno;
|
|
}
|
|
|
|
void pci_init_board(void)
|
|
{
|
|
ls_pcie_init_board(0);
|
|
}
|
|
|
|
#ifdef CONFIG_OF_BOARD_SETUP
|
|
#include <libfdt.h>
|
|
#include <fdt_support.h>
|
|
|
|
static void ft_pcie_ls_setup(void *blob, const char *pci_compat,
|
|
unsigned long ctrl_addr, enum srds_prtcl dev)
|
|
{
|
|
int off;
|
|
|
|
off = fdt_node_offset_by_compat_reg(blob, pci_compat,
|
|
(phys_addr_t)ctrl_addr);
|
|
if (off < 0)
|
|
return;
|
|
|
|
if (!is_serdes_configured(dev))
|
|
fdt_set_node_status(blob, off, FDT_STATUS_DISABLED, 0);
|
|
}
|
|
|
|
void ft_pci_setup(void *blob, bd_t *bd)
|
|
{
|
|
#ifdef CONFIG_PCIE1
|
|
ft_pcie_ls_setup(blob, FSL_PCIE_COMPAT, CONFIG_SYS_PCIE1_ADDR, PCIE1);
|
|
#endif
|
|
|
|
#ifdef CONFIG_PCIE2
|
|
ft_pcie_ls_setup(blob, FSL_PCIE_COMPAT, CONFIG_SYS_PCIE2_ADDR, PCIE2);
|
|
#endif
|
|
|
|
#ifdef CONFIG_PCIE3
|
|
ft_pcie_ls_setup(blob, FSL_PCIE_COMPAT, CONFIG_SYS_PCIE3_ADDR, PCIE3);
|
|
#endif
|
|
|
|
#ifdef CONFIG_PCIE4
|
|
ft_pcie_ls_setup(blob, FSL_PCIE_COMPAT, CONFIG_SYS_PCIE4_ADDR, PCIE4);
|
|
#endif
|
|
|
|
#ifdef CONFIG_FSL_LSCH3
|
|
fdt_fixup_pcie(blob);
|
|
#endif
|
|
}
|
|
|
|
#else
|
|
void ft_pci_setup(void *blob, bd_t *bd)
|
|
{
|
|
}
|
|
#endif
|