X-Git-Url: http://mj.ucw.cz/gitweb/?a=blobdiff_plain;f=lib%2Fi386-ports.c;h=4b51c8818f097e67bbbe4e864fc82156c67e461e;hb=f548ecdbccf5effff1f6fb121bbd6a1e49659c5b;hp=ada1ee1c5accea0a475598b05413b1415c397088;hpb=8fc75dbcb77abd5bfbfc1eb109503eeff57a8a9b;p=pciutils.git diff --git a/lib/i386-ports.c b/lib/i386-ports.c index ada1ee1..4b51c88 100644 --- a/lib/i386-ports.c +++ b/lib/i386-ports.c @@ -1,36 +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. */ -#include +#define _GNU_SOURCE #include "internal.h" -#if defined(OS_LINUX) +#include + +#if defined(PCI_OS_LINUX) #include "i386-io-linux.h" -#elif defined(OS_GNU) +#elif defined(PCI_OS_GNU) #include "i386-io-hurd.h" -#elif defined(OS_SunOS) +#elif defined(PCI_OS_SUNOS) #include "i386-io-sunos.h" +#elif defined(PCI_OS_WINDOWS) +#include "i386-io-windows.h" #else #error Do not know how to access I/O ports on this OS. #endif +static int conf12_io_enabled = -1; /* -1=haven't tried, 0=failed, 1=succeeded */ + +static int +conf12_setup_io(struct pci_access *a) +{ + 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) { - intel_cleanup_io(); + if (conf12_io_enabled > 0) + conf12_io_enabled = intel_cleanup_io(a); } /* @@ -80,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; @@ -100,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) @@ -123,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) @@ -149,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; @@ -171,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; @@ -200,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);