lib/access.c

   1 /*
   2  *      The PCI Library -- User Access
   3  *
   4  *      Copyright (c) 1997--2018 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   d->numa_node = -1;
  32   if (d->methods->init_dev)
  33     d->methods->init_dev(d);
  34   return d;
  35 }
  36
  37 int
  38 pci_link_dev(struct pci_access *a, struct pci_dev *d)
  39 {
  40   d->next = a->devices;
  41   a->devices = d;
  42
  43   /*
  44    * Applications compiled with older versions of libpci do not expect
  45    * 32-bit domain numbers. To keep them working, we keep a 16-bit
  46    * version of the domain number at the previous location in struct
  47    * pci_dev. This will keep backward compatibility on systems which
  48    * don't require large domain numbers.
  49    */
  50   if (d->domain > 0xffff)
  51     d->domain_16 = 0xffff;
  52   else
  53     d->domain_16 = d->domain;
  54
  55   return 1;
  56 }
  57
  58 struct pci_dev *
  59 pci_get_dev(struct pci_access *a, int domain, int bus, int dev, int func)
  60 {
  61   struct pci_dev *d = pci_alloc_dev(a);
  62
  63   d->domain = domain;
  64   d->bus = bus;
  65   d->dev = dev;
  66   d->func = func;
  67   return d;
  68 }
  69
  70 static void
  71 pci_free_properties(struct pci_dev *d)
  72 {
  73   struct pci_property *p;
  74
  75   while (p = d->properties)
  76     {
  77       d->properties = p->next;
  78       pci_mfree(p);
  79     }
  80 }
  81
  82 void pci_free_dev(struct pci_dev *d)
  83 {
  84   if (d->methods->cleanup_dev)
  85     d->methods->cleanup_dev(d);
  86
  87   pci_free_caps(d);
  88   pci_free_properties(d);
  89
  90   pci_mfree(d->module_alias);
  91   pci_mfree(d->label);
  92   pci_mfree(d->phy_slot);
  93
  94   pci_mfree(d);
  95 }
  96
  97 static inline void
  98 pci_read_data(struct pci_dev *d, void *buf, int pos, int len)
  99 {
 100   if (pos & (len-1))
 101     d->access->error("Unaligned read: pos=%02x, len=%d", pos, len);
 102   if (pos + len <= d->cache_len)
 103     memcpy(buf, d->cache + pos, len);
 104   else if (!d->methods->read(d, pos, buf, len))
 105     memset(buf, 0xff, len);
 106 }
 107
 108 byte
 109 pci_read_byte(struct pci_dev *d, int pos)
 110 {
 111   byte buf;
 112   pci_read_data(d, &buf, pos, 1);
 113   return buf;
 114 }
 115
 116 word
 117 pci_read_word(struct pci_dev *d, int pos)
 118 {
 119   word buf;
 120   pci_read_data(d, &buf, pos, 2);
 121   return le16_to_cpu(buf);
 122 }
 123
 124 u32
 125 pci_read_long(struct pci_dev *d, int pos)
 126 {
 127   u32 buf;
 128   pci_read_data(d, &buf, pos, 4);
 129   return le32_to_cpu(buf);
 130 }
 131
 132 int
 133 pci_read_block(struct pci_dev *d, int pos, byte *buf, int len)
 134 {
 135   return d->methods->read(d, pos, buf, len);
 136 }
 137
 138 int
 139 pci_read_vpd(struct pci_dev *d, int pos, byte *buf, int len)
 140 {
 141   return d->methods->read_vpd ? d->methods->read_vpd(d, pos, buf, len) : 0;
 142 }
 143
 144 static inline int
 145 pci_write_data(struct pci_dev *d, void *buf, int pos, int len)
 146 {
 147   if (pos & (len-1))
 148     d->access->error("Unaligned write: pos=%02x,len=%d", pos, len);
 149   if (pos + len <= d->cache_len)
 150     memcpy(d->cache + pos, buf, len);
 151   return d->methods->write(d, pos, buf, len);
 152 }
 153
 154 int
 155 pci_write_byte(struct pci_dev *d, int pos, byte data)
 156 {
 157   return pci_write_data(d, &data, pos, 1);
 158 }
 159
 160 int
 161 pci_write_word(struct pci_dev *d, int pos, word data)
 162 {
 163   word buf = cpu_to_le16(data);
 164   return pci_write_data(d, &buf, pos, 2);
 165 }
 166
 167 int
 168 pci_write_long(struct pci_dev *d, int pos, u32 data)
 169 {
 170   u32 buf = cpu_to_le32(data);
 171   return pci_write_data(d, &buf, pos, 4);
 172 }
 173
 174 int
 175 pci_write_block(struct pci_dev *d, int pos, byte *buf, int len)
 176 {
 177   if (pos < d->cache_len)
 178     {
 179       int l = (pos + len >= d->cache_len) ? (d->cache_len - pos) : len;
 180       memcpy(d->cache + pos, buf, l);
 181     }
 182   return d->methods->write(d, pos, buf, len);
 183 }
 184
 185 static void
 186 pci_reset_properties(struct pci_dev *d)
 187 {
 188   d->known_fields = 0;
 189   pci_free_caps(d);
 190   pci_free_properties(d);
 191 }
 192
 193 int
 194 pci_fill_info_v35(struct pci_dev *d, int flags)
 195 {
 196   if (flags & PCI_FILL_RESCAN)
 197     {
 198       flags &= ~PCI_FILL_RESCAN;
 199       pci_reset_properties(d);
 200     }
 201   if (flags & ~d->known_fields)
 202     d->known_fields |= d->methods->fill_info(d, flags & ~d->known_fields);
 203   return d->known_fields;
 204 }
 205
 206 /* In version 3.1, pci_fill_info got new flags => versioned alias */
 207 /* In versions 3.2, 3.3, 3.4 and 3.5, the same has happened */
 208 STATIC_ALIAS(int pci_fill_info(struct pci_dev *d, int flags), pci_fill_info_v35(d, flags));
 209 DEFINE_ALIAS(int pci_fill_info_v30(struct pci_dev *d, int flags), pci_fill_info_v35);
 210 DEFINE_ALIAS(int pci_fill_info_v31(struct pci_dev *d, int flags), pci_fill_info_v35);
 211 DEFINE_ALIAS(int pci_fill_info_v32(struct pci_dev *d, int flags), pci_fill_info_v35);
 212 DEFINE_ALIAS(int pci_fill_info_v33(struct pci_dev *d, int flags), pci_fill_info_v35);
 213 DEFINE_ALIAS(int pci_fill_info_v34(struct pci_dev *d, int flags), pci_fill_info_v35);
 214 SYMBOL_VERSION(pci_fill_info_v30, pci_fill_info@LIBPCI_3.0);
 215 SYMBOL_VERSION(pci_fill_info_v31, pci_fill_info@LIBPCI_3.1);
 216 SYMBOL_VERSION(pci_fill_info_v32, pci_fill_info@LIBPCI_3.2);
 217 SYMBOL_VERSION(pci_fill_info_v33, pci_fill_info@LIBPCI_3.3);
 218 SYMBOL_VERSION(pci_fill_info_v34, pci_fill_info@LIBPCI_3.4);
 219 SYMBOL_VERSION(pci_fill_info_v35, pci_fill_info@@LIBPCI_3.5);
 220
 221 void
 222 pci_setup_cache(struct pci_dev *d, byte *cache, int len)
 223 {
 224   d->cache = cache;
 225   d->cache_len = len;
 226 }
 227
 228 char *
 229 pci_set_property(struct pci_dev *d, u32 key, char *value)
 230 {
 231   struct pci_property *p;
 232   struct pci_property **pp = &d->properties;
 233
 234   while (p = *pp)
 235     {
 236       if (p->key == key)
 237         {
 238           *pp = p->next;
 239           pci_mfree(p);
 240         }
 241       else
 242         pp = &p->next;
 243     }
 244
 245   if (!value)
 246     return NULL;
 247
 248   p = pci_malloc(d->access, sizeof(*p) + strlen(value));
 249   *pp = p;
 250   p->next = NULL;
 251   p->key = key;
 252   strcpy(p->value, value);
 253
 254   return p->value;
 255 }
 256
 257 char *
 258 pci_get_string_property(struct pci_dev *d, u32 prop)
 259 {
 260   struct pci_property *p;
 261
 262   for (p = d->properties; p; p = p->next)
 263     if (p->key == prop)
 264       return p->value;
 265
 266   return NULL;
 267 }