144 lines
3.4 KiB
C
144 lines
3.4 KiB
C
#include <linux/pci.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/kernel.h>
|
|
|
|
static int __init
|
|
early_read_config_word(struct pci_channel *hose,
|
|
int top_bus, int bus, int devfn, int offset, u16 *value)
|
|
{
|
|
struct pci_dev fake_dev;
|
|
struct pci_bus fake_bus;
|
|
|
|
fake_dev.bus = &fake_bus;
|
|
fake_dev.sysdata = hose;
|
|
fake_dev.devfn = devfn;
|
|
fake_bus.number = bus;
|
|
fake_bus.sysdata = hose;
|
|
fake_bus.ops = hose->pci_ops;
|
|
|
|
if (bus != top_bus)
|
|
/* Fake a parent bus structure. */
|
|
fake_bus.parent = &fake_bus;
|
|
else
|
|
fake_bus.parent = NULL;
|
|
|
|
return pci_read_config_word(&fake_dev, offset, value);
|
|
}
|
|
|
|
int __init pci_is_66mhz_capable(struct pci_channel *hose,
|
|
int top_bus, int current_bus)
|
|
{
|
|
u32 pci_devfn;
|
|
unsigned short vid;
|
|
int cap66 = -1;
|
|
u16 stat;
|
|
|
|
printk(KERN_INFO "PCI: Checking 66MHz capabilities...\n");
|
|
|
|
for (pci_devfn = 0; pci_devfn < 0xff; pci_devfn++) {
|
|
if (PCI_FUNC(pci_devfn))
|
|
continue;
|
|
if (early_read_config_word(hose, top_bus, current_bus,
|
|
pci_devfn, PCI_VENDOR_ID, &vid) !=
|
|
PCIBIOS_SUCCESSFUL)
|
|
continue;
|
|
if (vid == 0xffff)
|
|
continue;
|
|
|
|
/* check 66MHz capability */
|
|
if (cap66 < 0)
|
|
cap66 = 1;
|
|
if (cap66) {
|
|
early_read_config_word(hose, top_bus, current_bus,
|
|
pci_devfn, PCI_STATUS, &stat);
|
|
if (!(stat & PCI_STATUS_66MHZ)) {
|
|
printk(KERN_DEBUG
|
|
"PCI: %02x:%02x not 66MHz capable.\n",
|
|
current_bus, pci_devfn);
|
|
cap66 = 0;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
return cap66 > 0;
|
|
}
|
|
|
|
static void pcibios_enable_err(unsigned long __data)
|
|
{
|
|
struct pci_channel *hose = (struct pci_channel *)__data;
|
|
|
|
del_timer(&hose->err_timer);
|
|
printk(KERN_DEBUG "PCI: re-enabling error IRQ.\n");
|
|
enable_irq(hose->err_irq);
|
|
}
|
|
|
|
static void pcibios_enable_serr(unsigned long __data)
|
|
{
|
|
struct pci_channel *hose = (struct pci_channel *)__data;
|
|
|
|
del_timer(&hose->serr_timer);
|
|
printk(KERN_DEBUG "PCI: re-enabling system error IRQ.\n");
|
|
enable_irq(hose->serr_irq);
|
|
}
|
|
|
|
void pcibios_enable_timers(struct pci_channel *hose)
|
|
{
|
|
if (hose->err_irq) {
|
|
init_timer(&hose->err_timer);
|
|
hose->err_timer.data = (unsigned long)hose;
|
|
hose->err_timer.function = pcibios_enable_err;
|
|
}
|
|
|
|
if (hose->serr_irq) {
|
|
init_timer(&hose->serr_timer);
|
|
hose->serr_timer.data = (unsigned long)hose;
|
|
hose->serr_timer.function = pcibios_enable_serr;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* A simple handler for the regular PCI status errors, called from IRQ
|
|
* context.
|
|
*/
|
|
unsigned int pcibios_handle_status_errors(unsigned long addr,
|
|
unsigned int status,
|
|
struct pci_channel *hose)
|
|
{
|
|
unsigned int cmd = 0;
|
|
|
|
if (status & PCI_STATUS_REC_MASTER_ABORT) {
|
|
printk(KERN_DEBUG "PCI: master abort, pc=0x%08lx\n", addr);
|
|
cmd |= PCI_STATUS_REC_MASTER_ABORT;
|
|
}
|
|
|
|
if (status & PCI_STATUS_REC_TARGET_ABORT) {
|
|
printk(KERN_DEBUG "PCI: target abort: ");
|
|
pcibios_report_status(PCI_STATUS_REC_TARGET_ABORT |
|
|
PCI_STATUS_SIG_TARGET_ABORT |
|
|
PCI_STATUS_REC_MASTER_ABORT, 1);
|
|
printk("\n");
|
|
|
|
cmd |= PCI_STATUS_REC_TARGET_ABORT;
|
|
}
|
|
|
|
if (status & (PCI_STATUS_PARITY | PCI_STATUS_DETECTED_PARITY)) {
|
|
printk(KERN_DEBUG "PCI: parity error detected: ");
|
|
pcibios_report_status(PCI_STATUS_PARITY |
|
|
PCI_STATUS_DETECTED_PARITY, 1);
|
|
printk("\n");
|
|
|
|
cmd |= PCI_STATUS_PARITY | PCI_STATUS_DETECTED_PARITY;
|
|
|
|
/* Now back off of the IRQ for awhile */
|
|
if (hose->err_irq) {
|
|
disable_irq(hose->err_irq);
|
|
hose->err_timer.expires = jiffies + HZ;
|
|
add_timer(&hose->err_timer);
|
|
}
|
|
}
|
|
|
|
return cmd;
|
|
}
|