lib/caps.c

   1 /*
   2  *      The PCI Library -- Capabilities
   3  *
   4  *      Copyright (c) 2008 Martin Mares <mj@ucw.cz>
   5  *
   6  *      Can be freely distributed and used under the terms of the GNU GPL.
   7  */
   8
   9 #include <string.h>
  10
  11 #include "internal.h"
  12
  13 static void
  14 pci_add_cap(struct pci_dev *d, unsigned int addr, unsigned int id, unsigned int type)
  15 {
  16   struct pci_cap *cap = pci_malloc(d->access, sizeof(*cap));
  17
  18   if (d->last_cap)
  19     d->last_cap->next = cap;
  20   else
  21     d->first_cap = cap;
  22   d->last_cap = cap;
  23   cap->next = NULL;
  24   cap->addr = addr;
  25   cap->id = id;
  26   cap->type = type;
  27   d->access->debug("%04x:%02x:%02x.%d: Found capability %04x of type %d at %04x\n",
  28     d->domain, d->bus, d->dev, d->func, id, type, addr);
  29 }
  30
  31 static void
  32 pci_scan_trad_caps(struct pci_dev *d)
  33 {
  34   word status = pci_read_word(d, PCI_STATUS);
  35   byte been_there[256];
  36   int where;
  37
  38   if (!(status & PCI_STATUS_CAP_LIST))
  39     return;
  40
  41   memset(been_there, 0, 256);
  42   where = pci_read_byte(d, PCI_CAPABILITY_LIST) & ~3;
  43   while (where)
  44     {
  45       byte id = pci_read_byte(d, where + PCI_CAP_LIST_ID);
  46       byte next = pci_read_byte(d, where + PCI_CAP_LIST_NEXT) & ~3;
  47       if (been_there[where]++)
  48         break;
  49       if (id == 0xff)
  50         break;
  51       pci_add_cap(d, where, id, PCI_CAP_NORMAL);
  52       where = next;
  53     }
  54 }
  55
  56 static void
  57 pci_scan_ext_caps(struct pci_dev *d)
  58 {
  59   byte been_there[0x1000];
  60   int where = 0x100;
  61
  62   if (!pci_find_cap(d, PCI_CAP_ID_EXP, PCI_CAP_NORMAL))
  63     return;
  64
  65   memset(been_there, 0, 0x1000);
  66   do
  67     {
  68       u32 header;
  69       int id;
  70
  71       header = pci_read_long(d, where);
  72       if (!header || header == 0xffffffff)
  73         break;
  74       id = header & 0xffff;
  75       if (been_there[where]++)
  76         break;
  77       pci_add_cap(d, where, id, PCI_CAP_EXTENDED);
  78       where = (header >> 20) & ~3;
  79     }
  80   while (where);
  81 }
  82
  83 void
  84 pci_scan_caps(struct pci_dev *d, unsigned int want_fields)
  85 {
  86   if (want_fields & PCI_FILL_EXT_CAPS)
  87     want_fields |= PCI_FILL_CAPS;
  88
  89   if (want_fill(d, want_fields, PCI_FILL_CAPS))
  90     pci_scan_trad_caps(d);
  91   if (want_fill(d, want_fields, PCI_FILL_EXT_CAPS))
  92     pci_scan_ext_caps(d);
  93 }
  94
  95 void
  96 pci_free_caps(struct pci_dev *d)
  97 {
  98   struct pci_cap *cap;
  99
 100   while (cap = d->first_cap)
 101     {
 102       d->first_cap = cap->next;
 103       pci_mfree(cap);
 104     }
 105 }
 106
 107 struct pci_cap *
 108 pci_find_cap(struct pci_dev *d, unsigned int id, unsigned int type)
 109 {
 110   return pci_find_cap_nr(d, id, type, NULL);
 111 }
 112
 113 /**
 114  * Finds a particular capability of a device
 115  *
 116  * To select one capability if there are more than one with the same id, you
 117  * can provide a pointer to an unsigned int that contains the index which you
 118  * want as cap_number. If you don't care and are fine with the first one you
 119  * can supply NULL. The cap_number will be replaced by the actual number
 120  * of capabilities with that id.
 121  */
 122 struct pci_cap *
 123 pci_find_cap_nr(struct pci_dev *d, unsigned int id, unsigned int type,
 124                 unsigned int *cap_number)
 125 {
 126   struct pci_cap *c;
 127   struct pci_cap *found = NULL;
 128   unsigned int target = (cap_number ? *cap_number : 0);
 129   unsigned int index = 0;
 130
 131   pci_fill_info_v38(d, ((type == PCI_CAP_NORMAL) ? PCI_FILL_CAPS : PCI_FILL_EXT_CAPS));
 132
 133   for (c=d->first_cap; c; c=c->next)
 134     {
 135       if (c->type == type && c->id == id)
 136         {
 137           if (target == index)
 138             found = c;
 139           index++;
 140         }
 141     }
 142
 143   if (cap_number)
 144     *cap_number = index;
 145   return found;
 146 }