[deliverable/linux.git] / arch / arm / mach-orion5x / pci.c

/*
 * arch/arm/mach-orion5x/pci.c
 *
 * PCI and PCIe functions for Marvell Orion System On Chip
 *
 * Maintainer: Tzachi Perelstein <tzachi@marvell.com>
 *
 * 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/irq.h>
#include <asm/mach/pci.h>
#include <plat/pcie.h>
#include "common.h"

/*****************************************************************************
 * Orion has one PCIe controller and one PCI controller.
 *
 * Note1: The local PCIe bus number is '0'. The local PCI bus number
 * follows the scanned PCIe bridged busses, if any.
 *
 * Note2: It is possible for PCI/PCIe agents to access many subsystem's
 * space, by configuring BARs and Address Decode Windows, e.g. flashes on
 * device bus, Orion registers, etc. However this code only enable the
 * access to DDR banks.
 ****************************************************************************/


/*****************************************************************************
 * PCIe controller
 ****************************************************************************/
#define PCIE_BASE	((void __iomem *)ORION5X_PCIE_VIRT_BASE)

void __init orion5x_pcie_id(u32 *dev, u32 *rev)
{
	*dev = orion_pcie_dev_id(PCIE_BASE);
	*rev = orion_pcie_rev(PCIE_BASE);
}

static int pcie_valid_config(int bus, int dev)
{
	/*
	 * Don't go out when trying to access --
	 * 1. nonexisting device on local bus
	 * 2. where there's no device connected (no link)
	 */
	if (bus == 0 && dev == 0)
		return 1;

	if (!orion_pcie_link_up(PCIE_BASE))
		return 0;

	if (bus == 0 && dev != 1)
		return 0;

	return 1;
}


/*
 * PCIe config cycles are done by programming the PCIE_CONF_ADDR register
 * and then reading the PCIE_CONF_DATA register. Need to make sure these
 * transactions are atomic.
 */
static DEFINE_SPINLOCK(orion5x_pcie_lock);

static int pcie_rd_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) {
		*val = 0xffffffff;
		return PCIBIOS_DEVICE_NOT_FOUND;
	}

	spin_lock_irqsave(&orion5x_pcie_lock, flags);
	ret = orion_pcie_rd_conf(PCIE_BASE, bus, devfn, where, size, val);
	spin_unlock_irqrestore(&orion5x_pcie_lock, flags);

	return ret;
}

static int pcie_rd_conf_wa(struct pci_bus *bus, u32 devfn,
			   int where, int size, u32 *val)
{
	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 *)ORION5X_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(&orion5x_pcie_lock, flags);
	ret = orion_pcie_wr_conf(PCIE_BASE, bus, devfn, where, size, val);
	spin_unlock_irqrestore(&orion5x_pcie_lock, flags);

	return ret;
}

static struct pci_ops pcie_ops = {
	.read = pcie_rd_conf,
	.write = pcie_wr_conf,
};


static int __init pcie_setup(struct pci_sys_data *sys)
{
	struct resource *res;
	int dev;

	/*
	 * Generic PCIe unit setup.
	 */
	orion_pcie_setup(PCIE_BASE, &orion5x_mbus_dram_info);

	/*
	 * Check whether to apply Orion-1/Orion-NAS PCIe config
	 * read transaction workaround.
	 */
	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");
		orion5x_setup_pcie_wa_win(ORION5X_PCIE_WA_PHYS_BASE,
					  ORION5X_PCIE_WA_SIZE);
		pcie_ops.read = pcie_rd_conf_wa;
	}

	/*
	 * Request resources.
	 */
	res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
	if (!res)
		panic("pcie_setup unable to alloc resources");

	/*
	 * IORESOURCE_IO
	 */
	res[0].name = "PCIe I/O Space";
	res[0].flags = IORESOURCE_IO;
	res[0].start = ORION5X_PCIE_IO_BUS_BASE;
	res[0].end = res[0].start + ORION5X_PCIE_IO_SIZE - 1;
	if (request_resource(&ioport_resource, &res[0]))
		panic("Request PCIe IO resource failed\n");
	sys->resource[0] = &res[0];

	/*
	 * IORESOURCE_MEM
	 */
	res[1].name = "PCIe Memory Space";
	res[1].flags = IORESOURCE_MEM;
	res[1].start = ORION5X_PCIE_MEM_PHYS_BASE;
	res[1].end = res[1].start + ORION5X_PCIE_MEM_SIZE - 1;
	if (request_resource(&iomem_resource, &res[1]))
		panic("Request PCIe Memory resource failed\n");
	sys->resource[1] = &res[1];

	sys->resource[2] = NULL;
	sys->io_offset = 0;

	return 1;
}

/*****************************************************************************
 * PCI controller
 ****************************************************************************/
#define ORION5X_PCI_REG(x)	(ORION5X_PCI_VIRT_BASE | (x))
#define PCI_MODE		ORION5X_PCI_REG(0xd00)
#define PCI_CMD			ORION5X_PCI_REG(0xc00)
#define PCI_P2P_CONF		ORION5X_PCI_REG(0x1d14)
#define PCI_CONF_ADDR		ORION5X_PCI_REG(0xc78)
#define PCI_CONF_DATA		ORION5X_PCI_REG(0xc7c)

/*
 * PCI_MODE bits
 */
#define PCI_MODE_64BIT			(1 << 2)
#define PCI_MODE_PCIX			((1 << 4) | (1 << 5))

/*
 * PCI_CMD bits
 */
#define PCI_CMD_HOST_REORDER		(1 << 29)

/*
 * PCI_P2P_CONF bits
 */
#define PCI_P2P_BUS_OFFS		16
#define PCI_P2P_BUS_MASK		(0xff << PCI_P2P_BUS_OFFS)
#define PCI_P2P_DEV_OFFS		24
#define PCI_P2P_DEV_MASK		(0x1f << PCI_P2P_DEV_OFFS)

/*
 * PCI_CONF_ADDR bits
 */
