/*
- * $Id: dump.c,v 1.1 1999/01/22 21:05:20 mj Exp $
- *
* The PCI Library -- Reading of Bus Dumps
*
- * Copyright (c) 1997--1999 Martin Mares <mj@atrey.karlin.mff.cuni.cz>
+ * Copyright (c) 1997--2005 Martin Mares <mj@ucw.cz>
*
* Can be freely distributed and used under the terms of the GNU GPL.
*/
#include "internal.h"
+struct dump_data {
+ int len, allocated;
+ byte data[1];
+};
+
static int
dump_detect(struct pci_access *a)
{
return !!a->method_params[PCI_ACCESS_DUMP];
}
+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->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)
{
FILE *f;
char buf[256];
struct pci_dev *dev = NULL;
- int len, bn, dn, fn, i, j;
+ int len, mn, bn, dn, fn, i, j;
if (!a)
a->error("dump: File name not given.");
if (z >= buf && *z == '\r')
*z-- = 0;
len = z - buf + 1;
- if (len >= 8 && buf[2] == ':' && buf[5] == '.' && buf[7] == ' ' &&
- sscanf(buf, "%x:%x.%d ", &bn, &dn, &fn) == 3)
+ mn = 0;
+ 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, bn, dn, fn);
- dev->aux = pci_malloc(a, 256);
- memset(dev->aux, 0xff, 256);
+ dev = pci_get_dev(a, mn, bn, dn, fn);
+ dump_alloc_data(dev, 256);
pci_link_dev(a, dev);
}
else if (!len)
dev = NULL;
- else if (dev && len >= 51 && buf[2] == ':' && buf[3] == ' ' &&
+ else if (dev &&
+ (dump_validate(buf, "##: ") || dump_validate(buf, "###: ")) &&
sscanf(buf, "%x: ", &i) == 1)
{
- z = buf+3;
- while (isspace(z[0]) && isxdigit(z[1]) && isxdigit(z[2]))
+ struct dump_data *dd = dev->aux;
+ z = strchr(buf, ' ') + 1;
+ 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");
- ((byte *) dev->aux)[i++] = j;
+ if (i >= 4096)
+ 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);
+ pci_mfree(dd);
+ 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");
}
}
}
static void
-dump_cleanup(struct pci_access * UNUSED a)
+dump_cleanup(struct pci_access *a UNUSED)
{
}
static void
-dump_scan(struct pci_access * UNUSED a)
+dump_scan(struct pci_access *a UNUSED)
{
}
static int
dump_read(struct pci_dev *d, int pos, byte *buf, int len)
{
- if (!d->aux)
+ struct dump_data *dd;
+ 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)
- d = e;
- else
+ if (!e)
return 0;
+ dd = e->aux;
}
- memcpy(buf, (byte *) d->aux + pos, len);
+ if (pos + len > dd->len)
+ return 0;
+ memcpy(buf, dd->data + pos, len);
return 1;
}
static int
-dump_write(struct pci_dev * UNUSED d, int UNUSED pos, byte * UNUSED buf, int UNUSED len)
+dump_write(struct pci_dev *d UNUSED, int pos UNUSED, byte *buf UNUSED, int len UNUSED)
{
d->access->error("Writing to dump files is not supported.");
return 0;