forked from luck/tmp_suning_uos_patched
a9311cfed2
The Discovery Duo (MV78xx0) has two x4 PCIe ports which can either be used in x4 mode or in quad x1 mode. This patch adds an accessor function to the generic plat-orion PCIe handling code to detect in which of the two modes we're running (which is determined by strap pins and/or configured by the bootloader). Signed-off-by: Lennert Buytenhek <buytenh@marvell.com>
252 lines
6.4 KiB
C
252 lines
6.4 KiB
C
/*
|
|
* arch/arm/plat-orion/pcie.c
|
|
*
|
|
* Marvell Orion SoC PCIe handling.
|
|
*
|
|
* This file is licensed under the terms of the GNU General Public
|
|
* License version 2. This program is licensed "as is" without any
|
|
* warranty of any kind, whether express or implied.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/mbus.h>
|
|
#include <asm/mach/pci.h>
|
|
#include <asm/plat-orion/pcie.h>
|
|
|
|
/*
|
|
* PCIe unit register offsets.
|
|
*/
|
|
#define PCIE_DEV_ID_OFF 0x0000
|
|
#define PCIE_CMD_OFF 0x0004
|
|
#define PCIE_DEV_REV_OFF 0x0008
|
|
#define PCIE_BAR_LO_OFF(n) (0x0010 + ((n) << 3))
|
|
#define PCIE_BAR_HI_OFF(n) (0x0014 + ((n) << 3))
|
|
#define PCIE_HEADER_LOG_4_OFF 0x0128
|
|
#define PCIE_BAR_CTRL_OFF(n) (0x1804 + ((n - 1) * 4))
|
|
#define PCIE_WIN04_CTRL_OFF(n) (0x1820 + ((n) << 4))
|
|
#define PCIE_WIN04_BASE_OFF(n) (0x1824 + ((n) << 4))
|
|
#define PCIE_WIN04_REMAP_OFF(n) (0x182c + ((n) << 4))
|
|
#define PCIE_WIN5_CTRL_OFF 0x1880
|
|
#define PCIE_WIN5_BASE_OFF 0x1884
|
|
#define PCIE_WIN5_REMAP_OFF 0x188c
|
|
#define PCIE_CONF_ADDR_OFF 0x18f8
|
|
#define PCIE_CONF_ADDR_EN 0x80000000
|
|
#define PCIE_CONF_REG(r) ((((r) & 0xf00) << 16) | ((r) & 0xfc))
|
|
#define PCIE_CONF_BUS(b) (((b) & 0xff) << 16)
|
|
#define PCIE_CONF_DEV(d) (((d) & 0x1f) << 11)
|
|
#define PCIE_CONF_FUNC(f) (((f) & 0x3) << 8)
|
|
#define PCIE_CONF_DATA_OFF 0x18fc
|
|
#define PCIE_MASK_OFF 0x1910
|
|
#define PCIE_CTRL_OFF 0x1a00
|
|
#define PCIE_CTRL_X1_MODE 0x0001
|
|
#define PCIE_STAT_OFF 0x1a04
|
|
#define PCIE_STAT_DEV_OFFS 20
|
|
#define PCIE_STAT_DEV_MASK 0x1f
|
|
#define PCIE_STAT_BUS_OFFS 8
|
|
#define PCIE_STAT_BUS_MASK 0xff
|
|
#define PCIE_STAT_LINK_DOWN 1
|
|
|
|
|
|
u32 __init orion_pcie_dev_id(void __iomem *base)
|
|
{
|
|
return readl(base + PCIE_DEV_ID_OFF) >> 16;
|
|
}
|
|
|
|
u32 __init orion_pcie_rev(void __iomem *base)
|
|
{
|
|
return readl(base + PCIE_DEV_REV_OFF) & 0xff;
|
|
}
|
|
|
|
int orion_pcie_link_up(void __iomem *base)
|
|
{
|
|
return !(readl(base + PCIE_STAT_OFF) & PCIE_STAT_LINK_DOWN);
|
|
}
|
|
|
|
int __init orion_pcie_x4_mode(void __iomem *base)
|
|
{
|
|
return !(readl(base + PCIE_CTRL_OFF) & PCIE_CTRL_X1_MODE);
|
|
}
|
|
|
|
int orion_pcie_get_local_bus_nr(void __iomem *base)
|
|
{
|
|
u32 stat = readl(base + PCIE_STAT_OFF);
|
|
|
|
return (stat >> PCIE_STAT_BUS_OFFS) & PCIE_STAT_BUS_MASK;
|
|
}
|
|
|
|
void __init orion_pcie_set_local_bus_nr(void __iomem *base, int nr)
|
|
{
|
|
u32 stat;
|
|
|
|
stat = readl(base + PCIE_STAT_OFF);
|
|
stat &= ~(PCIE_STAT_BUS_MASK << PCIE_STAT_BUS_OFFS);
|
|
stat |= nr << PCIE_STAT_BUS_OFFS;
|
|
writel(stat, base + PCIE_STAT_OFF);
|
|
}
|
|
|
|
/*
|
|
* Setup PCIE BARs and Address Decode Wins:
|
|
* BAR[0,2] -> disabled, BAR[1] -> covers all DRAM banks
|
|
* WIN[0-3] -> DRAM bank[0-3]
|
|
*/
|
|
static void __init orion_pcie_setup_wins(void __iomem *base,
|
|
struct mbus_dram_target_info *dram)
|
|
{
|
|
u32 size;
|
|
int i;
|
|
|
|
/*
|
|
* First, disable and clear BARs and windows.
|
|
*/
|
|
for (i = 1; i <= 2; i++) {
|
|
writel(0, base + PCIE_BAR_CTRL_OFF(i));
|
|
writel(0, base + PCIE_BAR_LO_OFF(i));
|
|
writel(0, base + PCIE_BAR_HI_OFF(i));
|
|
}
|
|
|
|
for (i = 0; i < 5; i++) {
|
|
writel(0, base + PCIE_WIN04_CTRL_OFF(i));
|
|
writel(0, base + PCIE_WIN04_BASE_OFF(i));
|
|
writel(0, base + PCIE_WIN04_REMAP_OFF(i));
|
|
}
|
|
|
|
writel(0, base + PCIE_WIN5_CTRL_OFF);
|
|
writel(0, base + PCIE_WIN5_BASE_OFF);
|
|
writel(0, base + PCIE_WIN5_REMAP_OFF);
|
|
|
|
/*
|
|
* Setup windows for DDR banks. Count total DDR size on the fly.
|
|
*/
|
|
size = 0;
|
|
for (i = 0; i < dram->num_cs; i++) {
|
|
struct mbus_dram_window *cs = dram->cs + i;
|
|
|
|
writel(cs->base & 0xffff0000, base + PCIE_WIN04_BASE_OFF(i));
|
|
writel(0, base + PCIE_WIN04_REMAP_OFF(i));
|
|
writel(((cs->size - 1) & 0xffff0000) |
|
|
(cs->mbus_attr << 8) |
|
|
(dram->mbus_dram_target_id << 4) | 1,
|
|
base + PCIE_WIN04_CTRL_OFF(i));
|
|
|
|
size += cs->size;
|
|
}
|
|
|
|
/*
|
|
* Setup BAR[1] to all DRAM banks.
|
|
*/
|
|
writel(dram->cs[0].base, base + PCIE_BAR_LO_OFF(1));
|
|
writel(0, base + PCIE_BAR_HI_OFF(1));
|
|
writel(((size - 1) & 0xffff0000) | 1, base + PCIE_BAR_CTRL_OFF(1));
|
|
}
|
|
|
|
void __init orion_pcie_setup(void __iomem *base,
|
|
struct mbus_dram_target_info *dram)
|
|
{
|
|
u16 cmd;
|
|
u32 mask;
|
|
|
|
/*
|
|
* Point PCIe unit MBUS decode windows to DRAM space.
|
|
*/
|
|
orion_pcie_setup_wins(base, dram);
|
|
|
|
/*
|
|
* Master + slave enable.
|
|
*/
|
|
cmd = readw(base + PCIE_CMD_OFF);
|
|
cmd |= PCI_COMMAND_IO;
|
|
cmd |= PCI_COMMAND_MEMORY;
|
|
cmd |= PCI_COMMAND_MASTER;
|
|
writew(cmd, base + PCIE_CMD_OFF);
|
|
|
|
/*
|
|
* Enable interrupt lines A-D.
|
|
*/
|
|
mask = readl(base + PCIE_MASK_OFF);
|
|
mask |= 0x0f000000;
|
|
writel(mask, base + PCIE_MASK_OFF);
|
|
}
|
|
|
|
int orion_pcie_rd_conf(void __iomem *base, struct pci_bus *bus,
|
|
u32 devfn, int where, int size, u32 *val)
|
|
{
|
|
writel(PCIE_CONF_BUS(bus->number) |
|
|
PCIE_CONF_DEV(PCI_SLOT(devfn)) |
|
|
PCIE_CONF_FUNC(PCI_FUNC(devfn)) |
|
|
PCIE_CONF_REG(where) | PCIE_CONF_ADDR_EN,
|
|
base + PCIE_CONF_ADDR_OFF);
|
|
|
|
*val = readl(base + PCIE_CONF_DATA_OFF);
|
|
|
|
if (size == 1)
|
|
*val = (*val >> (8 * (where & 3))) & 0xff;
|
|
else if (size == 2)
|
|
*val = (*val >> (8 * (where & 3))) & 0xffff;
|
|
|
|
return PCIBIOS_SUCCESSFUL;
|
|
}
|
|
|
|
int orion_pcie_rd_conf_tlp(void __iomem *base, struct pci_bus *bus,
|
|
u32 devfn, int where, int size, u32 *val)
|
|
{
|
|
writel(PCIE_CONF_BUS(bus->number) |
|
|
PCIE_CONF_DEV(PCI_SLOT(devfn)) |
|
|
PCIE_CONF_FUNC(PCI_FUNC(devfn)) |
|
|
PCIE_CONF_REG(where) | PCIE_CONF_ADDR_EN,
|
|
base + PCIE_CONF_ADDR_OFF);
|
|
|
|
*val = readl(base + PCIE_CONF_DATA_OFF);
|
|
|
|
if (bus->number != orion_pcie_get_local_bus_nr(base) ||
|
|
PCI_FUNC(devfn) != 0)
|
|
*val = readl(base + PCIE_HEADER_LOG_4_OFF);
|
|
|
|
if (size == 1)
|
|
*val = (*val >> (8 * (where & 3))) & 0xff;
|
|
else if (size == 2)
|
|
*val = (*val >> (8 * (where & 3))) & 0xffff;
|
|
|
|
return PCIBIOS_SUCCESSFUL;
|
|
}
|
|
|
|
int orion_pcie_rd_conf_wa(void __iomem *wa_base, struct pci_bus *bus,
|
|
u32 devfn, int where, int size, u32 *val)
|
|
{
|
|
*val = readl(wa_base + (PCIE_CONF_BUS(bus->number) |
|
|
PCIE_CONF_DEV(PCI_SLOT(devfn)) |
|
|
PCIE_CONF_FUNC(PCI_FUNC(devfn)) |
|
|
PCIE_CONF_REG(where)));
|
|
|
|
if (size == 1)
|
|
*val = (*val >> (8 * (where & 3))) & 0xff;
|
|
else if (size == 2)
|
|
*val = (*val >> (8 * (where & 3))) & 0xffff;
|
|
|
|
return PCIBIOS_SUCCESSFUL;
|
|
}
|
|
|
|
int orion_pcie_wr_conf(void __iomem *base, struct pci_bus *bus,
|
|
u32 devfn, int where, int size, u32 val)
|
|
{
|
|
int ret = PCIBIOS_SUCCESSFUL;
|
|
|
|
writel(PCIE_CONF_BUS(bus->number) |
|
|
PCIE_CONF_DEV(PCI_SLOT(devfn)) |
|
|
PCIE_CONF_FUNC(PCI_FUNC(devfn)) |
|
|
PCIE_CONF_REG(where) | PCIE_CONF_ADDR_EN,
|
|
base + PCIE_CONF_ADDR_OFF);
|
|
|
|
if (size == 4) {
|
|
writel(val, base + PCIE_CONF_DATA_OFF);
|
|
} else if (size == 2) {
|
|
writew(val, base + PCIE_CONF_DATA_OFF + (where & 3));
|
|
} else if (size == 1) {
|
|
writeb(val, base + PCIE_CONF_DATA_OFF + (where & 3));
|
|
} else {
|
|
ret = PCIBIOS_BAD_REGISTER_NUMBER;
|
|
}
|
|
|
|
return ret;
|
|
}
|