#define PCI_CONF_REG(reg)		((reg) & 0xfc)
#define PCI_CONF_FUNC(func)		(((func) & 0x3) << 8)
#define PCI_CONF_DEV(dev)		(((dev) & 0x1f) << 11)
#define PCI_CONF_BUS(bus)		(((bus) & 0xff) << 16)
#define PCI_CONF_ADDR_EN		(1 << 31)

/*
 * Internal configuration space
 */
#define PCI_CONF_FUNC_STAT_CMD		0
#define PCI_CONF_REG_STAT_CMD		4
#define PCIX_STAT			0x64
#define PCIX_STAT_BUS_OFFS		8
#define PCIX_STAT_BUS_MASK		(0xff << PCIX_STAT_BUS_OFFS)

/*
 * PCI Address Decode Windows registers
 */
#define PCI_BAR_SIZE_DDR_CS(n)	(((n) == 0) ? ORION5X_PCI_REG(0xc08) : \
				 ((n) == 1) ? ORION5X_PCI_REG(0xd08) : \
				 ((n) == 2) ? ORION5X_PCI_REG(0xc0c) : \
				 ((n) == 3) ? ORION5X_PCI_REG(0xd0c) : 0)
#define PCI_BAR_REMAP_DDR_CS(n)	(((n) == 0) ? ORION5X_PCI_REG(0xc48) : \
				 ((n) == 1) ? ORION5X_PCI_REG(0xd48) : \
				 ((n) == 2) ? ORION5X_PCI_REG(0xc4c) : \
				 ((n) == 3) ? ORION5X_PCI_REG(0xd4c) : 0)
#define PCI_BAR_ENABLE		ORION5X_PCI_REG(0xc3c)
#define PCI_ADDR_DECODE_CTRL	ORION5X_PCI_REG(0xd3c)

/*
 * PCI configuration helpers for BAR settings
 */
#define PCI_CONF_FUNC_BAR_CS(n)		((n) >> 1)
#define PCI_CONF_REG_BAR_LO_CS(n)	(((n) & 1) ? 0x18 : 0x10)
#define PCI_CONF_REG_BAR_HI_CS(n)	(((n) & 1) ? 0x1c : 0x14)

/*
 * PCI config cycles are done by programming the PCI_CONF_ADDR register
 * and then reading the PCI_CONF_DATA register. Need to make sure these
 * transactions are atomic.
 */
static DEFINE_SPINLOCK(orion5x_pci_lock);

static int orion5x_pci_cardbus_mode;

static int orion5x_pci_local_bus_nr(void)
{
	u32 conf = readl(PCI_P2P_CONF);
	return((conf & PCI_P2P_BUS_MASK) >> PCI_P2P_BUS_OFFS);
}

static int orion5x_pci_hw_rd_conf(int bus, int dev, u32 func,
					u32 where, u32 size, u32 *val)
{
	unsigned long flags;
	spin_lock_irqsave(&orion5x_pci_lock, flags);

	writel(PCI_CONF_BUS(bus) |
		PCI_CONF_DEV(dev) | PCI_CONF_REG(where) |
		PCI_CONF_FUNC(func) | PCI_CONF_ADDR_EN, PCI_CONF_ADDR);

	*val = readl(PCI_CONF_DATA);

	if (size == 1)
		*val = (*val >> (8*(where & 0x3))) & 0xff;
	else if (size == 2)
		*val = (*val >> (8*(where & 0x3))) & 0xffff;

	spin_unlock_irqrestore(&orion5x_pci_lock, flags);

	return PCIBIOS_SUCCESSFUL;
}

static int orion5x_pci_hw_wr_conf(int bus, int dev, u32 func,
					u32 where, u32 size, u32 val)
{
	unsigned long flags;
	int ret = PCIBIOS_SUCCESSFUL;

	spin_lock_irqsave(&orion5x_pci_lock, flags);

	writel(PCI_CONF_BUS(bus) |
		PCI_CONF_DEV(dev) | PCI_CONF_REG(where) |
		PCI_CONF_FUNC(func) | PCI_CONF_ADDR_EN, PCI_CONF_ADDR);

	if (size == 4) {
		__raw_writel(val, PCI_CONF_DATA);
	} else if (size == 2) {
		__raw_writew(val, PCI_CONF_DATA + (where & 0x3));
	} else if (size == 1) {
		__raw_writeb(val, PCI_CONF_DATA + (where & 0x3));
	} else {
		ret = PCIBIOS_BAD_REGISTER_NUMBER;
	}

	spin_unlock_irqrestore(&orion5x_pci_lock, flags);

	return ret;
}

static int orion5x_pci_valid_config(int bus, u32 devfn)
{
	if (bus == orion5x_pci_local_bus_nr()) {
		/*
		 * Don't go out for local device
		 */
		if (PCI_SLOT(devfn) == 0 && PCI_FUNC(devfn) != 0)
			return 0;

		/*
		 * When the PCI signals are directly connected to a
		 * Cardbus slot, ignore all but device IDs 0 and 1.
		 */
		if (orion5x_pci_cardbus_mode && PCI_SLOT(devfn) > 1)
			return 0;
	}

	return 1;
}

static int orion5x_pci_rd_conf(struct pci_bus *bus, u32 devfn,
				int where, int size, u32 *val)
{
	if (!orion5x_pci_valid_config(bus->number, devfn)) {
		*val = 0xffffffff;
		return PCIBIOS_DEVICE_NOT_FOUND;
	}

	return orion5x_pci_hw_rd_conf(bus->number, PCI_SLOT(devfn),
					PCI_FUNC(devfn), where, size, val);
}

static int orion5x_pci_wr_conf(struct pci_bus *bus, u32 devfn,
				int where, int size, u32 val)
{
	if (!orion5x_pci_valid_config(bus->number, devfn))
		return PCIBIOS_DEVICE_NOT_FOUND;

	return orion5x_pci_hw_wr_conf(bus->number, PCI_SLOT(devfn),
					PCI_FUNC(devfn), where, size, val);
}

static struct pci_ops pci_ops = {
	.read = orion5x_pci_rd_conf,
	.write = orion5x_pci_wr_conf,
};

