Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / pci / vpd.c

diff --git a/kernel/drivers/pci/vpd.c b/kernel/drivers/pci/vpd.c
new file mode 100644 (file)
index 0000000..39b7907
--- /dev/null
+++ b/kernel/drivers/pci/vpd.c
@@ -0,0 +1,62 @@
+/*
+ * File:       vpd.c
+ * Purpose:    Provide PCI VPD support
+ *
+ * Copyright (C) 2010 Broadcom Corporation.
+ */
+
+#include <linux/pci.h>
+#include <linux/export.h>
+
+int pci_vpd_find_tag(const u8 *buf, unsigned int off, unsigned int len, u8 rdt)
+{
+       int i;
+
+       for (i = off; i < len; ) {
+               u8 val = buf[i];
+
+               if (val & PCI_VPD_LRDT) {
+                       /* Don't return success of the tag isn't complete */
+                       if (i + PCI_VPD_LRDT_TAG_SIZE > len)
+                               break;
+
+                       if (val == rdt)
+                               return i;
+
+                       i += PCI_VPD_LRDT_TAG_SIZE +
+                            pci_vpd_lrdt_size(&buf[i]);
+               } else {
+                       u8 tag = val & ~PCI_VPD_SRDT_LEN_MASK;
+
+                       if (tag == rdt)
+                               return i;
+
+                       if (tag == PCI_VPD_SRDT_END)
+                               break;
+
+                       i += PCI_VPD_SRDT_TAG_SIZE +
+                            pci_vpd_srdt_size(&buf[i]);
+               }
+       }
+
+       return -ENOENT;
+}
+EXPORT_SYMBOL_GPL(pci_vpd_find_tag);
+
+int pci_vpd_find_info_keyword(const u8 *buf, unsigned int off,
+                             unsigned int len, const char *kw)
+{
+       int i;
+
+       for (i = off; i + PCI_VPD_INFO_FLD_HDR_SIZE <= off + len;) {
+               if (buf[i + 0] == kw[0] &&
+                   buf[i + 1] == kw[1])
+                       return i;
+
+               i += PCI_VPD_INFO_FLD_HDR_SIZE +
+                    pci_vpd_info_field_size(&buf[i]);
+       }
+
+       return -ENOENT;
+}
+EXPORT_SYMBOL_GPL(pci_vpd_find_info_keyword);