72 lines
1.7 KiB
C
72 lines
1.7 KiB
C
/* $NetBSD: aapic.c,v 1.1 2003/04/26 18:39:50 fvdl Exp $ */
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <dev/pci/pcireg.h>
|
|
#include <dev/pci/pcivar.h>
|
|
#include <dev/pci/pcidevs.h>
|
|
|
|
#include <arch/amd64/pci/amd8131reg.h>
|
|
|
|
static int aapic_match __P((struct device *, struct cfdata *, void *));
|
|
static void aapic_attach __P((struct device *, struct device *, void *));
|
|
|
|
struct aapic_softc {
|
|
struct device sc_dev;
|
|
};
|
|
|
|
CFATTACH_DECL(aapic, sizeof(struct aapic_softc),
|
|
aapic_match, aapic_attach, NULL, NULL);
|
|
|
|
static int
|
|
aapic_match(parent, match, aux)
|
|
struct device *parent;
|
|
struct cfdata *match;
|
|
void *aux;
|
|
{
|
|
struct pci_attach_args *pa = aux;
|
|
|
|
if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_AMD &&
|
|
PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_AMD_PCIX8131_APIC)
|
|
return (1);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
aapic_attach(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
{
|
|
struct pci_attach_args *pa = aux;
|
|
char devinfo[256];
|
|
int bus, dev, func, rev;
|
|
pcitag_t tag;
|
|
pcireg_t reg;
|
|
|
|
pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo);
|
|
rev = PCI_REVISION(pa->pa_class);
|
|
printf(": %s (rev. 0x%02x)\n", devinfo, rev);
|
|
|
|
reg = pci_conf_read(pa->pa_pc, pa->pa_tag, AMD8131_IOAPIC_CTL);
|
|
if ((reg & AMD8131_IOAEN) == 0) {
|
|
reg |= AMD8131_IOAEN;
|
|
pci_conf_write(pa->pa_pc, pa->pa_tag, AMD8131_IOAPIC_CTL, reg);
|
|
}
|
|
|
|
/*
|
|
* Work around erratum #22 for A0 and B0 revisions.
|
|
*/
|
|
if (rev == 0x01 || rev == 0x11) {
|
|
pci_decompose_tag(pa->pa_pc, pa->pa_tag, &bus, &dev, &func);
|
|
func = 0;
|
|
tag = pci_make_tag(pa->pa_pc, bus, dev, func);
|
|
reg = pci_conf_read(pa->pa_pc, tag, AMD8131_PCIX_MISC);
|
|
reg &= ~0x00000001;
|
|
pci_conf_write(pa->pa_pc, tag, AMD8131_PCIX_MISC, reg);
|
|
}
|
|
}
|