static void __init orion5x_pci_set_bus_nr(int nr)
{
	u32 p2p = readl(PCI_P2P_CONF);

	if (readl(PCI_MODE) & PCI_MODE_PCIX) {
		/*
		 * PCI-X mode
		 */
		u32 pcix_status, bus, dev;
		bus = (p2p & PCI_P2P_BUS_MASK) >> PCI_P2P_BUS_OFFS;
		dev = (p2p & PCI_P2P_DEV_MASK) >> PCI_P2P_DEV_OFFS;
		orion5x_pci_hw_rd_conf(bus, dev, 0, PCIX_STAT, 4, &pcix_status);
		pcix_status &= ~PCIX_STAT_BUS_MASK;
		pcix_status |= (nr << PCIX_STAT_BUS_OFFS);
		orion5x_pci_hw_wr_conf(bus, dev, 0, PCIX_STAT, 4, pcix_status);
	} else {
		/*
		 * PCI Conventional mode
		 */
		p2p &= ~PCI_P2P_BUS_MASK;
		p2p |= (nr << PCI_P2P_BUS_OFFS);
		writel(p2p, PCI_P2P_CONF);
	}
}

static void __init orion5x_pci_master_slave_enable(void)
{
	int bus_nr, func, reg;
	u32 val;

	bus_nr = orion5x_pci_local_bus_nr();
	func = PCI_CONF_FUNC_STAT_CMD;
	reg = PCI_CONF_REG_STAT_CMD;
	orion5x_pci_hw_rd_conf(bus_nr, 0, func, reg, 4, &val);
	val |= (PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
	orion5x_pci_hw_wr_conf(bus_nr, 0, func, reg, 4, val | 0x7);
}

static void __init orion5x_setup_pci_wins(struct mbus_dram_target_info *dram)
{
	u32 win_enable;
	int bus;
	int i;

	/*
	 * First, disable windows.
	 */
	win_enable = 0xffffffff;
	writel(win_enable, PCI_BAR_ENABLE);

	/*
	 * Setup windows for DDR banks.
	 */
	bus = orion5x_pci_local_bus_nr();

	for (i = 0; i < dram->num_cs; i++) {
		struct mbus_dram_window *cs = dram->cs + i;
		u32 func = PCI_CONF_FUNC_BAR_CS(cs->cs_index);
		u32 reg;
		u32 val;

		/*
		 * Write DRAM bank base address register.
		 */
		reg = PCI_CONF_REG_BAR_LO_CS(cs->cs_index);
		orion5x_pci_hw_rd_conf(bus, 0, func, reg, 4, &val);
		val = (cs->base & 0xfffff000) | (val & 0xfff);
		orion5x_pci_hw_wr_conf(bus, 0, func, reg, 4, val);

		/*
		 * Write DRAM bank size register.
		 */
		reg = PCI_CONF_REG_BAR_HI_CS(cs->cs_index);
		orion5x_pci_hw_wr_conf(bus, 0, func, reg, 4, 0);
		writel((cs->size - 1) & 0xfffff000,
			PCI_BAR_SIZE_DDR_CS(cs->cs_index));
		writel(cs->base & 0xfffff000,
			PCI_BAR_REMAP_DDR_CS(cs->cs_index));

		/*
		 * Enable decode window for this chip select.
		 */
		win_enable &= ~(1 << cs->cs_index);
	}

	/*
	 * Re-enable decode windows.
	 */
	writel(win_enable, PCI_BAR_ENABLE);

	/*
	 * Disable automatic update of address remapping when writing to BARs.
	 */
	orion5x_setbits(PCI_ADDR_DECODE_CTRL, 1);
}

static int __init pci_setup(struct pci_sys_data *sys)
{
	struct resource *res;

	/*
	 * Point PCI unit MBUS decode windows to DRAM space.
	 */
	orion5x_setup_pci_wins(&orion5x_mbus_dram_info);

	/*
	 * Master + Slave enable
	 */
	orion5x_pci_master_slave_enable();

	/*
	 * Force ordering
	 */
	orion5x_setbits(PCI_CMD, PCI_CMD_HOST_REORDER);

	/*
	 * Request resources
	 */
	res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
	if (!res)
		panic("pci_setup unable to alloc resources");

	/*
	 * IORESOURCE_IO
	 */
	res[0].name = "PCI I/O Space";
	res[0].flags = IORESOURCE_IO;
	res[0].start = ORION5X_PCI_IO_BUS_BASE;
	res[0].end = res[0].start + ORION5X_PCI_IO_SIZE - 1;
	if (request_resource(&ioport_resource, &res[0]))
		panic("Request PCI IO resource failed\n");
	sys->resource[0] = &res[0];

	/*
	 * IORESOURCE_MEM
	 */
	res[1].name = "PCI Memory Space";
	res[1].flags = IORESOURCE_MEM;
	res[1].start = ORION5X_PCI_MEM_PHYS_BASE;
	res[1].end = res[1].start + ORION5X_PCI_MEM_SIZE - 1;
	if (request_resource(&iomem_resource, &res[1]))
		panic("Request PCI Memory resource failed\n");
	sys->resource[1] = &res[1];

	sys->resource[2] = NULL;
	sys->io_offset = 0;

	return 1;
}


/*****************************************************************************
 * General PCIe + PCI
 ****************************************************************************/
static void __devinit rc_pci_fixup(struct pci_dev *dev)
{
	/*
	 * Prevent enumeration of root complex.
	 */
	if (dev->bus->parent == NULL && dev->devfn == 0) {
		int i;

		for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
			dev->resource[i].start = 0;
			dev->resource[i].end   = 0;
			dev->resource[i].flags = 0;
		}
	}
}
DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_MARVELL, PCI_ANY_ID, rc_pci_fixup);

static int orion5x_pci_disabled __initdata;

void __init orion5x_pci_disable(void)
{
	orion5x_pci_disabled = 1;
}

void __init orion5x_pci_set_cardbus_mode(void)
{
	orion5x_pci_cardbus_mode = 1;
}

