 7034228792
			
		
	
	
	7034228792
	
	
	
		
			
			Having received another series of whitespace patches I decided to do this once and for all rather than dealing with this kind of patches trickling in forever. Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
		
			
				
	
	
		
			376 lines
		
	
	
	
		
			9.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			376 lines
		
	
	
	
		
			9.2 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright 2003-2011 NetLogic Microsystems, Inc. (NetLogic). All rights
 | |
|  * reserved.
 | |
|  *
 | |
|  * This software is available to you under a choice of one of two
 | |
|  * licenses.  You may choose to be licensed under the terms of the GNU
 | |
|  * General Public License (GPL) Version 2, available from the file
 | |
|  * COPYING in the main directory of this source tree, or the NetLogic
 | |
|  * license below:
 | |
|  *
 | |
|  * Redistribution and use in source and binary forms, with or without
 | |
|  * modification, are permitted provided that the following conditions
 | |
|  * are met:
 | |
|  *
 | |
|  * 1. Redistributions of source code must retain the above copyright
 | |
|  *    notice, this list of conditions and the following disclaimer.
 | |
|  * 2. Redistributions in binary form must reproduce the above copyright
 | |
|  *    notice, this list of conditions and the following disclaimer in
 | |
|  *    the documentation and/or other materials provided with the
 | |
|  *    distribution.
 | |
|  *
 | |
|  * THIS SOFTWARE IS PROVIDED BY NETLOGIC ``AS IS'' AND ANY EXPRESS OR
 | |
|  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 | |
|  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 | |
|  * ARE DISCLAIMED. IN NO EVENT SHALL NETLOGIC OR CONTRIBUTORS BE LIABLE
 | |
|  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 | |
|  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 | |
|  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
 | |
|  * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 | |
|  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
 | |
|  * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
 | |
|  * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 | |
|  */
 | |
| 
 | |
| #include <linux/types.h>
 | |
| #include <linux/pci.h>
 | |
| #include <linux/kernel.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/msi.h>
 | |
| #include <linux/mm.h>
 | |
| #include <linux/irq.h>
 | |
| #include <linux/irqdesc.h>
 | |
| #include <linux/console.h>
 | |
| #include <linux/pci_regs.h>
 | |
| 
 | |
| #include <asm/io.h>
 | |
| 
 | |
| #include <asm/netlogic/interrupt.h>
 | |
| #include <asm/netlogic/haldefs.h>
 | |
| #include <asm/netlogic/common.h>
 | |
| 
 | |
| #include <asm/netlogic/xlr/msidef.h>
 | |
| #include <asm/netlogic/xlr/iomap.h>
 | |
| #include <asm/netlogic/xlr/pic.h>
 | |
| #include <asm/netlogic/xlr/xlr.h>
 | |
| 
 | |
| static void *pci_config_base;
 | |
| 
 | |
| #define pci_cfg_addr(bus, devfn, off) (((bus) << 16) | ((devfn) << 8) | (off))
 | |
| 
 | |
| /* PCI ops */
 | |
| static inline u32 pci_cfg_read_32bit(struct pci_bus *bus, unsigned int devfn,
 | |
| 	int where)
 | |
| {
 | |
| 	u32 data;
 | |
| 	u32 *cfgaddr;
 | |
| 
 | |
| 	cfgaddr = (u32 *)(pci_config_base +
 | |
| 			pci_cfg_addr(bus->number, devfn, where & ~3));
 | |
| 	data = *cfgaddr;
 | |
| 	return cpu_to_le32(data);
 | |
| }
 | |
| 
 | |
| static inline void pci_cfg_write_32bit(struct pci_bus *bus, unsigned int devfn,
 | |
| 	int where, u32 data)
 | |
| {
 | |
| 	u32 *cfgaddr;
 | |
| 
 | |
| 	cfgaddr = (u32 *)(pci_config_base +
 | |
| 			pci_cfg_addr(bus->number, devfn, where & ~3));
 | |
| 	*cfgaddr = cpu_to_le32(data);
 | |
| }
 | |
| 
 | |
| static int nlm_pcibios_read(struct pci_bus *bus, unsigned int devfn,
 | |
| 	int where, int size, u32 *val)
 | |
