NetBSD/sys/arch/amd64/pci/aapic.c

75 lines
1.8 KiB
C

/* $NetBSD: aapic.c,v 1.2 2003/07/14 23:32:34 lukem Exp $ */
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: aapic.c,v 1.2 2003/07/14 23:32:34 lukem 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);
}
}