int __init orion5x_pci_sys_setup(int nr, struct pci_sys_data *sys)
{
	int ret = 0;

	if (nr == 0) {
		orion_pcie_set_local_bus_nr(PCIE_BASE, sys->busnr);
		ret = pcie_setup(sys);
	} else if (nr == 1 && !orion5x_pci_disabled) {
		orion5x_pci_set_bus_nr(sys->busnr);
		ret = pci_setup(sys);
	}

	return ret;
}

struct pci_bus __init *orion5x_pci_sys_scan_bus(int nr, struct pci_sys_data *sys)
{
	struct pci_bus *bus;

	if (nr == 0) {
		bus = pci_scan_bus(sys->busnr, &pcie_ops, sys);
	} else if (nr == 1 && !orion5x_pci_disabled) {
		bus = pci_scan_bus(sys->busnr, &pci_ops, sys);
	} else {
		bus = NULL;
		BUG();
	}

	return bus;
}

int __init orion5x_pci_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
{
	int bus = dev->bus->number;

	/*
	 * PCIe endpoint?
	 */
	if (orion5x_pci_disabled || bus < orion5x_pci_local_bus_nr())
		return IRQ_ORION5X_PCIE0_INT;

	return -1;
}
Commit	Line	Data
038ee083	1	/*
9dd0b194	2	* arch/arm/mach-orion5x/pci.c
038ee083	3	*
159ffb3a	4	* PCI and PCIe functions for Marvell Orion System On Chip
038ee083 TP	5	*
	6	* Maintainer: Tzachi Perelstein <tzachi@marvell.com>
	7	*
159ffb3a LB	8	* This file is licensed under the terms of the GNU General Public
159ffb3a LB	9	* License version 2. This program is licensed "as is" without any
038ee083 TP	10	* warranty of any kind, whether express or implied.
	11	*/
	12
	13	#include <linux/kernel.h>
	14	#include <linux/pci.h>
1f2223b1	15	#include <linux/mbus.h>
ff89c462	16	#include <asm/irq.h>
038ee083	17	#include <asm/mach/pci.h>
6f088f1d	18	#include <plat/pcie.h>
038ee083 TP	19	#include "common.h"
	20
	21	/*****************************************************************************
159ffb3a	22	* Orion has one PCIe controller and one PCI controller.
038ee083	23	*
159ffb3a LB	24	* Note1: The local PCIe bus number is '0'. The local PCI bus number
159ffb3a LB	25	* follows the scanned PCIe bridged busses, if any.
038ee083	26	*
159ffb3a	27	* Note2: It is possible for PCI/PCIe agents to access many subsystem's
038ee083 TP	28	* space, by configuring BARs and Address Decode Windows, e.g. flashes on
	29	* device bus, Orion registers, etc. However this code only enable the
	30	* access to DDR banks.
	31	****************************************************************************/
	32
	33
	34	/*****************************************************************************
159ffb3a	35	* PCIe controller
038ee083	36	****************************************************************************/
9dd0b194	37	#define PCIE_BASE ((void __iomem *)ORION5X_PCIE_VIRT_BASE)
038ee083	38
9dd0b194	39	void __init orion5x_pcie_id(u32 dev, u32 rev)
038ee083	40	{
abc0197d LB	41	*dev = orion_pcie_dev_id(PCIE_BASE);
abc0197d LB	42	*rev = orion_pcie_rev(PCIE_BASE);
038ee083 TP	43	}
038ee083 TP	44
abc0197d	45	static int pcie_valid_config(int bus, int dev)
038ee083 TP	46	{
	47	/*
	48	* Don't go out when trying to access --
d50c60a8	49	* 1. nonexisting device on local bus
038ee083	50	* 2. where there's no device connected (no link)
038ee083	51	*/
d50c60a8 LB	52	if (bus == 0 && dev == 0)
d50c60a8 LB	53	return 1;
038ee083	54
abc0197d	55	if (!orion_pcie_link_up(PCIE_BASE))
038ee083 TP	56	return 0;
038ee083 TP	57
d50c60a8 LB	58	if (bus == 0 && dev != 1)
	59	return 0;
	60
038ee083 TP	61	return 1;
	62	}
	63
abc0197d LB	64
abc0197d LB	65	/*
159ffb3a	66	* PCIe config cycles are done by programming the PCIE_CONF_ADDR register
abc0197d LB	67	* and then reading the PCIE_CONF_DATA register. Need to make sure these
	68	* transactions are atomic.
	69	*/
9dd0b194	70	static DEFINE_SPINLOCK(orion5x_pcie_lock);
abc0197d LB	71
	72	static int pcie_rd_conf(struct pci_bus *bus, u32 devfn, int where,
	73	int size, u32 *val)
038ee083 TP	74	{
038ee083 TP	75	unsigned long flags;
abc0197d	76	int ret;
038ee083	77
abc0197d	78	if (pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0) {
038ee083 TP	79	*val = 0xffffffff;
	80	return PCIBIOS_DEVICE_NOT_FOUND;
	81	}
	82
9dd0b194	83	spin_lock_irqsave(&orion5x_pcie_lock, flags);
abc0197d	84	ret = orion_pcie_rd_conf(PCIE_BASE, bus, devfn, where, size, val);
9dd0b194	85	spin_unlock_irqrestore(&orion5x_pcie_lock, flags);
038ee083	86
abc0197d LB	87	return ret;
abc0197d LB	88	}
038ee083	89
abc0197d LB	90	static int pcie_rd_conf_wa(struct pci_bus *bus, u32 devfn,
	91	int where, int size, u32 *val)
	92	{
	93	int ret;
038ee083	94
abc0197d LB	95	if (pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0) {
	96	*val = 0xffffffff;
	97	return PCIBIOS_DEVICE_NOT_FOUND;
	98	}
038ee083	99
abc0197d LB	100	/*
	101	* We only support access to the non-extended configuration
	102	* space when using the WA access method (or we would have to
	103	* sacrifice 256M of CPU virtual address space.)
	104	*/
	105	if (where >= 0x100) {
	106	*val = 0xffffffff;
	107	return PCIBIOS_DEVICE_NOT_FOUND;
	108	}
038ee083	109
9dd0b194	110	ret = orion_pcie_rd_conf_wa((void __iomem *)ORION5X_PCIE_WA_VIRT_BASE,
abc0197d	111	bus, devfn, where, size, val);
038ee083	112
abc0197d LB	113	return ret;
abc0197d LB	114	}
038ee083	115
abc0197d LB	116	static int pcie_wr_conf(struct pci_bus *bus, u32 devfn,
abc0197d LB	117	int where, int size, u32 val)
038ee083 TP	118	{
	119	unsigned long flags;
	120	int ret;
	121
abc0197d	122	if (pcie_valid_config(bus->number, PCI_SLOT(devfn)) == 0)
038ee083 TP	123	return PCIBIOS_DEVICE_NOT_FOUND;
038ee083 TP	124
9dd0b194	125	spin_lock_irqsave(&orion5x_pcie_lock, flags);
abc0197d	126	ret = orion_pcie_wr_conf(PCIE_BASE, bus, devfn, where, size, val);
9dd0b194	127	spin_unlock_irqrestore(&orion5x_pcie_lock, flags);
038ee083 TP	128
	129	return ret;
	130	}
	131