| {
 | |
| 	u32 data;
 | |
| 
 | |
| 	if ((size == 2) && (where & 1))
 | |
| 		return PCIBIOS_BAD_REGISTER_NUMBER;
 | |
| 	else if ((size == 4) && (where & 3))
 | |
| 		return PCIBIOS_BAD_REGISTER_NUMBER;
 | |
| 
 | |
| 	data = pci_cfg_read_32bit(bus, devfn, where);
 | |
| 
 | |
| 	if (size == 1)
 | |
| 		*val = (data >> ((where & 3) << 3)) & 0xff;
 | |
| 	else if (size == 2)
 | |
| 		*val = (data >> ((where & 3) << 3)) & 0xffff;
 | |
| 	else
 | |
| 		*val = data;
 | |
| 
 | |
| 	return PCIBIOS_SUCCESSFUL;
 | |
| }
 | |
| 
 | |
| 
 | |
| static int nlm_pcibios_write(struct pci_bus *bus, unsigned int devfn,
 | |
| 		int where, int size, u32 val)
 | |
| {
 | |
| 	u32 data;
 | |
| 
 | |
| 	if ((size == 2) && (where & 1))
 | |
| 		return PCIBIOS_BAD_REGISTER_NUMBER;
 | |
| 	else if ((size == 4) && (where & 3))
 | |
| 		return PCIBIOS_BAD_REGISTER_NUMBER;
 | |
| 
 | |
| 	data = pci_cfg_read_32bit(bus, devfn, where);
 | |
| 
 | |
| 	if (size == 1)
 | |
| 		data = (data & ~(0xff << ((where & 3) << 3))) |
 | |
| 			(val << ((where & 3) << 3));
 | |
| 	else if (size == 2)
 | |
| 		data = (data & ~(0xffff << ((where & 3) << 3))) |
 | |
| 			(val << ((where & 3) << 3));
 | |
| 	else
 | |
| 		data = val;
 | |
| 
 | |
| 	pci_cfg_write_32bit(bus, devfn, where, data);
 | |
| 
 | |
| 	return PCIBIOS_SUCCESSFUL;
 | |
| }
 | |
| 
 | |
| struct pci_ops nlm_pci_ops = {
 | |
| 	.read  = nlm_pcibios_read,
 | |
| 	.write = nlm_pcibios_write
 | |
| };
 | |
| 
 | |
| static struct resource nlm_pci_mem_resource = {
 | |
| 	.name		= "XLR PCI MEM",
 | |
| 	.start		= 0xd0000000UL, /* 256MB PCI mem @ 0xd000_0000 */
 | |
| 	.end		= 0xdfffffffUL,
 | |
| 	.flags		= IORESOURCE_MEM,
 | |
| };
 | |
| 
 | |
| static struct resource nlm_pci_io_resource = {
 | |
| 	.name		= "XLR IO MEM",
 | |
| 	.start		= 0x10000000UL, /* 16MB PCI IO @ 0x1000_0000 */
 | |
| 	.end		= 0x100fffffUL,
 | |
| 	.flags		= IORESOURCE_IO,
 | |
| };
 | |
| 
 | |
| struct pci_controller nlm_pci_controller = {
 | |
| 	.index		= 0,
 | |
| 	.pci_ops	= &nlm_pci_ops,
 | |
| 	.mem_resource	= &nlm_pci_mem_resource,
 | |
| 	.mem_offset	= 0x00000000UL,
 | |
| 	.io_resource	= &nlm_pci_io_resource,
 | |
| 	.io_offset	= 0x00000000UL,
 | |
| };
 | |
| 
 | |
| /*
 | |
|  * The top level PCIe links on the XLS PCIe controller appear as
 | |
|  * bridges. Given a device, this function finds which link it is
 | |
|  * on.
 | |
|  */
 | |
| static struct pci_dev *xls_get_pcie_link(const struct pci_dev *dev)
 | |
| {
 | |
| 	struct pci_bus *bus, *p;
 | |
| 
 | |
| 	/* Find the bridge on bus 0 */
 | |
| 	bus = dev->bus;
 | |
| 	for (p = bus->parent; p && p->number != 0; p = p->parent)
 | |
| 		bus = p;
 | |
| 
 | |
| 	return p ? bus->self : NULL;
 | |
| }
 | |
