X-Git-Url: http://mj.ucw.cz/gitweb/?a=blobdiff_plain;f=lib%2Fi386-ports.c;h=4b51c8818f097e67bbbe4e864fc82156c67e461e;hb=f548ecdbccf5effff1f6fb121bbd6a1e49659c5b;hp=b0d05c49fb12197bab8a0a9208ea087ee3e33ca9;hpb=a832f6f13a5068c00c121bd9a01fec28587ba351;p=pciutils.git diff --git a/lib/i386-ports.c b/lib/i386-ports.c index b0d05c4..4b51c88 100644 --- a/lib/i386-ports.c +++ b/lib/i386-ports.c @@ -1,43 +1,51 @@ /* * The PCI Library -- Direct Configuration access via i386 Ports * - * Copyright (c) 1997--2003 Martin Mares + * Copyright (c) 1997--2006 Martin Mares * * Can be freely distributed and used under the terms of the GNU GPL. */ +#define _GNU_SOURCE + +#include "internal.h" + #include -#ifdef __GLIBC__ -#include +#if defined(PCI_OS_LINUX) +#include "i386-io-linux.h" +#elif defined(PCI_OS_GNU) +#include "i386-io-hurd.h" +#elif defined(PCI_OS_SUNOS) +#include "i386-io-sunos.h" +#elif defined(PCI_OS_WINDOWS) +#include "i386-io-windows.h" #else -#include +#error Do not know how to access I/O ports on this OS. #endif -#include "internal.h" - -static int intel_iopl_set = -1; +static int conf12_io_enabled = -1; /* -1=haven't tried, 0=failed, 1=succeeded */ static int -intel_setup_io(void) +conf12_setup_io(struct pci_access *a) { - if (intel_iopl_set < 0) - intel_iopl_set = (iopl(3) < 0) ? 0 : 1; - return intel_iopl_set; + if (conf12_io_enabled < 0) + conf12_io_enabled = intel_setup_io(a); + return conf12_io_enabled; } static void conf12_init(struct pci_access *a) { - if (!intel_setup_io()) - a->error("You need to be root to have access to I/O ports."); + if (!conf12_setup_io(a)) + a->error("No permission to access I/O ports (you probably have to be root)."); } static void conf12_cleanup(struct pci_access *a UNUSED) { - iopl(3); - intel_iopl_set = -1; + if (conf12_io_enabled > 0) + conf12_io_enabled = intel_cleanup_io(a); } /* @@ -87,7 +95,7 @@ conf1_detect(struct pci_access *a) unsigned int tmp; int res = 0; - if (!intel_setup_io()) + if (!conf12_setup_io(a)) { a->debug("...no I/O permission"); return 0; @@ -107,6 +115,10 @@ static int conf1_read(struct pci_dev *d, int pos, byte *buf, int len) { int addr = 0xcfc + (pos&3); + + if (pos >= 256) + return 0; + outl(0x80000000 | ((d->bus & 0xff) << 16) | (PCI_DEVFN(d->dev, d->func) << 8) | (pos&~3), 0xcf8); switch (len) @@ -130,6 +142,10 @@ static int conf1_write(struct pci_dev *d, int pos, byte *buf, int len) { int addr = 0xcfc + (pos&3); + + if (pos >= 256) + return 0; + outl(0x80000000 | ((d->bus & 0xff) << 16) | (PCI_DEVFN(d->dev, d->func) << 8) | (pos&~3), 0xcf8); switch (len) @@ -156,7 +172,7 @@ conf1_write(struct pci_dev *d, int pos, byte *buf, int len) static int conf2_detect(struct pci_access *a) { - if (!intel_setup_io()) + if (!conf12_setup_io(a)) { a->debug("...no I/O permission"); return 0; @@ -178,6 +194,9 @@ conf2_read(struct pci_dev *d, int pos, byte *buf, int len) { int addr = 0xc000 | (d->dev << 8) | pos; + if (pos >= 256) + return 0; + if (d->dev >= 16) /* conf2 supports only 16 devices per bus */ return 0; @@ -207,6 +226,9 @@ conf2_write(struct pci_dev *d, int pos, byte *buf, int len) { int addr = 0xc000 | (d->dev << 8) | pos; + if (pos >= 256) + return 0; + if (d->dev >= 16) d->access->error("conf2_write: only first 16 devices exist."); outb((d->func << 1) | 0xf0, 0xcf8);