261 lines
8 KiB
C
261 lines
8 KiB
C
|
/*
|
||
|
* arch/arm/mach-ks8695/pci.c
|
||
|
*
|
||
|
* Copyright (C) 2003, Micrel Semiconductors
|
||
|
* Copyright (C) 2006, Greg Ungerer <gerg@snapgear.com>
|
||
|
* Copyright (C) 2006, Ben Dooks
|
||
|
* Copyright (C) 2007, Andrew Victor
|
||
|
*
|
||
|
* This program is free software; you can redistribute it and/or modify
|
||
|
* it under the terms of the GNU General Public License as published by
|
||
|
* the Free Software Foundation; either version 2 of the License, or
|
||
|
* (at your option) any later version.
|
||
|
*
|
||
|
* This program is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
* GNU General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License
|
||
|
* along with this program; if not, write to the Free Software
|
||
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||
|
*/
|
||
|
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/pci.h>
|
||
|
#include <linux/mm.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/irq.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/io.h>
|
||
|
|
||
|
#include <asm/signal.h>
|
||
|
#include <asm/mach/pci.h>
|
||
|
#include <mach/hardware.h>
|
||
|
|
||
|
#include "devices.h"
|
||
|
#include "regs-pci.h"
|
||
|
|
||
|
|
||
|
static int pci_dbg;
|
||
|
|
||
|
static void ks8695_pci_setupconfig(unsigned int bus_nr, unsigned int devfn, unsigned int where)
|
||
|
{
|
||
|
unsigned long pbca;
|
||
|
|
||
|
pbca = PBCA_ENABLE | (where & ~3);
|
||
|
pbca |= PCI_SLOT(devfn) << 11 ;
|
||
|
pbca |= PCI_FUNC(devfn) << 8;
|
||
|
pbca |= bus_nr << 16;
|
||
|
|
||
|
if (bus_nr == 0) {
|
||
|
/* use Type-0 transaction */
|
||
|
__raw_writel(pbca, KS8695_PCI_VA + KS8695_PBCA);
|
||
|
} else {
|
||
|
/* use Type-1 transaction */
|
||
|
__raw_writel(pbca | PBCA_TYPE1, KS8695_PCI_VA + KS8695_PBCA);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static void __iomem *ks8695_pci_map_bus(struct pci_bus *bus, unsigned int devfn,
|
||
|
int where)
|
||
|
{
|
||
|
ks8695_pci_setupconfig(bus->number, devfn, where);
|
||
|
return KS8695_PCI_VA + KS8695_PBCD;
|
||
|
}
|
||
|
|
||
|
static void ks8695_local_writeconfig(int where, u32 value)
|
||
|
{
|
||
|
ks8695_pci_setupconfig(0, 0, where);
|
||
|
__raw_writel(value, KS8695_PCI_VA + KS8695_PBCD);
|
||
|
}
|
||
|
|
||
|
static struct pci_ops ks8695_pci_ops = {
|
||
|
.map_bus = ks8695_pci_map_bus,
|
||
|
.read = pci_generic_config_read32,
|
||
|
.write = pci_generic_config_write32,
|
||
|
};
|
||
|
|
||
|
static struct resource pci_mem = {
|
||
|
.name = "PCI Memory space",
|
||
|
.start = KS8695_PCIMEM_PA,
|
||
|
.end = KS8695_PCIMEM_PA + (KS8695_PCIMEM_SIZE - 1),
|
||
|
.flags = IORESOURCE_MEM,
|
||
|
};
|
||
|
|
||
|
static struct resource pci_io = {
|
||
|
.name = "PCI IO space",
|
||
|
.start = KS8695_PCIIO_PA,
|
||
|
.end = KS8695_PCIIO_PA + (KS8695_PCIIO_SIZE - 1),
|
||
|
.flags = IORESOURCE_IO,
|
||
|
};
|
||
|
|
||
|
static int __init ks8695_pci_setup(int nr, struct pci_sys_data *sys)
|
||
|
{
|
||
|
if (nr > 0)
|
||
|
return 0;
|
||
|
|
||
|
request_resource(&iomem_resource, &pci_mem);
|
||
|
request_resource(&ioport_resource, &pci_io);
|
||
|
|
||
|
pci_add_resource_offset(&sys->resources, &pci_io, sys->io_offset);
|
||
|
pci_add_resource_offset(&sys->resources, &pci_mem, sys->mem_offset);
|
||
|
|
||
|
/* Assign and enable processor bridge */
|
||
|
ks8695_local_writeconfig(PCI_BASE_ADDRESS_0, KS8695_PCIMEM_PA);
|
||
|
|
||
|
/* Enable bus-master & Memory Space access */
|
||
|
ks8695_local_writeconfig(PCI_COMMAND, PCI_COMMAND_MASTER | PCI_COMMAND_MEMORY);
|
||
|
|
||
|
/* Set cache-line size & latency. */
|
||
|
ks8695_local_writeconfig(PCI_CACHE_LINE_SIZE, (32 << 8) | (L1_CACHE_BYTES / sizeof(u32)));
|
||
|
|
||
|
/* Reserve PCI memory space for PCI-AHB resources */
|
||
|
if (!request_mem_region(KS8695_PCIMEM_PA, SZ_64M, "PCI-AHB Bridge")) {
|
||
|
printk(KERN_ERR "Cannot allocate PCI-AHB Bridge memory.\n");
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static inline unsigned int size_mask(unsigned long size)
|
||
|
{
|
||
|
return (~size) + 1;
|
||
|
}
|
||
|
|
||
|
static int ks8695_pci_fault(unsigned long addr, unsigned int fsr, struct pt_regs *regs)
|
||
|
{
|
||
|
unsigned long pc = instruction_pointer(regs);
|
||
|
unsigned long instr = *(unsigned long *)pc;
|
||
|
unsigned long cmdstat;
|
||
|
|
||
|
cmdstat = __raw_readl(KS8695_PCI_VA + KS8695_CRCFCS);
|
||
|
|
||
|
printk(KERN_ERR "PCI abort: address = 0x%08lx fsr = 0x%03x PC = 0x%08lx LR = 0x%08lx [%s%s%s%s%s]\n",
|
||
|
addr, fsr, regs->ARM_pc, regs->ARM_lr,
|
||
|
cmdstat & (PCI_STATUS_SIG_TARGET_ABORT << 16) ? "GenTarget" : " ",
|
||
|
cmdstat & (PCI_STATUS_REC_TARGET_ABORT << 16) ? "RecvTarget" : " ",
|
||
|
cmdstat & (PCI_STATUS_REC_MASTER_ABORT << 16) ? "MasterAbort" : " ",
|
||
|
cmdstat & (PCI_STATUS_SIG_SYSTEM_ERROR << 16) ? "SysError" : " ",
|
||
|
cmdstat & (PCI_STATUS_DETECTED_PARITY << 16) ? "Parity" : " "
|
||
|
);
|
||
|
|
||
|
__raw_writel(cmdstat, KS8695_PCI_VA + KS8695_CRCFCS);
|
||
|
|
||
|
/*
|
||
|
* If the instruction being executed was a read,
|
||
|
* make it look like it read all-ones.
|
||
|
*/
|
||
|
if ((instr & 0x0c100000) == 0x04100000) {
|
||
|
int reg = (instr >> 12) & 15;
|
||
|
unsigned long val;
|
||
|
|
||
|
if (instr & 0x00400000)
|
||
|
val = 255;
|
||
|
else
|
||
|
val = -1;
|
||
|
|
||
|
regs->uregs[reg] = val;
|
||
|
regs->ARM_pc += 4;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if ((instr & 0x0e100090) == 0x00100090) {
|
||
|
int reg = (instr >> 12) & 15;
|
||
|
|
||
|
regs->uregs[reg] = -1;
|
||
|
regs->ARM_pc += 4;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static void __init ks8695_pci_preinit(void)
|
||
|
{
|
||
|
/* make software reset to avoid freeze if PCI bus was messed up */
|
||
|
__raw_writel(0x80000000, KS8695_PCI_VA + KS8695_PBCS);
|
||
|
|
||
|
/* stage 1 initialization, subid, subdevice = 0x0001 */
|
||
|
__raw_writel(0x00010001, KS8695_PCI_VA + KS8695_CRCSID);
|
||
|
|
||
|
/* stage 2 initialization */
|
||
|
/* prefetch limits with 16 words, retry enable */
|
||
|
__raw_writel(0x40000000, KS8695_PCI_VA + KS8695_PBCS);
|
||
|
|
||
|
/* configure memory mapping */
|
||
|
__raw_writel(KS8695_PCIMEM_PA, KS8695_PCI_VA + KS8695_PMBA);
|
||
|
__raw_writel(size_mask(KS8695_PCIMEM_SIZE), KS8695_PCI_VA + KS8695_PMBAM);
|
||
|
__raw_writel(KS8695_PCIMEM_PA, KS8695_PCI_VA + KS8695_PMBAT);
|
||
|
__raw_writel(0, KS8695_PCI_VA + KS8695_PMBAC);
|
||
|
|
||
|
/* configure IO mapping */
|
||
|
__raw_writel(KS8695_PCIIO_PA, KS8695_PCI_VA + KS8695_PIOBA);
|
||
|
__raw_writel(size_mask(KS8695_PCIIO_SIZE), KS8695_PCI_VA + KS8695_PIOBAM);
|
||
|
__raw_writel(KS8695_PCIIO_PA, KS8695_PCI_VA + KS8695_PIOBAT);
|
||
|
__raw_writel(0, KS8695_PCI_VA + KS8695_PIOBAC);
|
||
|
|
||
|
/* hook in fault handlers */
|
||
|
hook_fault_code(8, ks8695_pci_fault, SIGBUS, 0, "external abort on non-linefetch");
|
||
|
hook_fault_code(10, ks8695_pci_fault, SIGBUS, 0, "external abort on non-linefetch");
|
||
|
}
|
||
|
|
||
|
static void ks8695_show_pciregs(void)
|
||
|
{
|
||
|
if (!pci_dbg)
|
||
|
return;
|
||
|
|
||
|
printk(KERN_INFO "PCI: CRCFID = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_CRCFID));
|
||
|
printk(KERN_INFO "PCI: CRCFCS = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_CRCFCS));
|
||
|
printk(KERN_INFO "PCI: CRCFRV = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_CRCFRV));
|
||
|
printk(KERN_INFO "PCI: CRCFLT = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_CRCFLT));
|
||
|
printk(KERN_INFO "PCI: CRCBMA = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_CRCBMA));
|
||
|
printk(KERN_INFO "PCI: CRCSID = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_CRCSID));
|
||
|
printk(KERN_INFO "PCI: CRCFIT = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_CRCFIT));
|
||
|
|
||
|
printk(KERN_INFO "PCI: PBM = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PBM));
|
||
|
printk(KERN_INFO "PCI: PBCS = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PBCS));
|
||
|
|
||
|
printk(KERN_INFO "PCI: PMBA = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PMBA));
|
||
|
printk(KERN_INFO "PCI: PMBAC = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PMBAC));
|
||
|
printk(KERN_INFO "PCI: PMBAM = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PMBAM));
|
||
|
printk(KERN_INFO "PCI: PMBAT = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PMBAT));
|
||
|
|
||
|
printk(KERN_INFO "PCI: PIOBA = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PIOBA));
|
||
|
printk(KERN_INFO "PCI: PIOBAC = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PIOBAC));
|
||
|
printk(KERN_INFO "PCI: PIOBAM = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PIOBAM));
|
||
|
printk(KERN_INFO "PCI: PIOBAT = %08x\n", __raw_readl(KS8695_PCI_VA + KS8695_PIOBAT));
|
||
|
}
|
||
|
|
||
|
|
||
|
static struct hw_pci ks8695_pci __initdata = {
|
||
|
.nr_controllers = 1,
|
||
|
.ops = &ks8695_pci_ops,
|
||
|
.preinit = ks8695_pci_preinit,
|
||
|
.setup = ks8695_pci_setup,
|
||
|
.postinit = NULL,
|
||
|
.map_irq = NULL,
|
||
|
};
|
||
|
|
||
|
void __init ks8695_init_pci(struct ks8695_pci_cfg *cfg)
|
||
|
{
|
||
|
if (__raw_readl(KS8695_PCI_VA + KS8695_CRCFRV) & CFRV_GUEST) {
|
||
|
printk("PCI: KS8695 in guest mode, not initialising\n");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
pcibios_min_io = 0;
|
||
|
pcibios_min_mem = 0;
|
||
|
|
||
|
printk(KERN_INFO "PCI: Initialising\n");
|
||
|
ks8695_show_pciregs();
|
||
|
|
||
|
/* set Mode */
|
||
|
__raw_writel(cfg->mode << 29, KS8695_PCI_VA + KS8695_PBM);
|
||
|
|
||
|
ks8695_pci.map_irq = cfg->map_irq; /* board-specific map_irq method */
|
||
|
|
||
|
pci_common_init(&ks8695_pci);
|
||
|
}
|