lib/access.c

   1 /*
   2  *      The PCI Library -- User Access
   3  *
   4  *      Copyright (c) 1997--2013 Martin Mares <mj@ucw.cz>
   5  *
   6  *      Can be freely distributed and used under the terms of the GNU GPL.
   7  */
   8
   9 #include <stdio.h>
  10 #include <stdlib.h>
  11 #include <stdarg.h>
  12 #include <string.h>
  13
  14 #include "internal.h"
  15
  16 void
  17 pci_scan_bus(struct pci_access *a)
  18 {
  19   a->methods->scan(a);
  20 }
  21
  22 struct pci_dev *
  23 pci_alloc_dev(struct pci_access *a)
  24 {
  25   struct pci_dev *d = pci_malloc(a, sizeof(struct pci_dev));
  26
  27   memset(d, 0, sizeof(*d));
  28   d->access = a;
  29   d->methods = a->methods;
  30   d->hdrtype = -1;
  31   if (d->methods->init_dev)
  32     d->methods->init_dev(d);
  33   return d;
  34 }
  35
  36 int
  37 pci_link_dev(struct pci_access *a, struct pci_dev *d)
  38 {
  39   d->next = a->devices;
  40   a->devices = d;
  41
  42   return 1;
  43 }
  44
  45 struct pci_dev *
  46 pci_get_dev(struct pci_access *a, int domain, int bus, int dev, int func)
  47 {
  48   struct pci_dev *d = pci_alloc_dev(a);
  49
  50   d->domain = domain;
  51   d->bus = bus;
  52   d->dev = dev;
  53   d->func = func;
  54   return d;
  55 }
  56
  57 void pci_free_dev(struct pci_dev *d)
  58 {
  59   if (d->methods->cleanup_dev)
  60     d->methods->cleanup_dev(d);
  61   pci_free_caps(d);
  62   pci_mfree(d->module_alias);
  63   pci_mfree(d->label);
  64   pci_mfree(d->phy_slot);
  65   pci_mfree(d);
  66 }
  67
  68 static inline void
  69 pci_read_data(struct pci_dev *d, void *buf, int pos, int len)
  70 {
  71   if (pos & (len-1))
  72     d->access->error("Unaligned read: pos=%02x, len=%d", pos, len);
  73   if (pos + len <= d->cache_len)
  74     memcpy(buf, d->cache + pos, len);
  75   else if (!d->methods->read(d, pos, buf, len))
  76     memset(buf, 0xff, len);
  77 }
  78
  79 byte
  80 pci_read_byte(struct pci_dev *d, int pos)
  81 {
  82   byte buf;
  83   pci_read_data(d, &buf, pos, 1);
  84   return buf;
  85 }
  86
  87 word
  88 pci_read_word(struct pci_dev *d, int pos)
  89 {
  90   word buf;
  91   pci_read_data(d, &buf, pos, 2);
  92   return le16_to_cpu(buf);
  93 }
  94
  95 u32
  96 pci_read_long(struct pci_dev *d, int pos)
  97 {
  98   u32 buf;
  99   pci_read_data(d, &buf, pos, 4);
 100   return le32_to_cpu(buf);
 101 }
 102
 103 int
 104 pci_read_block(struct pci_dev *d, int pos, byte *buf, int len)
 105 {
 106   return d->methods->read(d, pos, buf, len);
 107 }
 108
 109 int
 110 pci_read_vpd(struct pci_dev *d, int pos, byte *buf, int len)
 111 {
 112   return d->methods->read_vpd ? d->methods->read_vpd(d, pos, buf, len) : 0;
 113 }
 114
 115 static inline int
 116 pci_write_data(struct pci_dev *d, void *buf, int pos, int len)
 117 {
 118   if (pos & (len-1))
 119     d->access->error("Unaligned write: pos=%02x,len=%d", pos, len);
 120   if (pos + len <= d->cache_len)
 121     memcpy(d->cache + pos, buf, len);
 122   return d->methods->write(d, pos, buf, len);
 123 }
 124
 125 int
 126 pci_write_byte(struct pci_dev *d, int pos, byte data)
 127 {
 128   return pci_write_data(d, &data, pos, 1);
 129 }
 130
 131 int
 132 pci_write_word(struct pci_dev *d, int pos, word data)
 133 {
 134   word buf = cpu_to_le16(data);
 135   return pci_write_data(d, &buf, pos, 2);
 136 }
 137
 138 int
 139 pci_write_long(struct pci_dev *d, int pos, u32 data)
 140 {
 141   u32 buf = cpu_to_le32(data);
 142   return pci_write_data(d, &buf, pos, 4);
 143 }
 144
 145 int
 146 pci_write_block(struct pci_dev *d, int pos, byte *buf, int len)
 147 {
 148   if (pos < d->cache_len)
 149     {
 150       int l = (pos + len >= d->cache_len) ? (d->cache_len - pos) : len;
 151       memcpy(d->cache + pos, buf, l);
 152     }
 153   return d->methods->write(d, pos, buf, len);
 154 }
 155
 156 int VERSIONED
 157 pci_fill_info_v32(struct pci_dev *d, int flags)
 158 {
 159   if (flags & PCI_FILL_RESCAN)
 160     {
 161       flags &= ~PCI_FILL_RESCAN;
 162       d->known_fields = 0;
 163       pci_free_caps(d);
 164     }
 165   if (flags & ~d->known_fields)
 166     d->known_fields |= d->methods->fill_info(d, flags & ~d->known_fields);
 167   return d->known_fields;
 168 }
 169
 170 /* In version 3.1, pci_fill_info got new flags => versioned alias */
 171 /* In version 3.2, the same has happened */
 172 STATIC_ALIAS(int pci_fill_info(struct pci_dev *d, int flags), pci_fill_info_v32(d, flags));
 173 DEFINE_ALIAS(int pci_fill_info_v30(struct pci_dev *d, int flags), pci_fill_info_v32);
 174 DEFINE_ALIAS(int pci_fill_info_v31(struct pci_dev *d, int flags), pci_fill_info_v32);
 175 SYMBOL_VERSION(pci_fill_info_v30, pci_fill_info@LIBPCI_3.0);
 176 SYMBOL_VERSION(pci_fill_info_v31, pci_fill_info@LIBPCI_3.1);
 177 SYMBOL_VERSION(pci_fill_info_v32, pci_fill_info@@LIBPCI_3.2);
 178
 179 void
 180 pci_setup_cache(struct pci_dev *d, byte *cache, int len)
 181 {
 182   d->cache = cache;
 183   d->cache_len = len;
 184 }