159ffb3a	132	static struct pci_ops pcie_ops = {
abc0197d LB	133	.read = pcie_rd_conf,
abc0197d LB	134	.write = pcie_wr_conf,
038ee083 TP	135	};
	136
	137
a9984270	138	static int __init pcie_setup(struct pci_sys_data *sys)
038ee083 TP	139	{
038ee083 TP	140	struct resource *res;
abc0197d	141	int dev;
038ee083	142
1f2223b1	143	/*
abc0197d	144	* Generic PCIe unit setup.
038ee083	145	*/
9dd0b194	146	orion_pcie_setup(PCIE_BASE, &orion5x_mbus_dram_info);
038ee083 TP	147
038ee083 TP	148	/*
abc0197d LB	149	* Check whether to apply Orion-1/Orion-NAS PCIe config
abc0197d LB	150	* read transaction workaround.
038ee083	151	*/
abc0197d LB	152	dev = orion_pcie_dev_id(PCIE_BASE);
	153	if (dev == MV88F5181_DEV_ID \|\| dev == MV88F5182_DEV_ID) {
	154	printk(KERN_NOTICE "Applying Orion-1/Orion-NAS PCIe config "
	155	"read transaction workaround\n");
386a048a LB	156	orion5x_setup_pcie_wa_win(ORION5X_PCIE_WA_PHYS_BASE,
386a048a LB	157	ORION5X_PCIE_WA_SIZE);
abc0197d LB	158	pcie_ops.read = pcie_rd_conf_wa;
abc0197d LB	159	}
038ee083 TP	160
038ee083 TP	161	/*
abc0197d	162	* Request resources.
038ee083 TP	163	*/
	164	res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
	165	if (!res)
abc0197d	166	panic("pcie_setup unable to alloc resources");
038ee083 TP	167
	168	/*
	169	* IORESOURCE_IO
	170	*/
159ffb3a	171	res[0].name = "PCIe I/O Space";
038ee083	172	res[0].flags = IORESOURCE_IO;
9dd0b194 LB	173	res[0].start = ORION5X_PCIE_IO_BUS_BASE;
9dd0b194 LB	174	res[0].end = res[0].start + ORION5X_PCIE_IO_SIZE - 1;
038ee083	175	if (request_resource(&ioport_resource, &res[0]))
159ffb3a	176	panic("Request PCIe IO resource failed\n");
038ee083 TP	177	sys->resource[0] = &res[0];
	178
	179	/*
	180	* IORESOURCE_MEM
	181	*/
159ffb3a	182	res[1].name = "PCIe Memory Space";
038ee083	183	res[1].flags = IORESOURCE_MEM;
9dd0b194 LB	184	res[1].start = ORION5X_PCIE_MEM_PHYS_BASE;
9dd0b194 LB	185	res[1].end = res[1].start + ORION5X_PCIE_MEM_SIZE - 1;
038ee083	186	if (request_resource(&iomem_resource, &res[1]))
159ffb3a	187	panic("Request PCIe Memory resource failed\n");
038ee083 TP	188	sys->resource[1] = &res[1];
	189
	190	sys->resource[2] = NULL;
	191	sys->io_offset = 0;
	192
	193	return 1;
	194	}
	195
	196	/*****************************************************************************
	197	* PCI controller
	198	****************************************************************************/
fdd8b079	199	#define ORION5X_PCI_REG(x) (ORION5X_PCI_VIRT_BASE \| (x))
9dd0b194 LB	200	#define PCI_MODE ORION5X_PCI_REG(0xd00)
	201	#define PCI_CMD ORION5X_PCI_REG(0xc00)
	202	#define PCI_P2P_CONF ORION5X_PCI_REG(0x1d14)
	203	#define PCI_CONF_ADDR ORION5X_PCI_REG(0xc78)
	204	#define PCI_CONF_DATA ORION5X_PCI_REG(0xc7c)
038ee083 TP	205
	206	/*
	207	* PCI_MODE bits
	208	*/
	209	#define PCI_MODE_64BIT (1 << 2)
	210	#define PCI_MODE_PCIX ((1 << 4) \| (1 << 5))
	211
	212	/*
	213	* PCI_CMD bits
	214	*/
	215	#define PCI_CMD_HOST_REORDER (1 << 29)
	216
	217	/*
	218	* PCI_P2P_CONF bits
	219	*/
	220	#define PCI_P2P_BUS_OFFS 16
	221	#define PCI_P2P_BUS_MASK (0xff << PCI_P2P_BUS_OFFS)
	222	#define PCI_P2P_DEV_OFFS 24
	223	#define PCI_P2P_DEV_MASK (0x1f << PCI_P2P_DEV_OFFS)
	224
	225	/*
	226	* PCI_CONF_ADDR bits
	227	*/
	228	#define PCI_CONF_REG(reg) ((reg) & 0xfc)
	229	#define PCI_CONF_FUNC(func) (((func) & 0x3) << 8)
	230	#define PCI_CONF_DEV(dev) (((dev) & 0x1f) << 11)
	231	#define PCI_CONF_BUS(bus) (((bus) & 0xff) << 16)
	232	#define PCI_CONF_ADDR_EN (1 << 31)
	233
	234	/*
	235	* Internal configuration space
	236	*/
	237	#define PCI_CONF_FUNC_STAT_CMD 0
	238	#define PCI_CONF_REG_STAT_CMD 4
	239	#define PCIX_STAT 0x64
	240	#define PCIX_STAT_BUS_OFFS 8
	241	#define PCIX_STAT_BUS_MASK (0xff << PCIX_STAT_BUS_OFFS)
	242
