drivers/xen/xen-pciback/conf_space_capability.c

   1 /*
   2  * PCI Backend - Handles the virtual fields found on the capability lists
   3  *               in the configuration space.
   4  *
   5  * Author: Ryan Wilson <hap9@epoch.ncsc.mil>
   6  */
   7
   8 #include <linux/kernel.h>
   9 #include <linux/pci.h>
  10 #include "pciback.h"
  11 #include "conf_space.h"
  12 #include "conf_space_capability.h"
  13
  14 static LIST_HEAD(capabilities);
  15
  16 static const struct config_field caplist_header[] = {
  17         {
  18          .offset    = PCI_CAP_LIST_ID,
  19          .size      = 2, /* encompass PCI_CAP_LIST_ID & PCI_CAP_LIST_NEXT */
  20          .u.w.read  = pciback_read_config_word,
  21          .u.w.write = NULL,
  22         },
  23         {}
  24 };
  25
  26 static inline void register_capability(struct pciback_config_capability *cap)
  27 {
  28         list_add_tail(&cap->cap_list, &capabilities);
  29 }
  30
  31 int pciback_config_capability_add_fields(struct pci_dev *dev)
  32 {
  33         int err = 0;
  34         struct pciback_config_capability *cap;
  35         int cap_offset;
  36
  37         list_for_each_entry(cap, &capabilities, cap_list) {
  38                 cap_offset = pci_find_capability(dev, cap->capability);
  39                 if (cap_offset) {
  40                         dev_dbg(&dev->dev, "Found capability 0x%x at 0x%x\n",
  41                                 cap->capability, cap_offset);
  42
  43                         err = pciback_config_add_fields_offset(dev,
  44                                                                caplist_header,
  45                                                                cap_offset);
  46                         if (err)
  47                                 goto out;
  48                         err = pciback_config_add_fields_offset(dev,
  49                                                                cap->fields,
  50                                                                cap_offset);
  51                         if (err)
  52                                 goto out;
  53                 }
  54         }
  55
  56 out:
  57         return err;
  58 }
  59
  60 int pciback_config_capability_init(void)
  61 {
  62         register_capability(&pciback_config_capability_vpd);
  63         register_capability(&pciback_config_capability_pm);
  64
  65         return 0;
  66 }