/* *	The PCI Library -- Reading of Bus Dumps * *	Copyright (c) 1997--2005 Martin Mares <mj@ucw.cz> * *	Can be freely distributed and used under the terms of the GNU GPL. */#include <stdio.h>#include <ctype.h>#include <string.h>#include <errno.h>#include "internal.h"struct dump_data {  int len, allocated;  byte data[1];};static intdump_detect(struct pci_access *a){  return !!a->method_params[PCI_ACCESS_DUMP];}static voiddump_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 intdump_validate(char *s, char *fmt){  while (*fmt)    {      if (*fmt == '#' ? !isxdigit(*s) : *fmt != *s)	return 0;      *fmt++, *s++;    }  return 1;}static voiddump_init(struct pci_access *a){  char *name = a->method_params[PCI_ACCESS_DUMP];  FILE *f;  char buf[256];  struct pci_dev *dev = NULL;  int len, mn, bn, dn, fn, i, j;  if (!a)    a->error("dump: File name not given.");  if (!(f = fopen(name, "r")))    a->error("dump: Cannot open %s: %s", name, strerror(errno));  while (fgets(buf, sizeof(buf)-1, f))    {      char *z = strchr(buf, '\n');      if (!z)	a->error("dump: line too long or unterminated");      *z-- = 0;      if (z >= buf && *z == '\r')	*z-- = 0;      len = z - buf + 1;      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, mn, bn, dn, fn);	  dump_alloc_data(dev, 256);	  pci_link_dev(a, dev);	}      else if (!len)	dev = NULL;      else if (dev &&	       (dump_validate(buf, "##: ") || dump_validate(buf, "###: ")) &&	       sscanf(buf, "%x: ", &i) == 1)	{	  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)	    {	      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 voiddump_cleanup(struct pci_access *a UNUSED){}static voiddump_scan(struct pci_access *a UNUSED){}static intdump_read(struct pci_dev *d, int pos, byte *buf, int len){  struct dump_data *dd;  if (!(dd = d->aux))    {      struct pci_dev *e = d->access->devices;      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;      dd = e->aux;    }  if (pos + len > dd->len)    return 0;  memcpy(buf, dd->data + pos, len);  return 1;}static intdump_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;}static voiddump_cleanup_dev(struct pci_dev *d){  if (d->aux)    {      pci_mfree(d->aux);      d->aux = NULL;    }}struct pci_methods pm_dump = {  "dump",  NULL,					/* config */  dump_detect,  dump_init,  dump_cleanup,  dump_scan,  pci_generic_fill_info,  dump_read,  dump_write,  NULL,					/* init_dev */  dump_cleanup_dev};