mirror of
https://github.com/torvalds/linux.git
synced 2024-12-01 00:21:32 +00:00
plat-orion: share PCIe handling code
Split off Orion PCIe handling code into plat-orion/. Signed-off-by: Lennert Buytenhek <buytenh@marvell.com> Reviewed-by: Tzachi Perelstein <tzachi@marvell.com> Acked-by: Russell King <rmk+kernel@arm.linux.org.uk> Signed-off-by: Nicolas Pitre <nico@marvell.com>
This commit is contained in:
parent
01eb569823
commit
abc0197d7a
@ -43,8 +43,8 @@ struct pci_sys_data;
|
|||||||
struct pci_bus;
|
struct pci_bus;
|
||||||
|
|
||||||
void orion_pcie_id(u32 *dev, u32 *rev);
|
void orion_pcie_id(u32 *dev, u32 *rev);
|
||||||
u32 orion_pcie_local_bus_nr(void);
|
int orion_pcie_local_bus_nr(void);
|
||||||
u32 orion_pci_local_bus_nr(void);
|
int orion_pci_local_bus_nr(void);
|
||||||
int orion_pci_sys_setup(int nr, struct pci_sys_data *sys);
|
int orion_pci_sys_setup(int nr, struct pci_sys_data *sys);
|
||||||
struct pci_bus *orion_pci_sys_scan_bus(int nr, struct pci_sys_data *sys);
|
struct pci_bus *orion_pci_sys_scan_bus(int nr, struct pci_sys_data *sys);
|
||||||
|
|
||||||
|
@ -14,6 +14,7 @@
|
|||||||
#include <linux/pci.h>
|
#include <linux/pci.h>
|
||||||
#include <linux/mbus.h>
|
#include <linux/mbus.h>
|
||||||
#include <asm/mach/pci.h>
|
#include <asm/mach/pci.h>
|
||||||
|
#include <asm/plat-orion/pcie.h>
|
||||||
#include "common.h"
|
#include "common.h"
|
||||||
|
|
||||||
/*****************************************************************************
|
/*****************************************************************************
|
||||||
@ -32,55 +33,35 @@
|
|||||||
/*****************************************************************************
|
/*****************************************************************************
|
||||||
* PCIE controller
|
* PCIE controller
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
#define PCIE_CTRL ORION_PCIE_REG(0x1a00)
|
#define PCIE_BASE ((void __iomem *)ORION_PCIE_VIRT_BASE)
|
||||||
#define PCIE_STAT ORION_PCIE_REG(0x1a04)
|
|
||||||
#define PCIE_DEV_ID ORION_PCIE_REG(0x0000)
|
|
||||||
#define PCIE_CMD_STAT ORION_PCIE_REG(0x0004)
|
|
||||||
#define PCIE_DEV_REV ORION_PCIE_REG(0x0008)
|
|
||||||
#define PCIE_MASK ORION_PCIE_REG(0x1910)
|
|
||||||
#define PCIE_CONF_ADDR ORION_PCIE_REG(0x18f8)
|
|
||||||
#define PCIE_CONF_DATA ORION_PCIE_REG(0x18fc)
|
|
||||||
|
|
||||||
/*
|
void orion_pcie_id(u32 *dev, u32 *rev)
|
||||||
* PCIE_STAT bits
|
{
|
||||||
*/
|
*dev = orion_pcie_dev_id(PCIE_BASE);
|
||||||
#define PCIE_STAT_LINK_DOWN 1
|
*rev = orion_pcie_rev(PCIE_BASE);
|
||||||
#define PCIE_STAT_BUS_OFFS 8
|
}
|
||||||
#define PCIE_STAT_BUS_MASK (0xff << PCIE_STAT_BUS_OFFS)
|
|
||||||
#define PCIE_STAT_DEV_OFFS 20
|
|
||||||
#define PCIE_STAT_DEV_MASK (0x1f << PCIE_STAT_DEV_OFFS)
|
|
||||||
|
|
||||||
/*
|
int orion_pcie_local_bus_nr(void)
|
||||||
* PCIE_CONF_ADDR bits
|
{
|
||||||
*/
|
return orion_pcie_get_local_bus_nr(PCIE_BASE);
|
||||||
#define PCIE_CONF_REG(r) ((((r) & 0xf00) << 24) | ((r) & 0xfc))
|
}
|
||||||
#define PCIE_CONF_FUNC(f) (((f) & 0x3) << 8)
|
|
||||||
#define PCIE_CONF_DEV(d) (((d) & 0x1f) << 11)
|
|
||||||
#define PCIE_CONF_BUS(b) (((b) & 0xff) << 16)
|
|
||||||
#define PCIE_CONF_ADDR_EN (1 << 31)
|
|
||||||
|
|
||||||
/*
|
static int pcie_valid_config(int bus, int dev)
|
||||||
* PCIE Address Decode Windows registers
|
{
|
||||||
*/
|
/*
|
||||||
#define PCIE_BAR_CTRL(n) ORION_PCIE_REG(0x1804 + ((n - 1) * 4))
|
* Don't go out when trying to access --
|
||||||
#define PCIE_BAR_LO(n) ORION_PCIE_REG(0x0010 + ((n) * 8))
|
* 1. our own device / nonexisting device on local bus
|
||||||
#define PCIE_BAR_HI(n) ORION_PCIE_REG(0x0014 + ((n) * 8))
|
* 2. where there's no device connected (no link)
|
||||||
#define PCIE_WIN_CTRL(n) (((n) < 5) ? \
|
*/
|
||||||
ORION_PCIE_REG(0x1820 + ((n) << 4)) : \
|
if (bus == 0 && dev != 1)
|
||||||
ORION_PCIE_REG(0x1880))
|
return 0;
|
||||||
#define PCIE_WIN_BASE(n) (((n) < 5) ? \
|
|
||||||
ORION_PCIE_REG(0x1824 + ((n) << 4)) : \
|
if (!orion_pcie_link_up(PCIE_BASE))
|
||||||
ORION_PCIE_REG(0x1884))
|
return 0;
|
||||||
#define PCIE_WIN_REMAP(n) (((n) < 5) ? \
|
|
||||||
ORION_PCIE_REG(0x182c + ((n) << 4)) : \
|
return 1;
|
||||||
ORION_PCIE_REG(0x188c))
|
}
|
||||||
#define PCIE_MAX_BARS 3
|
|
||||||
#define PCIE_MAX_WINS 6
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Use PCIE BAR '1' for all DDR banks
|
|
||||||
*/
|
|
||||||
#define PCIE_DRAM_BAR 1
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* PCIE config cycles are done by programming the PCIE_CONF_ADDR register
|
* PCIE config cycles are done by programming the PCIE_CONF_ADDR register
|
||||||
@ -89,231 +70,99 @@
|
|||||||
*/
|
*/
|
||||||
static DEFINE_SPINLOCK(orion_pcie_lock);
|
static DEFINE_SPINLOCK(orion_pcie_lock);
|
||||||
|
|
||||||
void orion_pcie_id(u32 *dev, u32 *rev)
|
static int pcie_rd_conf(struct pci_bus *bus, u32 devfn, int where,
|
||||||
{
|
int size, u32 *val)
|
||||||
*dev = orion_read(PCIE_DEV_ID) >> 16;
|
|
||||||
*rev = orion_read(PCIE_DEV_REV) & 0xff;
|
|
||||||
}
|
|
||||||
|
|
||||||
u32 orion_pcie_local_bus_nr(void)
|
|
||||||
{
|
|
||||||
u32 stat = orion_read(PCIE_STAT);
|
|
||||||
return((stat & PCIE_STAT_BUS_MASK) >> PCIE_STAT_BUS_OFFS);
|
|
||||||
}
|
|
||||||
|
|
||||||
static u32 orion_pcie_local_dev_nr(void)
|
|
||||||
{
|
|
||||||
u32 stat = orion_read(PCIE_STAT);
|
|
||||||
return((stat & PCIE_STAT_DEV_MASK) >> PCIE_STAT_DEV_OFFS);
|
|
||||||
}
|
|
||||||
|
|
||||||
static u32 orion_pcie_no_link(void)
|
|
||||||
{
|
|
||||||
u32 stat = orion_read(PCIE_STAT);
|
|
||||||
return(stat & PCIE_STAT_LINK_DOWN);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void orion_pcie_set_bus_nr(int nr)
|
|
||||||
{
|
|
||||||
orion_clrbits(PCIE_STAT, PCIE_STAT_BUS_MASK);
|
|
||||||
orion_setbits(PCIE_STAT, nr << PCIE_STAT_BUS_OFFS);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* 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 orion_setup_pcie_wins(struct mbus_dram_target_info *dram)
|
|
||||||
{
|
|
||||||
u32 size;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* First, disable and clear BARs and windows
|
|
||||||
*/
|
|
||||||
for (i = 1; i < PCIE_MAX_BARS; i++) {
|
|
||||||
writel(0, PCIE_BAR_CTRL(i));
|
|
||||||
writel(0, PCIE_BAR_LO(i));
|
|
||||||
writel(0, PCIE_BAR_HI(i));
|
|
||||||
}
|
|
||||||
|
|
||||||
for (i = 0; i < PCIE_MAX_WINS; i++) {
|
|
||||||
writel(0, PCIE_WIN_CTRL(i));
|
|
||||||
writel(0, PCIE_WIN_BASE(i));
|
|
||||||
writel(0, PCIE_WIN_REMAP(i));
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* 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, PCIE_WIN_BASE(i));
|
|
||||||
writel(0, PCIE_WIN_REMAP(i));
|
|
||||||
writel(((cs->size - 1) & 0xffff0000) |
|
|
||||||
(cs->mbus_attr << 8) |
|
|
||||||
(dram->mbus_dram_target_id << 4) |
|
|
||||||
(PCIE_DRAM_BAR << 1) | 1, PCIE_WIN_CTRL(i));
|
|
||||||
|
|
||||||
size += cs->size;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Setup BAR[1] to all DRAM banks
|
|
||||||
*/
|
|
||||||
writel(dram->cs[0].base, PCIE_BAR_LO(PCIE_DRAM_BAR));
|
|
||||||
writel(0, PCIE_BAR_HI(PCIE_DRAM_BAR));
|
|
||||||
writel(((size - 1) & 0xffff0000) | 1, PCIE_BAR_CTRL(PCIE_DRAM_BAR));
|
|
||||||
}
|
|
||||||
|
|
||||||
static void orion_pcie_master_slave_enable(void)
|
|
||||||
{
|
|
||||||
orion_setbits(PCIE_CMD_STAT, PCI_COMMAND_MASTER |
|
|
||||||
PCI_COMMAND_IO |
|
|
||||||
PCI_COMMAND_MEMORY);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void orion_pcie_enable_interrupts(void)
|
|
||||||
{
|
|
||||||
/*
|
|
||||||
* Enable interrupts lines
|
|
||||||
* INTA[24] INTB[25] INTC[26] INTD[27]
|
|
||||||
*/
|
|
||||||
orion_setbits(PCIE_MASK, 0xf<<24);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int orion_pcie_valid_config(u32 bus, u32 dev)
|
|
||||||
{
|
|
||||||
/*
|
|
||||||
* Don't go out when trying to access --
|
|
||||||
* 1. our own device
|
|
||||||
* 2. where there's no device connected (no link)
|
|
||||||
* 3. nonexisting devices on local bus
|
|
||||||
*/
|
|
||||||
|
|
||||||
if ((orion_pcie_local_bus_nr() == bus) &&
|
|
||||||
(orion_pcie_local_dev_nr() == dev))
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
if (orion_pcie_no_link())
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
if (bus == orion_pcie_local_bus_nr())
|
|
||||||
if (((orion_pcie_local_dev_nr() == 0) && (dev != 1)) ||
|
|
||||||
((orion_pcie_local_dev_nr() != 0) && (dev != 0)))
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int orion_pcie_rd_conf(struct pci_bus *bus, u32 devfn, int where,
|
|
||||||
int size, u32 *val)
|
|
||||||
{
|
{
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
unsigned int dev, rev, pcie_addr;
|
int ret;
|
||||||
|
|
||||||
if (orion_pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0) {
|
if (pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0) {
|
||||||
*val = 0xffffffff;
|
*val = 0xffffffff;
|
||||||
return PCIBIOS_DEVICE_NOT_FOUND;
|
return PCIBIOS_DEVICE_NOT_FOUND;
|
||||||
}
|
}
|
||||||
|
|
||||||
spin_lock_irqsave(&orion_pcie_lock, flags);
|
spin_lock_irqsave(&orion_pcie_lock, flags);
|
||||||
|
ret = orion_pcie_rd_conf(PCIE_BASE, bus, devfn, where, size, val);
|
||||||
orion_write(PCIE_CONF_ADDR, 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);
|
|
||||||
|
|
||||||
orion_pcie_id(&dev, &rev);
|
|
||||||
if (dev == MV88F5181_DEV_ID || dev == MV88F5182_DEV_ID) {
|
|
||||||
/* extended register space */
|
|
||||||
pcie_addr = ORION_PCIE_WA_VIRT_BASE;
|
|
||||||
pcie_addr |= PCIE_CONF_BUS(bus->number) |
|
|
||||||
PCIE_CONF_DEV(PCI_SLOT(devfn)) |
|
|
||||||
PCIE_CONF_FUNC(PCI_FUNC(devfn)) |
|
|
||||||
PCIE_CONF_REG(where);
|
|
||||||
*val = orion_read(pcie_addr);
|
|
||||||
} else
|
|
||||||
*val = orion_read(PCIE_CONF_DATA);
|
|
||||||
|
|
||||||
if (size == 1)
|
|
||||||
*val = (*val >> (8*(where & 0x3))) & 0xff;
|
|
||||||
else if (size == 2)
|
|
||||||
*val = (*val >> (8*(where & 0x3))) & 0xffff;
|
|
||||||
|
|
||||||
spin_unlock_irqrestore(&orion_pcie_lock, flags);
|
|
||||||
|
|
||||||
return PCIBIOS_SUCCESSFUL;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static int orion_pcie_wr_conf(struct pci_bus *bus, u32 devfn, int where,
|
|
||||||
int size, u32 val)
|
|
||||||
{
|
|
||||||
unsigned long flags;
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
if (orion_pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0)
|
|
||||||
return PCIBIOS_DEVICE_NOT_FOUND;
|
|
||||||
|
|
||||||
spin_lock_irqsave(&orion_pcie_lock, flags);
|
|
||||||
|
|
||||||
ret = PCIBIOS_SUCCESSFUL;
|
|
||||||
|
|
||||||
orion_write(PCIE_CONF_ADDR, 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);
|
|
||||||
|
|
||||||
if (size == 4) {
|
|
||||||
__raw_writel(val, PCIE_CONF_DATA);
|
|
||||||
} else if (size == 2) {
|
|
||||||
__raw_writew(val, PCIE_CONF_DATA + (where & 0x3));
|
|
||||||
} else if (size == 1) {
|
|
||||||
__raw_writeb(val, PCIE_CONF_DATA + (where & 0x3));
|
|
||||||
} else {
|
|
||||||
ret = PCIBIOS_BAD_REGISTER_NUMBER;
|
|
||||||
}
|
|
||||||
|
|
||||||
spin_unlock_irqrestore(&orion_pcie_lock, flags);
|
spin_unlock_irqrestore(&orion_pcie_lock, flags);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
struct pci_ops orion_pcie_ops = {
|
static int pcie_rd_conf_wa(struct pci_bus *bus, u32 devfn,
|
||||||
.read = orion_pcie_rd_conf,
|
int where, int size, u32 *val)
|
||||||
.write = orion_pcie_wr_conf,
|
{
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0) {
|
||||||
|
*val = 0xffffffff;
|
||||||
|
return PCIBIOS_DEVICE_NOT_FOUND;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* We only support access to the non-extended configuration
|
||||||
|
* space when using the WA access method (or we would have to
|
||||||
|
* sacrifice 256M of CPU virtual address space.)
|
||||||
|
*/
|
||||||
|
if (where >= 0x100) {
|
||||||
|
*val = 0xffffffff;
|
||||||
|
return PCIBIOS_DEVICE_NOT_FOUND;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = orion_pcie_rd_conf_wa((void __iomem *)ORION_PCIE_WA_VIRT_BASE,
|
||||||
|
bus, devfn, where, size, val);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int pcie_wr_conf(struct pci_bus *bus, u32 devfn,
|
||||||
|
int where, int size, u32 val)
|
||||||
|
{
|
||||||
|
unsigned long flags;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0)
|
||||||
|
return PCIBIOS_DEVICE_NOT_FOUND;
|
||||||
|
|
||||||
|
spin_lock_irqsave(&orion_pcie_lock, flags);
|
||||||
|
ret = orion_pcie_wr_conf(PCIE_BASE, bus, devfn, where, size, val);
|
||||||
|
spin_unlock_irqrestore(&orion_pcie_lock, flags);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
struct pci_ops pcie_ops = {
|
||||||
|
.read = pcie_rd_conf,
|
||||||
|
.write = pcie_wr_conf,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
static int orion_pcie_setup(struct pci_sys_data *sys)
|
static int pcie_setup(struct pci_sys_data *sys)
|
||||||
{
|
{
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
int dev;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Point PCIe unit MBUS decode windows to DRAM space.
|
* Generic PCIe unit setup.
|
||||||
*/
|
*/
|
||||||
orion_setup_pcie_wins(&orion_mbus_dram_info);
|
orion_pcie_setup(PCIE_BASE, &orion_mbus_dram_info);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Master + Slave enable
|
* Check whether to apply Orion-1/Orion-NAS PCIe config
|
||||||
|
* read transaction workaround.
|
||||||
*/
|
*/
|
||||||
orion_pcie_master_slave_enable();
|
dev = orion_pcie_dev_id(PCIE_BASE);
|
||||||
|
if (dev == MV88F5181_DEV_ID || dev == MV88F5182_DEV_ID) {
|
||||||
|
printk(KERN_NOTICE "Applying Orion-1/Orion-NAS PCIe config "
|
||||||
|
"read transaction workaround\n");
|
||||||
|
pcie_ops.read = pcie_rd_conf_wa;
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Enable interrupts lines A-D
|
* Request resources.
|
||||||
*/
|
|
||||||
orion_pcie_enable_interrupts();
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Request resource
|
|
||||||
*/
|
*/
|
||||||
res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
|
res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
|
||||||
if (!res)
|
if (!res)
|
||||||
panic("orion_pci_setup unable to alloc resources");
|
panic("pcie_setup unable to alloc resources");
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* IORESOURCE_IO
|
* IORESOURCE_IO
|
||||||
@ -417,19 +266,19 @@ static int orion_pcie_setup(struct pci_sys_data *sys)
|
|||||||
*/
|
*/
|
||||||
static DEFINE_SPINLOCK(orion_pci_lock);
|
static DEFINE_SPINLOCK(orion_pci_lock);
|
||||||
|
|
||||||
u32 orion_pci_local_bus_nr(void)
|
int orion_pci_local_bus_nr(void)
|
||||||
{
|
{
|
||||||
u32 conf = orion_read(PCI_P2P_CONF);
|
u32 conf = orion_read(PCI_P2P_CONF);
|
||||||
return((conf & PCI_P2P_BUS_MASK) >> PCI_P2P_BUS_OFFS);
|
return((conf & PCI_P2P_BUS_MASK) >> PCI_P2P_BUS_OFFS);
|
||||||
}
|
}
|
||||||
|
|
||||||
static u32 orion_pci_local_dev_nr(void)
|
static int orion_pci_local_dev_nr(void)
|
||||||
{
|
{
|
||||||
u32 conf = orion_read(PCI_P2P_CONF);
|
u32 conf = orion_read(PCI_P2P_CONF);
|
||||||
return((conf & PCI_P2P_DEV_MASK) >> PCI_P2P_DEV_OFFS);
|
return((conf & PCI_P2P_DEV_MASK) >> PCI_P2P_DEV_OFFS);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int orion_pci_hw_rd_conf(u32 bus, u32 dev, u32 func,
|
static int orion_pci_hw_rd_conf(int bus, int dev, u32 func,
|
||||||
u32 where, u32 size, u32 *val)
|
u32 where, u32 size, u32 *val)
|
||||||
{
|
{
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
@ -451,7 +300,7 @@ static int orion_pci_hw_rd_conf(u32 bus, u32 dev, u32 func,
|
|||||||
return PCIBIOS_SUCCESSFUL;
|
return PCIBIOS_SUCCESSFUL;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int orion_pci_hw_wr_conf(u32 bus, u32 dev, u32 func,
|
static int orion_pci_hw_wr_conf(int bus, int dev, u32 func,
|
||||||
u32 where, u32 size, u32 val)
|
u32 where, u32 size, u32 val)
|
||||||
{
|
{
|
||||||
unsigned long flags;
|
unsigned long flags;
|
||||||
@ -508,7 +357,7 @@ static int orion_pci_wr_conf(struct pci_bus *bus, u32 devfn,
|
|||||||
PCI_FUNC(devfn), where, size, val);
|
PCI_FUNC(devfn), where, size, val);
|
||||||
}
|
}
|
||||||
|
|
||||||
struct pci_ops orion_pci_ops = {
|
struct pci_ops pci_ops = {
|
||||||
.read = orion_pci_rd_conf,
|
.read = orion_pci_rd_conf,
|
||||||
.write = orion_pci_wr_conf,
|
.write = orion_pci_wr_conf,
|
||||||
};
|
};
|
||||||
@ -540,7 +389,8 @@ static void orion_pci_set_bus_nr(int nr)
|
|||||||
|
|
||||||
static void orion_pci_master_slave_enable(void)
|
static void orion_pci_master_slave_enable(void)
|
||||||
{
|
{
|
||||||
u32 bus_nr, dev_nr, func, reg, val;
|
int bus_nr, dev_nr, func, reg;
|
||||||
|
u32 val;
|
||||||
|
|
||||||
bus_nr = orion_pci_local_bus_nr();
|
bus_nr = orion_pci_local_bus_nr();
|
||||||
dev_nr = orion_pci_local_dev_nr();
|
dev_nr = orion_pci_local_dev_nr();
|
||||||
@ -554,8 +404,8 @@ static void orion_pci_master_slave_enable(void)
|
|||||||
static void orion_setup_pci_wins(struct mbus_dram_target_info *dram)
|
static void orion_setup_pci_wins(struct mbus_dram_target_info *dram)
|
||||||
{
|
{
|
||||||
u32 win_enable;
|
u32 win_enable;
|
||||||
u32 bus;
|
int bus;
|
||||||
u32 dev;
|
int dev;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@ -611,7 +461,7 @@ static void orion_setup_pci_wins(struct mbus_dram_target_info *dram)
|
|||||||
orion_setbits(PCI_ADDR_DECODE_CTRL, 1);
|
orion_setbits(PCI_ADDR_DECODE_CTRL, 1);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int orion_pci_setup(struct pci_sys_data *sys)
|
static int pci_setup(struct pci_sys_data *sys)
|
||||||
{
|
{
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
|
||||||
@ -635,7 +485,7 @@ static int orion_pci_setup(struct pci_sys_data *sys)
|
|||||||
*/
|
*/
|
||||||
res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
|
res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
|
||||||
if (!res)
|
if (!res)
|
||||||
panic("orion_pci_setup unable to alloc resources");
|
panic("pci_setup unable to alloc resources");
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* IORESOURCE_IO
|
* IORESOURCE_IO
|
||||||
@ -674,16 +524,11 @@ int orion_pci_sys_setup(int nr, struct pci_sys_data *sys)
|
|||||||
int ret = 0;
|
int ret = 0;
|
||||||
|
|
||||||
if (nr == 0) {
|
if (nr == 0) {
|
||||||
/*
|
orion_pcie_set_local_bus_nr(PCIE_BASE, sys->busnr);
|
||||||
* PCIE setup
|
ret = pcie_setup(sys);
|
||||||
*/
|
|
||||||
orion_pcie_set_bus_nr(0);
|
|
||||||
ret = orion_pcie_setup(sys);
|
|
||||||
} else if (nr == 1) {
|
} else if (nr == 1) {
|
||||||
/*
|
orion_pci_set_bus_nr(sys->busnr);
|
||||||
* PCI setup
|
ret = pci_setup(sys);
|
||||||
*/
|
|
||||||
ret = orion_pci_setup(sys);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
@ -691,31 +536,15 @@ int orion_pci_sys_setup(int nr, struct pci_sys_data *sys)
|
|||||||
|
|
||||||
struct pci_bus *orion_pci_sys_scan_bus(int nr, struct pci_sys_data *sys)
|
struct pci_bus *orion_pci_sys_scan_bus(int nr, struct pci_sys_data *sys)
|
||||||
{
|
{
|
||||||
struct pci_ops *ops;
|
|
||||||
struct pci_bus *bus;
|
struct pci_bus *bus;
|
||||||
|
|
||||||
|
|
||||||
if (nr == 0) {
|
if (nr == 0) {
|
||||||
u32 pci_bus;
|
bus = pci_scan_bus(sys->busnr, &pcie_ops, sys);
|
||||||
/*
|
|
||||||
* PCIE scan
|
|
||||||
*/
|
|
||||||
ops = &orion_pcie_ops;
|
|
||||||
bus = pci_scan_bus(sys->busnr, ops, sys);
|
|
||||||
/*
|
|
||||||
* Set local PCI bus number to follow PCIE bridges (if any)
|
|
||||||
*/
|
|
||||||
pci_bus = bus->number + bus->subordinate - bus->secondary + 1;
|
|
||||||
orion_pci_set_bus_nr(pci_bus);
|
|
||||||
} else if (nr == 1) {
|
} else if (nr == 1) {
|
||||||
/*
|
bus = pci_scan_bus(sys->busnr, &pci_ops, sys);
|
||||||
* PCI scan
|
|
||||||
*/
|
|
||||||
ops = &orion_pci_ops;
|
|
||||||
bus = pci_scan_bus(sys->busnr, ops, sys);
|
|
||||||
} else {
|
} else {
|
||||||
BUG();
|
|
||||||
bus = NULL;
|
bus = NULL;
|
||||||
|
BUG();
|
||||||
}
|
}
|
||||||
|
|
||||||
return bus;
|
return bus;
|
||||||
|
@ -2,7 +2,7 @@
|
|||||||
# Makefile for the linux kernel.
|
# Makefile for the linux kernel.
|
||||||
#
|
#
|
||||||
|
|
||||||
obj-y := irq.o
|
obj-y := irq.o pcie.o
|
||||||
obj-m :=
|
obj-m :=
|
||||||
obj-n :=
|
obj-n :=
|
||||||
obj- :=
|
obj- :=
|
||||||
|
245
arch/arm/plat-orion/pcie.c
Normal file
245
arch/arm/plat-orion/pcie.c
Normal file
@ -0,0 +1,245 @@
|
|||||||
|
/*
|
||||||
|
* 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_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 __init orion_pcie_link_up(void __iomem *base)
|
||||||
|
{
|
||||||
|
return !(readl(base + PCIE_STAT_OFF) & PCIE_STAT_LINK_DOWN);
|
||||||
|
}
|
||||||
|
|
||||||
|
int __init 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;
|
||||||
|
}
|
31
include/asm-arm/plat-orion/pcie.h
Normal file
31
include/asm-arm/plat-orion/pcie.h
Normal file
@ -0,0 +1,31 @@
|
|||||||
|
/*
|
||||||
|
* include/asm-arm/plat-orion/pcie.h
|
||||||
|
*
|
||||||
|
* 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.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef __ASM_PLAT_ORION_PCIE_H
|
||||||
|
#define __ASM_PLAT_ORION_PCIE_H
|
||||||
|
|
||||||
|
u32 orion_pcie_dev_id(void __iomem *base);
|
||||||
|
u32 orion_pcie_rev(void __iomem *base);
|
||||||
|
int orion_pcie_link_up(void __iomem *base);
|
||||||
|
int orion_pcie_get_local_bus_nr(void __iomem *base);
|
||||||
|
void orion_pcie_set_local_bus_nr(void __iomem *base, int nr);
|
||||||
|
void orion_pcie_setup(void __iomem *base,
|
||||||
|
struct mbus_dram_target_info *dram);
|
||||||
|
int orion_pcie_rd_conf(void __iomem *base, struct pci_bus *bus,
|
||||||
|
u32 devfn, int where, int size, u32 *val);
|
||||||
|
int orion_pcie_rd_conf_tlp(void __iomem *base, struct pci_bus *bus,
|
||||||
|
u32 devfn, int where, int size, u32 *val);
|
||||||
|
int orion_pcie_rd_conf_wa(void __iomem *wa_base, struct pci_bus *bus,
|
||||||
|
u32 devfn, int where, int size, u32 *val);
|
||||||
|
int orion_pcie_wr_conf(void __iomem *base, struct pci_bus *bus,
|
||||||
|
u32 devfn, int where, int size, u32 val);
|
||||||
|
|
||||||
|
|
||||||
|
#endif
|
Loading…
Reference in New Issue
Block a user