/* *	The PCI Library -- User Access * *	Copyright (c) 1997--2003 Martin Mares <mj@ucw.cz> * *	Can be freely distributed and used under the terms of the GNU GPL. */#include <stdio.h>#include <stdlib.h>#include <stdarg.h>#include <string.h>#include "internal.h"static struct pci_methods *pci_methods[PCI_ACCESS_MAX] = {  NULL,#ifdef PCI_HAVE_PM_LINUX_SYSFS  &pm_linux_sysfs,#else  NULL,#endif#ifdef PCI_HAVE_PM_LINUX_PROC  &pm_linux_proc,#else  NULL,#endif#ifdef PCI_HAVE_PM_INTEL_CONF  &pm_intel_conf1,  &pm_intel_conf2,#else  NULL,  NULL,#endif#ifdef PCI_HAVE_PM_FBSD_DEVICE  &pm_fbsd_device,#else  NULL,#endif#ifdef PCI_HAVE_PM_AIX_DEVICE  &pm_aix_device,#else  NULL,#endif#ifdef PCI_HAVE_PM_NBSD_LIBPCI  &pm_nbsd_libpci,#else  NULL,#endif#ifdef PCI_HAVE_PM_OBSD_DEVICE  &pm_obsd_device,#else  NULL,#endif#ifdef PCI_HAVE_PM_DUMP  &pm_dump,#else  NULL,#endif};struct pci_access *pci_alloc(void){  struct pci_access *a = malloc(sizeof(struct pci_access));  int i;  memset(a, 0, sizeof(*a));  pci_set_name_list_path(a, PCI_PATH_IDS_DIR "/" PCI_IDS, 0);  for(i=0; i<PCI_ACCESS_MAX; i++)    if (pci_methods[i] && pci_methods[i]->config)      pci_methods[i]->config(a);  return a;}void *pci_malloc(struct pci_access *a, int size){  void *x = malloc(size);  if (!x)    a->error("Out of memory (allocation of %d bytes failed)", size);  return x;}voidpci_mfree(void *x){  if (x)    free(x);}static voidpci_generic_error(char *msg, ...){  va_list args;  va_start(args, msg);  fputs("pcilib: ", stderr);  vfprintf(stderr, msg, args);  fputc('\n', stderr);  exit(1);}static voidpci_generic_warn(char *msg, ...){  va_list args;  va_start(args, msg);  fputs("pcilib: ", stderr);  vfprintf(stderr, msg, args);  fputc('\n', stderr);}static voidpci_generic_debug(char *msg, ...){  va_list args;  va_start(args, msg);  vfprintf(stdout, msg, args);  va_end(args);}static voidpci_null_debug(char *msg UNUSED, ...){}voidpci_init(struct pci_access *a){  if (!a->error)    a->error = pci_generic_error;  if (!a->warning)    a->warning = pci_generic_warn;  if (!a->debug)    a->debug = pci_generic_debug;  if (!a->debugging)    a->debug = pci_null_debug;  if (a->method)    {      if (a->method >= PCI_ACCESS_MAX || !pci_methods[a->method])	a->error("This access method is not supported.");      a->methods = pci_methods[a->method];    }  else    {      unsigned int i;      for(i=0; i<PCI_ACCESS_MAX; i++)	if (pci_methods[i])	  {	    a->debug("Trying method %d...", i);	    if (pci_methods[i]->detect(a))	      {		a->debug("...OK\n");		a->methods = pci_methods[i];		a->method = i;		break;	      }	    a->debug("...No.\n");	  }      if (!a->methods)	a->error("Cannot find any working access method.");    }  a->debug("Decided to use %s\n", a->methods->name);  a->methods->init(a);}voidpci_cleanup(struct pci_access *a){  struct pci_dev *d, *e;  for(d=a->devices; d; d=e)    {      e = d->next;      pci_free_dev(d);    }  if (a->methods)    a->methods->cleanup(a);  pci_free_name_list(a);  pci_set_name_list_path(a, NULL, 0);  pci_mfree(a);}voidpci_scan_bus(struct pci_access *a){  a->methods->scan(a);}struct pci_dev *pci_alloc_dev(struct pci_access *a){  struct pci_dev *d = pci_malloc(a, sizeof(struct pci_dev));  memset(d, 0, sizeof(*d));  d->access = a;  d->methods = a->methods;  d->hdrtype = -1;  if (d->methods->init_dev)    d->methods->init_dev(d);  return d;}intpci_link_dev(struct pci_access *a, struct pci_dev *d){  d->next = a->devices;  a->devices = d;  return 1;}struct pci_dev *pci_get_dev(struct pci_access *a, int domain, int bus, int dev, int func){  struct pci_dev *d = pci_alloc_dev(a);  d->domain = domain;  d->bus = bus;  d->dev = dev;  d->func = func;  return d;}void pci_free_dev(struct pci_dev *d){  if (d->methods->cleanup_dev)    d->methods->cleanup_dev(d);  pci_mfree(d);}static inline voidpci_read_data(struct pci_dev *d, void *buf, int pos, int len){  if (pos & (len-1))    d->access->error("Unaligned read: pos=%02x, len=%d", pos, len);  if (pos + len <= d->cache_len)    memcpy(buf, d->cache + pos, len);  else if (!d->methods->read(d, pos, buf, len))    memset(buf, 0xff, len);}bytepci_read_byte(struct pci_dev *d, int pos){  byte buf;  pci_read_data(d, &buf, pos, 1);  return buf;}wordpci_read_word(struct pci_dev *d, int pos){  word buf;  pci_read_data(d, &buf, pos, 2);  return le16_to_cpu(buf);}u32pci_read_long(struct pci_dev *d, int pos){  u32 buf;  pci_read_data(d, &buf, pos, 4);  return le32_to_cpu(buf);}intpci_read_block(struct pci_dev *d, int pos, byte *buf, int len){  return d->methods->read(d, pos, buf, len);}static inline intpci_write_data(struct pci_dev *d, void *buf, int pos, int len){  if (pos & (len-1))    d->access->error("Unaligned write: pos=%02x,len=%d", pos, len);  if (pos + len <= d->cache_len)    memcpy(d->cache + pos, buf, len);  return d->methods->write(d, pos, buf, len);}intpci_write_byte(struct pci_dev *d, int pos, byte data){  return pci_write_data(d, &data, pos, 1);}intpci_write_word(struct pci_dev *d, int pos, word data){  word buf = cpu_to_le16(data);  return pci_write_data(d, &buf, pos, 2);}intpci_write_long(struct pci_dev *d, int pos, u32 data){  u32 buf = cpu_to_le32(data);  return pci_write_data(d, &buf, pos, 4);}intpci_write_block(struct pci_dev *d, int pos, byte *buf, int len){  if (pos < d->cache_len)    {      int l = (pos + len >= d->cache_len) ? (d->cache_len - pos) : len;      memcpy(d->cache + pos, buf, l);    }  return d->methods->write(d, pos, buf, len);}intpci_fill_info(struct pci_dev *d, int flags){  if (flags & PCI_FILL_RESCAN)    {      flags &= ~PCI_FILL_RESCAN;      d->known_fields = 0;    }  if (flags & ~d->known_fields)    d->known_fields |= d->methods->fill_info(d, flags & ~d->known_fields);  return d->known_fields;}voidpci_setup_cache(struct pci_dev *d, byte *cache, int len){  d->cache = cache;  d->cache_len = len;}