1f2223b1 LB	243	/*
	244	* PCI Address Decode Windows registers
	245	*/
9dd0b194	246	#define PCI_BAR_SIZE_DDR_CS(n) (((n) == 0) ? ORION5X_PCI_REG(0xc08) : \
e7068ad3 LB	247	((n) == 1) ? ORION5X_PCI_REG(0xd08) : \
	248	((n) == 2) ? ORION5X_PCI_REG(0xc0c) : \
	249	((n) == 3) ? ORION5X_PCI_REG(0xd0c) : 0)
	250	#define PCI_BAR_REMAP_DDR_CS(n) (((n) == 0) ? ORION5X_PCI_REG(0xc48) : \
	251	((n) == 1) ? ORION5X_PCI_REG(0xd48) : \
	252	((n) == 2) ? ORION5X_PCI_REG(0xc4c) : \
	253	((n) == 3) ? ORION5X_PCI_REG(0xd4c) : 0)
9dd0b194 LB	254	#define PCI_BAR_ENABLE ORION5X_PCI_REG(0xc3c)
9dd0b194 LB	255	#define PCI_ADDR_DECODE_CTRL ORION5X_PCI_REG(0xd3c)
1f2223b1 LB	256
	257	/*
	258	* PCI configuration helpers for BAR settings
	259	*/
	260	#define PCI_CONF_FUNC_BAR_CS(n) ((n) >> 1)
	261	#define PCI_CONF_REG_BAR_LO_CS(n) (((n) & 1) ? 0x18 : 0x10)
	262	#define PCI_CONF_REG_BAR_HI_CS(n) (((n) & 1) ? 0x1c : 0x14)
	263
038ee083 TP	264	/*
	265	* PCI config cycles are done by programming the PCI_CONF_ADDR register
	266	* and then reading the PCI_CONF_DATA register. Need to make sure these
	267	* transactions are atomic.
	268	*/
9dd0b194	269	static DEFINE_SPINLOCK(orion5x_pci_lock);
038ee083	270
da01bba3 LB	271	static int orion5x_pci_cardbus_mode;
da01bba3 LB	272
92b913b0	273	static int orion5x_pci_local_bus_nr(void)
038ee083	274	{
79e90dd5	275	u32 conf = readl(PCI_P2P_CONF);
038ee083 TP	276	return((conf & PCI_P2P_BUS_MASK) >> PCI_P2P_BUS_OFFS);
	277	}
	278
9dd0b194	279	static int orion5x_pci_hw_rd_conf(int bus, int dev, u32 func,
038ee083 TP	280	u32 where, u32 size, u32 *val)
	281	{
	282	unsigned long flags;
9dd0b194	283	spin_lock_irqsave(&orion5x_pci_lock, flags);
038ee083	284
79e90dd5 LB	285	writel(PCI_CONF_BUS(bus) \|
	286	PCI_CONF_DEV(dev) \| PCI_CONF_REG(where) \|
	287	PCI_CONF_FUNC(func) \| PCI_CONF_ADDR_EN, PCI_CONF_ADDR);
038ee083	288
79e90dd5	289	*val = readl(PCI_CONF_DATA);
038ee083 TP	290
	291	if (size == 1)
	292	val = (val >> (8*(where & 0x3))) & 0xff;
	293	else if (size == 2)
	294	val = (val >> (8*(where & 0x3))) & 0xffff;
	295
9dd0b194	296	spin_unlock_irqrestore(&orion5x_pci_lock, flags);
038ee083 TP	297
	298	return PCIBIOS_SUCCESSFUL;
	299	}
	300
9dd0b194	301	static int orion5x_pci_hw_wr_conf(int bus, int dev, u32 func,
038ee083 TP	302	u32 where, u32 size, u32 val)
	303	{
	304	unsigned long flags;
	305	int ret = PCIBIOS_SUCCESSFUL;
	306
9dd0b194	307	spin_lock_irqsave(&orion5x_pci_lock, flags);
038ee083	308
79e90dd5 LB	309	writel(PCI_CONF_BUS(bus) \|
	310	PCI_CONF_DEV(dev) \| PCI_CONF_REG(where) \|
	311	PCI_CONF_FUNC(func) \| PCI_CONF_ADDR_EN, PCI_CONF_ADDR);
038ee083 TP	312
	313	if (size == 4) {
	314	__raw_writel(val, PCI_CONF_DATA);
	315	} else if (size == 2) {
	316	__raw_writew(val, PCI_CONF_DATA + (where & 0x3));
	317	} else if (size == 1) {
	318	__raw_writeb(val, PCI_CONF_DATA + (where & 0x3));
	319	} else {
	320	ret = PCIBIOS_BAD_REGISTER_NUMBER;
	321	}
	322
9dd0b194	323	spin_unlock_irqrestore(&orion5x_pci_lock, flags);
038ee083 TP	324
	325	return ret;
	326	}
	327
da01bba3 LB	328	static int orion5x_pci_valid_config(int bus, u32 devfn)
	329	{
	330	if (bus == orion5x_pci_local_bus_nr()) {
	331	/*
	332	* Don't go out for local device
	333	*/
	334	if (PCI_SLOT(devfn) == 0 && PCI_FUNC(devfn) != 0)
	335	return 0;
	336
	337	/*
	338	* When the PCI signals are directly connected to a
	339	* Cardbus slot, ignore all but device IDs 0 and 1.
	340	*/
	341	if (orion5x_pci_cardbus_mode && PCI_SLOT(devfn) > 1)
	342	return 0;
	343	}
	344
	345	return 1;
	346	}
	347
