X-Git-Url: http://mj.ucw.cz/gitweb/?a=blobdiff_plain;f=lib%2Fdump.c;h=69a99c82ae3a50897eb6557ac03da43d6a3335b2;hb=38190363b8577e656e92d1360c08faaf776b575c;hp=02b2ce4fe9309cfd1f001ee0fd32af2faf776cc9;hpb=098174370094ba8c31f86bd9faed3796dcaeb1db;p=pciutils.git diff --git a/lib/dump.c b/lib/dump.c index 02b2ce4..69a99c8 100644 --- a/lib/dump.c +++ b/lib/dump.c @@ -1,7 +1,7 @@ /* * The PCI Library -- Reading of Bus Dumps * - * Copyright (c) 1997--2004 Martin Mares + * Copyright (c) 1997--2008 Martin Mares * * Can be freely distributed and used under the terms of the GNU GPL. */ @@ -14,29 +14,49 @@ #include "internal.h" struct dump_data { - int len; + int len, allocated; byte data[1]; }; +static void +dump_config(struct pci_access *a) +{ + pci_define_param(a, "dump.name", "", "Name of the bus dump file to read from"); +} + static int dump_detect(struct pci_access *a) { - return !!a->method_params[PCI_ACCESS_DUMP]; + char *name = pci_get_param(a, "dump.name"); + return name && name[0]; } static void dump_alloc_data(struct pci_dev *dev, int len) { struct dump_data *dd = pci_malloc(dev->access, sizeof(struct dump_data) + len - 1); - dd->len = len; + dd->allocated = len; + dd->len = 0; memset(dd->data, 0xff, len); dev->aux = dd; } +static int +dump_validate(char *s, char *fmt) +{ + while (*fmt) + { + if (*fmt == '#' ? !isxdigit(*s) : *fmt != *s) + return 0; + fmt++, s++; + } + return 1; +} + static void dump_init(struct pci_access *a) { - char *name = a->method_params[PCI_ACCESS_DUMP]; + char *name = pci_get_param(a, "dump.name"); FILE *f; char buf[256]; struct pci_dev *dev = NULL; @@ -56,10 +76,8 @@ dump_init(struct pci_access *a) *z-- = 0; len = z - buf + 1; mn = 0; - if ((len >= 8 && buf[2] == ':' && buf[5] == '.' && buf[7] == ' ' && - sscanf(buf, "%x:%x.%d ", &bn, &dn, &fn) == 3) || - (len >= 13 && buf[4] == ':' && buf[7] == ':' && buf[10] == '.' && buf[12] == ' ' && - sscanf(buf, "%x:%x:%x.%d", &mn, &bn, &dn, &fn) == 4)) + if (dump_validate(buf, "##:##.# ") && sscanf(buf, "%x:%x.%d", &bn, &dn, &fn) == 3 || + dump_validate(buf, "####:##:##.# ") && sscanf(buf, "%x:%x:%x.%d", &mn, &bn, &dn, &fn) == 4) { dev = pci_get_dev(a, mn, bn, dn, fn); dump_alloc_data(dev, 256); @@ -68,19 +86,17 @@ dump_init(struct pci_access *a) else if (!len) dev = NULL; else if (dev && - (len >= 51 && buf[2] == ':' && buf[3] == ' ' || len >= 52 && buf[3] == ':' && buf[4] == ' ') && + (dump_validate(buf, "##: ") || dump_validate(buf, "###: ")) && sscanf(buf, "%x: ", &i) == 1) { struct dump_data *dd = dev->aux; z = strchr(buf, ' ') + 1; - while (isspace(z[0]) && isxdigit(z[1]) && isxdigit(z[2])) + while (isxdigit(z[0]) && isxdigit(z[1]) && (!z[2] || z[2] == ' ') && + sscanf(z, "%x", &j) == 1 && j < 256) { - z++; - if (sscanf(z, "%x", &j) != 1 || i >= 256) - a->error("dump: Malformed line"); if (i >= 4096) - break; - if (i > dd->len) /* Need to re-allocate the buffer */ + a->error("dump: At most 4096 bytes of config space are supported"); + if (i >= dd->allocated) /* Need to re-allocate the buffer */ { dump_alloc_data(dev, 4096); memcpy(((struct dump_data *) dev->aux)->data, dd->data, 256); @@ -88,8 +104,14 @@ dump_init(struct pci_access *a) dd = dev->aux; } dd->data[i++] = j; + if (i > dd->len) + dd->len = i; z += 2; + if (*z) + z++; } + if (*z) + a->error("dump: Malformed line"); } } } @@ -111,7 +133,7 @@ dump_read(struct pci_dev *d, int pos, byte *buf, int len) if (!(dd = d->aux)) { struct pci_dev *e = d->access->devices; - while (e && (e->bus != d->bus || e->dev != d->dev || e->func != d->func)) + while (e && (e->domain != d->domain || e->bus != d->bus || e->dev != d->dev || e->func != d->func)) e = e->next; if (!e) return 0; @@ -142,7 +164,8 @@ dump_cleanup_dev(struct pci_dev *d) struct pci_methods pm_dump = { "dump", - NULL, /* config */ + "Reading of register dumps (set the `dump.name' parameter)", + dump_config, dump_detect, dump_init, dump_cleanup,