forked from luck/tmp_suning_uos_patched
0d368cb06e
The pci_fixup_irqs() function allocates IRQs for all PCI devices present in a system; those PCI devices possibly belong to different PCI bus trees (and possibly rooted at different host bridges) and may well be enabled (ie probed and bound to a driver) by the time pci_fixup_irqs() is called when probing a given host bridge driver. Furthermore, current kernel code relying on pci_fixup_irqs() to assign legacy PCI IRQs to devices does not work at all for hotplugged devices in that the code carrying out the IRQ fixup is called at host bridge driver probe time, which just cannot take into account devices hotplugged after the system has booted. The introduction of map/swizzle function hooks in struct pci_host_bridge allows us to define per-bridge map/swizzle functions that can be used at device probe time in PCI core code to allocate IRQs for a given device (through pci_assign_irq()). Convert PCI host bridge initialization code to the pci_scan_root_bus_bridge() API (that allows to pass a struct pci_host_bridge with initialized map/swizzle pointers) and remove the pci_fixup_irqs() call from arch code. Signed-off-by: Lorenzo Pieralisi <lorenzo.pieralisi@arm.com> Signed-off-by: Bjorn Helgaas <bhelgaas@google.com> Cc: Guan Xuetao <gxt@mprc.pku.edu.cn>
386 lines
9.6 KiB
C
386 lines
9.6 KiB
C
/*
|
|
* linux/arch/unicore32/kernel/pci.c
|
|
*
|
|
* Code specific to PKUnity SoC and UniCore ISA
|
|
*
|
|
* Copyright (C) 2001-2010 GUAN Xue-tao
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* PCI bios-type initialisation for PCI machines
|
|
*
|
|
*/
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/init.h>
|
|
#include <linux/io.h>
|
|
|
|
static int debug_pci;
|
|
|
|
#define CONFIG_CMD(bus, devfn, where) \
|
|
(0x80000000 | (bus->number << 16) | (devfn << 8) | (where & ~3))
|
|
|
|
static int
|
|
puv3_read_config(struct pci_bus *bus, unsigned int devfn, int where,
|
|
int size, u32 *value)
|
|
{
|
|
writel(CONFIG_CMD(bus, devfn, where), PCICFG_ADDR);
|
|
switch (size) {
|
|
case 1:
|
|
*value = (readl(PCICFG_DATA) >> ((where & 3) * 8)) & 0xFF;
|
|
break;
|
|
case 2:
|
|
*value = (readl(PCICFG_DATA) >> ((where & 2) * 8)) & 0xFFFF;
|
|
break;
|
|
case 4:
|
|
*value = readl(PCICFG_DATA);
|
|
break;
|
|
}
|
|
return PCIBIOS_SUCCESSFUL;
|
|
}
|
|
|
|
static int
|
|
puv3_write_config(struct pci_bus *bus, unsigned int devfn, int where,
|
|
int size, u32 value)
|
|
{
|
|
writel(CONFIG_CMD(bus, devfn, where), PCICFG_ADDR);
|
|
switch (size) {
|
|
case 1:
|
|
writel((readl(PCICFG_DATA) & ~FMASK(8, (where&3)*8))
|
|
| FIELD(value, 8, (where&3)*8), PCICFG_DATA);
|
|
break;
|
|
case 2:
|
|
writel((readl(PCICFG_DATA) & ~FMASK(16, (where&2)*8))
|
|
| FIELD(value, 16, (where&2)*8), PCICFG_DATA);
|
|
break;
|
|
case 4:
|
|
writel(value, PCICFG_DATA);
|
|
break;
|
|
}
|
|
return PCIBIOS_SUCCESSFUL;
|
|
}
|
|
|
|
struct pci_ops pci_puv3_ops = {
|
|
.read = puv3_read_config,
|
|
.write = puv3_write_config,
|
|
};
|
|
|
|
void pci_puv3_preinit(void)
|
|
{
|
|
printk(KERN_DEBUG "PCI: PKUnity PCI Controller Initializing ...\n");
|
|
/* config PCI bridge base */
|
|
writel(io_v2p(PKUNITY_PCIBRI_BASE), PCICFG_BRIBASE);
|
|
|
|
writel(0, PCIBRI_AHBCTL0);
|
|
writel(io_v2p(PKUNITY_PCIBRI_BASE) | PCIBRI_BARx_MEM, PCIBRI_AHBBAR0);
|
|
writel(0xFFFF0000, PCIBRI_AHBAMR0);
|
|
writel(0, PCIBRI_AHBTAR0);
|
|
|
|
writel(PCIBRI_CTLx_AT, PCIBRI_AHBCTL1);
|
|
writel(io_v2p(PKUNITY_PCILIO_BASE) | PCIBRI_BARx_IO, PCIBRI_AHBBAR1);
|
|
writel(0xFFFF0000, PCIBRI_AHBAMR1);
|
|
writel(0x00000000, PCIBRI_AHBTAR1);
|
|
|
|
writel(PCIBRI_CTLx_PREF, PCIBRI_AHBCTL2);
|
|
writel(io_v2p(PKUNITY_PCIMEM_BASE) | PCIBRI_BARx_MEM, PCIBRI_AHBBAR2);
|
|
writel(0xF8000000, PCIBRI_AHBAMR2);
|
|
writel(0, PCIBRI_AHBTAR2);
|
|
|
|
writel(io_v2p(PKUNITY_PCIAHB_BASE) | PCIBRI_BARx_MEM, PCIBRI_BAR1);
|
|
|
|
writel(PCIBRI_CTLx_AT | PCIBRI_CTLx_PREF, PCIBRI_PCICTL0);
|
|
writel(io_v2p(PKUNITY_PCIAHB_BASE) | PCIBRI_BARx_MEM, PCIBRI_PCIBAR0);
|
|
writel(0xF8000000, PCIBRI_PCIAMR0);
|
|
writel(PKUNITY_SDRAM_BASE, PCIBRI_PCITAR0);
|
|
|
|
writel(readl(PCIBRI_CMD) | PCIBRI_CMD_IO | PCIBRI_CMD_MEM, PCIBRI_CMD);
|
|
}
|
|
|
|
static int pci_puv3_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
|
|
{
|
|
if (dev->bus->number == 0) {
|
|
#ifdef CONFIG_ARCH_FPGA /* 4 pci slots */
|
|
if (dev->devfn == 0x00)
|
|
return IRQ_PCIINTA;
|
|
else if (dev->devfn == 0x08)
|
|
return IRQ_PCIINTB;
|
|
else if (dev->devfn == 0x10)
|
|
return IRQ_PCIINTC;
|
|
else if (dev->devfn == 0x18)
|
|
return IRQ_PCIINTD;
|
|
#endif
|
|
#ifdef CONFIG_PUV3_DB0913 /* 3 pci slots */
|
|
if (dev->devfn == 0x30)
|
|
return IRQ_PCIINTB;
|
|
else if (dev->devfn == 0x60)
|
|
return IRQ_PCIINTC;
|
|
else if (dev->devfn == 0x58)
|
|
return IRQ_PCIINTD;
|
|
#endif
|
|
#if defined(CONFIG_PUV3_NB0916) || defined(CONFIG_PUV3_SMW0919)
|
|
/* only support 2 pci devices */
|
|
if (dev->devfn == 0x00)
|
|
return IRQ_PCIINTC; /* sata */
|
|
#endif
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
/*
|
|
* Only first 128MB of memory can be accessed via PCI.
|
|
* We use GFP_DMA to allocate safe buffers to do map/unmap.
|
|
* This is really ugly and we need a better way of specifying
|
|
* DMA-capable regions of memory.
|
|
*/
|
|
void __init puv3_pci_adjust_zones(unsigned long *zone_size,
|
|
unsigned long *zhole_size)
|
|
{
|
|
unsigned int sz = SZ_128M >> PAGE_SHIFT;
|
|
|
|
/*
|
|
* Only adjust if > 128M on current system
|
|
*/
|
|
if (zone_size[0] <= sz)
|
|
return;
|
|
|
|
zone_size[1] = zone_size[0] - sz;
|
|
zone_size[0] = sz;
|
|
zhole_size[1] = zhole_size[0];
|
|
zhole_size[0] = 0;
|
|
}
|
|
|
|
/*
|
|
* If the bus contains any of these devices, then we must not turn on
|
|
* parity checking of any kind.
|
|
*/
|
|
static inline int pdev_bad_for_parity(struct pci_dev *dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* pcibios_fixup_bus - Called after each bus is probed,
|
|
* but before its children are examined.
|
|
*/
|
|
void pcibios_fixup_bus(struct pci_bus *bus)
|
|
{
|
|
struct pci_dev *dev;
|
|
u16 features = PCI_COMMAND_SERR
|
|
| PCI_COMMAND_PARITY
|
|
| PCI_COMMAND_FAST_BACK;
|
|
|
|
bus->resource[0] = &ioport_resource;
|
|
bus->resource[1] = &iomem_resource;
|
|
|
|
/*
|
|
* Walk the devices on this bus, working out what we can
|
|
* and can't support.
|
|
*/
|
|
list_for_each_entry(dev, &bus->devices, bus_list) {
|
|
u16 status;
|
|
|
|
pci_read_config_word(dev, PCI_STATUS, &status);
|
|
|
|
/*
|
|
* If any device on this bus does not support fast back
|
|
* to back transfers, then the bus as a whole is not able
|
|
* to support them. Having fast back to back transfers
|
|
* on saves us one PCI cycle per transaction.
|
|
*/
|
|
if (!(status & PCI_STATUS_FAST_BACK))
|
|
features &= ~PCI_COMMAND_FAST_BACK;
|
|
|
|
if (pdev_bad_for_parity(dev))
|
|
features &= ~(PCI_COMMAND_SERR
|
|
| PCI_COMMAND_PARITY);
|
|
|
|
switch (dev->class >> 8) {
|
|
case PCI_CLASS_BRIDGE_PCI:
|
|
pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &status);
|
|
status |= PCI_BRIDGE_CTL_PARITY
|
|
| PCI_BRIDGE_CTL_MASTER_ABORT;
|
|
status &= ~(PCI_BRIDGE_CTL_BUS_RESET
|
|
| PCI_BRIDGE_CTL_FAST_BACK);
|
|
pci_write_config_word(dev, PCI_BRIDGE_CONTROL, status);
|
|
break;
|
|
|
|
case PCI_CLASS_BRIDGE_CARDBUS:
|
|
pci_read_config_word(dev, PCI_CB_BRIDGE_CONTROL,
|
|
&status);
|
|
status |= PCI_CB_BRIDGE_CTL_PARITY
|
|
| PCI_CB_BRIDGE_CTL_MASTER_ABORT;
|
|
pci_write_config_word(dev, PCI_CB_BRIDGE_CONTROL,
|
|
status);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Now walk the devices again, this time setting them up.
|
|
*/
|
|
list_for_each_entry(dev, &bus->devices, bus_list) {
|
|
u16 cmd;
|
|
|
|
pci_read_config_word(dev, PCI_COMMAND, &cmd);
|
|
cmd |= features;
|
|
pci_write_config_word(dev, PCI_COMMAND, cmd);
|
|
|
|
pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE,
|
|
L1_CACHE_BYTES >> 2);
|
|
}
|
|
|
|
/*
|
|
* Propagate the flags to the PCI bridge.
|
|
*/
|
|
if (bus->self && bus->self->hdr_type == PCI_HEADER_TYPE_BRIDGE) {
|
|
if (features & PCI_COMMAND_FAST_BACK)
|
|
bus->bridge_ctl |= PCI_BRIDGE_CTL_FAST_BACK;
|
|
if (features & PCI_COMMAND_PARITY)
|
|
bus->bridge_ctl |= PCI_BRIDGE_CTL_PARITY;
|
|
}
|
|
|
|
/*
|
|
* Report what we did for this bus
|
|
*/
|
|
printk(KERN_INFO "PCI: bus%d: Fast back to back transfers %sabled\n",
|
|
bus->number, (features & PCI_COMMAND_FAST_BACK) ? "en" : "dis");
|
|
}
|
|
EXPORT_SYMBOL(pcibios_fixup_bus);
|
|
|
|
static struct resource busn_resource = {
|
|
.name = "PCI busn",
|
|
.start = 0,
|
|
.end = 255,
|
|
.flags = IORESOURCE_BUS,
|
|
};
|
|
|
|
static int __init pci_common_init(void)
|
|
{
|
|
struct pci_bus *puv3_bus;
|
|
struct pci_host_bridge *bridge;
|
|
int ret;
|
|
|
|
bridge = pci_alloc_host_bridge(0);
|
|
if (!bridge)
|
|
return -ENOMEM;
|
|
|
|
pci_puv3_preinit();
|
|
|
|
pci_add_resource(&bridge->windows, &ioport_resource);
|
|
pci_add_resource(&bridge->windows, &iomem_resource);
|
|
pci_add_resource(&bridge->windows, &busn_resource);
|
|
bridge->sysdata = NULL;
|
|
bridge->busnr = 0;
|
|
bridge->ops = &pci_puv3_ops;
|
|
bridge->swizzle_irq = pci_common_swizzle;
|
|
bridge->map_irq = pci_puv3_map_irq;
|
|
|
|
/* Scan our single hose. */
|
|
ret = pci_scan_root_bus_bridge(bridge);
|
|
if (ret) {
|
|
pci_free_host_bridge(bridge);
|
|
return;
|
|
}
|
|
|
|
puv3_bus = bridge->bus;
|
|
|
|
if (!puv3_bus)
|
|
panic("PCI: unable to scan bus!");
|
|
|
|
pci_bus_size_bridges(puv3_bus);
|
|
pci_bus_assign_resources(puv3_bus);
|
|
pci_bus_add_devices(puv3_bus);
|
|
return 0;
|
|
}
|
|
subsys_initcall(pci_common_init);
|
|
|
|
char * __init pcibios_setup(char *str)
|
|
{
|
|
if (!strcmp(str, "debug")) {
|
|
debug_pci = 1;
|
|
return NULL;
|
|
}
|
|
return str;
|
|
}
|
|
|
|
void pcibios_set_master(struct pci_dev *dev)
|
|
{
|
|
/* No special bus mastering setup handling */
|
|
}
|
|
|
|
/*
|
|
* From arch/i386/kernel/pci-i386.c:
|
|
*
|
|
* We need to avoid collisions with `mirrored' VGA ports
|
|
* and other strange ISA hardware, so we always want the
|
|
* addresses to be allocated in the 0x000-0x0ff region
|
|
* modulo 0x400.
|
|
*
|
|
* Why? Because some silly external IO cards only decode
|
|
* the low 10 bits of the IO address. The 0x00-0xff region
|
|
* is reserved for motherboard devices that decode all 16
|
|
* bits, so it's ok to allocate at, say, 0x2800-0x28ff,
|
|
* but we want to try to avoid allocating at 0x2900-0x2bff
|
|
* which might be mirrored at 0x0100-0x03ff..
|
|
*/
|
|
resource_size_t pcibios_align_resource(void *data, const struct resource *res,
|
|
resource_size_t size, resource_size_t align)
|
|
{
|
|
resource_size_t start = res->start;
|
|
|
|
if (res->flags & IORESOURCE_IO && start & 0x300)
|
|
start = (start + 0x3ff) & ~0x3ff;
|
|
|
|
start = (start + align - 1) & ~(align - 1);
|
|
|
|
return start;
|
|
}
|
|
|
|
/**
|
|
* pcibios_enable_device - Enable I/O and memory.
|
|
* @dev: PCI device to be enabled
|
|
*/
|
|
int pcibios_enable_device(struct pci_dev *dev, int mask)
|
|
{
|
|
u16 cmd, old_cmd;
|
|
int idx;
|
|
struct resource *r;
|
|
|
|
pci_read_config_word(dev, PCI_COMMAND, &cmd);
|
|
old_cmd = cmd;
|
|
for (idx = 0; idx < 6; idx++) {
|
|
/* Only set up the requested stuff */
|
|
if (!(mask & (1 << idx)))
|
|
continue;
|
|
|
|
r = dev->resource + idx;
|
|
if (!r->start && r->end) {
|
|
printk(KERN_ERR "PCI: Device %s not available because"
|
|
" of resource collisions\n", pci_name(dev));
|
|
return -EINVAL;
|
|
}
|
|
if (r->flags & IORESOURCE_IO)
|
|
cmd |= PCI_COMMAND_IO;
|
|
if (r->flags & IORESOURCE_MEM)
|
|
cmd |= PCI_COMMAND_MEMORY;
|
|
}
|
|
|
|
/*
|
|
* Bridges (eg, cardbus bridges) need to be fully enabled
|
|
*/
|
|
if ((dev->class >> 16) == PCI_BASE_CLASS_BRIDGE)
|
|
cmd |= PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
|
|
|
|
if (cmd != old_cmd) {
|
|
printk("PCI: enabling device %s (%04x -> %04x)\n",
|
|
pci_name(dev), old_cmd, cmd);
|
|
pci_write_config_word(dev, PCI_COMMAND, cmd);
|
|
}
|
|
return 0;
|
|
}
|