9dd0b194	348	static int orion5x_pci_rd_conf(struct pci_bus *bus, u32 devfn,
038ee083 TP	349	int where, int size, u32 *val)
038ee083 TP	350	{
da01bba3	351	if (!orion5x_pci_valid_config(bus->number, devfn)) {
038ee083 TP	352	*val = 0xffffffff;
	353	return PCIBIOS_DEVICE_NOT_FOUND;
	354	}
	355
9dd0b194	356	return orion5x_pci_hw_rd_conf(bus->number, PCI_SLOT(devfn),
038ee083 TP	357	PCI_FUNC(devfn), where, size, val);
	358	}
	359
9dd0b194	360	static int orion5x_pci_wr_conf(struct pci_bus *bus, u32 devfn,
038ee083 TP	361	int where, int size, u32 val)
038ee083 TP	362	{
da01bba3	363	if (!orion5x_pci_valid_config(bus->number, devfn))
038ee083 TP	364	return PCIBIOS_DEVICE_NOT_FOUND;
038ee083 TP	365
9dd0b194	366	return orion5x_pci_hw_wr_conf(bus->number, PCI_SLOT(devfn),
038ee083 TP	367	PCI_FUNC(devfn), where, size, val);
	368	}
	369
159ffb3a	370	static struct pci_ops pci_ops = {
9dd0b194 LB	371	.read = orion5x_pci_rd_conf,
9dd0b194 LB	372	.write = orion5x_pci_wr_conf,
038ee083 TP	373	};
038ee083 TP	374
9dd0b194	375	static void __init orion5x_pci_set_bus_nr(int nr)
038ee083	376	{
79e90dd5	377	u32 p2p = readl(PCI_P2P_CONF);
038ee083	378
79e90dd5	379	if (readl(PCI_MODE) & PCI_MODE_PCIX) {
038ee083 TP	380	/*
	381	* PCI-X mode
	382	*/
	383	u32 pcix_status, bus, dev;
	384	bus = (p2p & PCI_P2P_BUS_MASK) >> PCI_P2P_BUS_OFFS;
	385	dev = (p2p & PCI_P2P_DEV_MASK) >> PCI_P2P_DEV_OFFS;
9dd0b194	386	orion5x_pci_hw_rd_conf(bus, dev, 0, PCIX_STAT, 4, &pcix_status);
038ee083 TP	387	pcix_status &= ~PCIX_STAT_BUS_MASK;
038ee083 TP	388	pcix_status \|= (nr << PCIX_STAT_BUS_OFFS);
9dd0b194	389	orion5x_pci_hw_wr_conf(bus, dev, 0, PCIX_STAT, 4, pcix_status);
038ee083 TP	390	} else {
	391	/*
	392	* PCI Conventional mode
	393	*/
	394	p2p &= ~PCI_P2P_BUS_MASK;
	395	p2p \|= (nr << PCI_P2P_BUS_OFFS);
79e90dd5	396	writel(p2p, PCI_P2P_CONF);
038ee083 TP	397	}
	398	}
	399