| 
 | |
| static int nlm_pci_link_to_irq(int link)
 | |
| {
 | |
| 	switch	(link) {
 | |
| 	case 0:
 | |
| 		return PIC_PCIE_LINK0_IRQ;
 | |
| 	case 1:
 | |
| 		return PIC_PCIE_LINK1_IRQ;
 | |
| 	case 2:
 | |
| 		if (nlm_chip_is_xls_b())
 | |
| 			return PIC_PCIE_XLSB0_LINK2_IRQ;
 | |
| 		else
 | |
| 			return PIC_PCIE_LINK2_IRQ;
 | |
| 	case 3:
 | |
| 		if (nlm_chip_is_xls_b())
 | |
| 			return PIC_PCIE_XLSB0_LINK3_IRQ;
 | |
| 		else
 | |
| 			return PIC_PCIE_LINK3_IRQ;
 | |
| 	}
 | |
| 	WARN(1, "Unexpected link %d\n", link);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int get_irq_vector(const struct pci_dev *dev)
 | |
| {
 | |
| 	struct pci_dev *lnk;
 | |
| 	int link;
 | |
| 
 | |
| 	if (!nlm_chip_is_xls())
 | |
| 		return	PIC_PCIX_IRQ;	/* for XLR just one IRQ */
 | |
| 
 | |
| 	lnk = xls_get_pcie_link(dev);
 | |
| 	if (lnk == NULL)
 | |
| 		return 0;
 | |
| 
 | |
| 	link = PCI_SLOT(lnk->devfn);
 | |
| 	return nlm_pci_link_to_irq(link);
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_PCI_MSI
 | |
| void destroy_irq(unsigned int irq)
 | |
| {
 | |
| 	    /* nothing to do yet */
 | |
| }
 | |
| 
 | |
| void arch_teardown_msi_irq(unsigned int irq)
 | |
| {
 | |
| 	destroy_irq(irq);
 | |
| }
 | |
| 
 | |
| int arch_setup_msi_irq(struct pci_dev *dev, struct msi_desc *desc)
 | |
| {
 | |
| 	struct msi_msg msg;
 | |
| 	struct pci_dev *lnk;
 | |
| 	int irq, ret;
 | |
| 	u16 val;
 | |
| 
 | |
| 	/* MSI not supported on XLR */
 | |
| 	if (!nlm_chip_is_xls())
 | |
| 		return 1;
 | |
| 
 | |
| 	/*
 | |
| 	 * Enable MSI on the XLS PCIe controller bridge which was disabled
 | |
| 	 * at enumeration, the bridge MSI capability is at 0x50
 | |
| 	 */
 | |
| 	lnk = xls_get_pcie_link(dev);
 | |
| 	if (lnk == NULL)
 | |
| 		return 1;
 | |
| 
 | |
| 	pci_read_config_word(lnk, 0x50 + PCI_MSI_FLAGS, &val);
 | |
| 	if ((val & PCI_MSI_FLAGS_ENABLE) == 0) {
 | |
| 		val |= PCI_MSI_FLAGS_ENABLE;
 | |
| 		pci_write_config_word(lnk, 0x50 + PCI_MSI_FLAGS, val);
 | |
| 	}
 | |
| 
 | |
| 	irq = get_irq_vector(dev);
 | |
| 	if (irq <= 0)
 | |
| 		return 1;
 | |
| 
 | |
| 	msg.address_hi = MSI_ADDR_BASE_HI;
 | |
| 	msg.address_lo = MSI_ADDR_BASE_LO   |
 | |
| 		MSI_ADDR_DEST_MODE_PHYSICAL |
 | |
| 		MSI_ADDR_REDIRECTION_CPU;
 | |
| 
 | |
| 	msg.data = MSI_DATA_TRIGGER_EDGE |
 | |
| 		MSI_DATA_LEVEL_ASSERT	 |
 | |
| 		MSI_DATA_DELIVERY_FIXED;
 | |
| 
 | |
| 	ret = irq_set_msi_desc(irq, desc);
 | |
| 	if (ret < 0) {
 | |
| 		destroy_irq(irq);
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	write_msi_msg(irq, &msg);
 | |
| 	return 0;
 | |
| }
 | |
| #endif
 | |
| 
 | |
| /* Extra ACK needed for XLR on chip PCI controller */
 | |
| static void xlr_pci_ack(struct irq_data *d)
 | |
| {
 | |
| 	uint64_t pcibase = nlm_mmio_base(NETLOGIC_IO_PCIX_OFFSET);
 | |
| 
 | |
| 	nlm_read_reg(pcibase, (0x140 >> 2));
 | |
| }
 | |
| 
 | |
| /* Extra ACK needed for XLS on chip PCIe controller */
 | |
| static void xls_pcie_ack(struct irq_data *d)
 | |
| {
 | |
| 	uint64_t pciebase_le = nlm_mmio_base(NETLOGIC_IO_PCIE_1_OFFSET);
 | |
| 
 | |
| 	switch (d->irq) {
 | |
| 	case PIC_PCIE_LINK0_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x90 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	case PIC_PCIE_LINK1_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x94 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	case PIC_PCIE_LINK2_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x190 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	case PIC_PCIE_LINK3_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x194 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| /* For XLS B silicon, the 3,4 PCI interrupts are different */
 | |
| static void xls_pcie_ack_b(struct irq_data *d)
 | |
| {
 | |
| 	uint64_t pciebase_le = nlm_mmio_base(NETLOGIC_IO_PCIE_1_OFFSET);
 | |
| 
 | |
| 	switch (d->irq) {
 | |
| 	case PIC_PCIE_LINK0_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x90 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	case PIC_PCIE_LINK1_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x94 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	case PIC_PCIE_XLSB0_LINK2_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x190 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	case PIC_PCIE_XLSB0_LINK3_IRQ:
 | |
| 		nlm_write_reg(pciebase_le, (0x194 >> 2), 0xffffffff);
 | |
| 		break;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| int __init pcibios_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
 | |
| {
 | |
| 	return get_irq_vector(dev);
 | |
| }
 | |
| 
 | |
| /* Do platform specific device initialization at pci_enable_device() time */
 | |
| int pcibios_plat_dev_init(struct pci_dev *dev)
 | |
| {
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __init pcibios_init(void)
 | |
| {
 | |
| 	void (*extra_ack)(struct irq_data *);
 | |
| 	int link, irq;
 | |
| 
 | |
| 	/* PSB assigns PCI resources */
 | |
| 	pci_set_flags(PCI_PROBE_ONLY);
 | |
| 	pci_config_base = ioremap(DEFAULT_PCI_CONFIG_BASE, 16 << 20);
 | |
| 
 | |
| 	/* Extend IO port for memory mapped io */
 | |
| 	ioport_resource.start =	 0;
 | |
| 	ioport_resource.end   = ~0;
 | |
| 
 | |
| 	set_io_port_base(CKSEG1);
 | |
| 	nlm_pci_controller.io_map_base = CKSEG1;
 | |
| 
 | |
| 	pr_info("Registering XLR/XLS PCIX/PCIE Controller.\n");
 | |
| 	register_pci_controller(&nlm_pci_controller);
 | |
| 
 | |
| 	/*
 | |
| 	 * For PCI interrupts, we need to ack the PCI controller too, overload
 | |
| 	 * irq handler data to do this
 | |
| 	 */
 | |
| 	if (!nlm_chip_is_xls()) {
 | |
| 		/* XLR PCI controller ACK */
 | |
| 		nlm_set_pic_extra_ack(0, PIC_PCIX_IRQ, xlr_pci_ack);
 | |
| 	} else {
 | |
| 		if  (nlm_chip_is_xls_b())
 | |
| 			extra_ack = xls_pcie_ack_b;
 | |
| 		else
 | |
| 			extra_ack = xls_pcie_ack;
 | |
| 		for (link = 0; link < 4; link++) {
 | |
| 			irq = nlm_pci_link_to_irq(link);
 | |
| 			nlm_set_pic_extra_ack(0, irq, extra_ack);
 | |
| 		}
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| arch_initcall(pcibios_init);
 |