| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524 | /* * 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/slab.h>#include <linux/mbus.h>#include <video/vga.h>#include <asm/irq.h>#include <asm/mach/pci.h>#include <plat/pcie.h>#include <plat/addr-map.h>#include <mach/orion5x.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	(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(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);	/*	 * 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;	}	pci_ioremap_io(sys->busnr * SZ_64K, ORION5X_PCIE_IO_PHYS_BASE);	/*	 * Request resources.	 */	res = kzalloc(sizeof(struct resource), GFP_KERNEL);	if (!res)		panic("pcie_setup unable to alloc resources");	/*	 * IORESOURCE_MEM	 */	res->name = "PCIe Memory Space";	res->flags = IORESOURCE_MEM;	res->start = ORION5X_PCIE_MEM_PHYS_BASE;	res->end = res->start + ORION5X_PCIE_MEM_SIZE - 1;	if (request_resource(&iomem_resource, res))		panic("Request PCIe Memory resource failed\n");	pci_add_resource_offset(&sys->resources, res, sys->mem_offset);	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(&orion_mbus_dram_info);	/*	 * Master + Slave enable	 */	orion5x_pci_master_slave_enable();	/*	 * Force ordering	 */	orion5x_setbits(PCI_CMD, PCI_CMD_HOST_REORDER);	pci_ioremap_io(sys->busnr * SZ_64K, ORION5X_PCI_IO_PHYS_BASE);	/*	 * Request resources	 */	res = kzalloc(sizeof(struct resource), GFP_KERNEL);	if (!res)		panic("pci_setup unable to alloc resources");	/*	 * IORESOURCE_MEM	 */	res->name = "PCI Memory Space";	res->flags = IORESOURCE_MEM;	res->start = ORION5X_PCI_MEM_PHYS_BASE;	res->end = res->start + ORION5X_PCI_MEM_SIZE - 1;	if (request_resource(&iomem_resource, res))		panic("Request PCI Memory resource failed\n");	pci_add_resource_offset(&sys->resources, res, sys->mem_offset);	return 1;}/***************************************************************************** * General PCIe + PCI ****************************************************************************/static void 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);
 |