9dd0b194	400	static void __init orion5x_pci_master_slave_enable(void)
038ee083	401	{
d50c60a8	402	int bus_nr, func, reg;
abc0197d	403	u32 val;
038ee083	404
9dd0b194	405	bus_nr = orion5x_pci_local_bus_nr();
038ee083 TP	406	func = PCI_CONF_FUNC_STAT_CMD;
038ee083 TP	407	reg = PCI_CONF_REG_STAT_CMD;
9dd0b194	408	orion5x_pci_hw_rd_conf(bus_nr, 0, func, reg, 4, &val);
038ee083	409	val \|= (PCI_COMMAND_IO \| PCI_COMMAND_MEMORY \| PCI_COMMAND_MASTER);
9dd0b194	410	orion5x_pci_hw_wr_conf(bus_nr, 0, func, reg, 4, val \| 0x7);
038ee083 TP	411	}
038ee083 TP	412
9dd0b194	413	static void __init orion5x_setup_pci_wins(struct mbus_dram_target_info *dram)
1f2223b1 LB	414	{
1f2223b1 LB	415	u32 win_enable;
abc0197d	416	int bus;
1f2223b1 LB	417	int i;
	418
	419	/*
	420	* First, disable windows.
	421	*/
	422	win_enable = 0xffffffff;
79e90dd5	423	writel(win_enable, PCI_BAR_ENABLE);
1f2223b1 LB	424
	425	/*
	426	* Setup windows for DDR banks.
	427	*/
9dd0b194	428	bus = orion5x_pci_local_bus_nr();
1f2223b1 LB	429
	430	for (i = 0; i < dram->num_cs; i++) {
	431	struct mbus_dram_window *cs = dram->cs + i;
	432	u32 func = PCI_CONF_FUNC_BAR_CS(cs->cs_index);
	433	u32 reg;
	434	u32 val;
	435
	436	/*
	437	* Write DRAM bank base address register.
	438	*/
	439	reg = PCI_CONF_REG_BAR_LO_CS(cs->cs_index);
9dd0b194	440	orion5x_pci_hw_rd_conf(bus, 0, func, reg, 4, &val);
1f2223b1	441	val = (cs->base & 0xfffff000) \| (val & 0xfff);
9dd0b194	442	orion5x_pci_hw_wr_conf(bus, 0, func, reg, 4, val);
1f2223b1 LB	443
	444	/*
	445	* Write DRAM bank size register.
	446	*/
	447	reg = PCI_CONF_REG_BAR_HI_CS(cs->cs_index);
9dd0b194	448	orion5x_pci_hw_wr_conf(bus, 0, func, reg, 4, 0);
79e90dd5 LB	449	writel((cs->size - 1) & 0xfffff000,
	450	PCI_BAR_SIZE_DDR_CS(cs->cs_index));
	451	writel(cs->base & 0xfffff000,
	452	PCI_BAR_REMAP_DDR_CS(cs->cs_index));
1f2223b1 LB	453
	454	/*
	455	* Enable decode window for this chip select.
	456	*/
	457	win_enable &= ~(1 << cs->cs_index);
	458	}
	459
	460	/*
	461	* Re-enable decode windows.
	462	*/
79e90dd5	463	writel(win_enable, PCI_BAR_ENABLE);
1f2223b1 LB	464
1f2223b1 LB	465	/*
af901ca1	466	* Disable automatic update of address remapping when writing to BARs.
1f2223b1	467	*/
9dd0b194	468	orion5x_setbits(PCI_ADDR_DECODE_CTRL, 1);
1f2223b1 LB	469	}
1f2223b1 LB	470
a9984270	471	static int __init pci_setup(struct pci_sys_data *sys)
038ee083 TP	472	{
	473	struct resource *res;
	474
1f2223b1 LB	475	/*
	476	* Point PCI unit MBUS decode windows to DRAM space.
	477	*/
9dd0b194	478	orion5x_setup_pci_wins(&orion5x_mbus_dram_info);
1f2223b1	479
038ee083 TP	480	/*
	481	* Master + Slave enable
	482	*/
9dd0b194	483	orion5x_pci_master_slave_enable();
038ee083 TP	484
	485	/*
	486	* Force ordering
	487	*/
9dd0b194	488	orion5x_setbits(PCI_CMD, PCI_CMD_HOST_REORDER);
038ee083 TP	489
	490	/*
	491	* Request resources
	492	*/
	493	res = kzalloc(sizeof(struct resource) * 2, GFP_KERNEL);
	494	if (!res)
abc0197d	495	panic("pci_setup unable to alloc resources");
038ee083 TP	496
	497	/*
	498	* IORESOURCE_IO
	499	*/
	500	res[0].name = "PCI I/O Space";
	501	res[0].flags = IORESOURCE_IO;
9dd0b194 LB	502	res[0].start = ORION5X_PCI_IO_BUS_BASE;
9dd0b194 LB	503	res[0].end = res[0].start + ORION5X_PCI_IO_SIZE - 1;
038ee083 TP	504	if (request_resource(&ioport_resource, &res[0]))
	505	panic("Request PCI IO resource failed\n");
	506	sys->resource[0] = &res[0];
	507
	508	/*
	509	* IORESOURCE_MEM
	510	*/
	511	res[1].name = "PCI Memory Space";
	512	res[1].flags = IORESOURCE_MEM;
9dd0b194 LB	513	res[1].start = ORION5X_PCI_MEM_PHYS_BASE;
9dd0b194 LB	514	res[1].end = res[1].start + ORION5X_PCI_MEM_SIZE - 1;
038ee083 TP	515	if (request_resource(&iomem_resource, &res[1]))
	516	panic("Request PCI Memory resource failed\n");
	517	sys->resource[1] = &res[1];
	518
	519	sys->resource[2] = NULL;
	520	sys->io_offset = 0;
	521
	522	return 1;
	523	}
	524
	525
	526	/*****************************************************************************
159ffb3a	527	* General PCIe + PCI
038ee083	528	****************************************************************************/
d50c60a8 LB	529	static void __devinit rc_pci_fixup(struct pci_dev *dev)
	530	{
	531	/*
	532	* Prevent enumeration of root complex.
	533	*/
	534	if (dev->bus->parent == NULL && dev->devfn == 0) {
	535	int i;
	536
	537	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
	538	dev->resource[i].start = 0;
	539	dev->resource[i].end = 0;
	540	dev->resource[i].flags = 0;
	541	}
	542	}
	543	}
	544	DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_MARVELL, PCI_ANY_ID, rc_pci_fixup);
	545
7a6bb262 PA	546	static int orion5x_pci_disabled __initdata;
	547
	548	void __init orion5x_pci_disable(void)
	549	{
	550	orion5x_pci_disabled = 1;
	551	}
	552
da01bba3 LB	553	void __init orion5x_pci_set_cardbus_mode(void)
	554	{
	555	orion5x_pci_cardbus_mode = 1;
	556	}
	557
9dd0b194	558	int __init orion5x_pci_sys_setup(int nr, struct pci_sys_data *sys)
038ee083 TP	559	{
	560	int ret = 0;
	561
	562	if (nr == 0) {
abc0197d LB	563	orion_pcie_set_local_bus_nr(PCIE_BASE, sys->busnr);
abc0197d LB	564	ret = pcie_setup(sys);
7a6bb262	565	} else if (nr == 1 && !orion5x_pci_disabled) {
9dd0b194	566	orion5x_pci_set_bus_nr(sys->busnr);
abc0197d	567	ret = pci_setup(sys);
038ee083 TP	568	}
	569
	570	return ret;
	571	}
	572
9dd0b194	573	struct pci_bus __init orion5x_pci_sys_scan_bus(int nr, struct pci_sys_data sys)
038ee083	574	{
038ee083 TP	575	struct pci_bus *bus;
038ee083 TP	576
038ee083	577	if (nr == 0) {
abc0197d	578	bus = pci_scan_bus(sys->busnr, &pcie_ops, sys);
7a6bb262	579	} else if (nr == 1 && !orion5x_pci_disabled) {
abc0197d	580	bus = pci_scan_bus(sys->busnr, &pci_ops, sys);
038ee083	581	} else {
038ee083	582	bus = NULL;
abc0197d	583	BUG();
038ee083 TP	584	}
	585
	586	return bus;
	587	}
92b913b0 LB	588
	589	int __init orion5x_pci_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
	590	{
	591	int bus = dev->bus->number;
	592
	593	/*
	594	* PCIe endpoint?
	595	*/
7a6bb262	596	if (orion5x_pci_disabled \|\| bus < orion5x_pci_local_bus_nr())
92b913b0 LB	597	return IRQ_ORION5X_PCIE0_INT;
	598
	599	return -1;
	600	}