Sylixos port

Contributed by YuJian Gong.

6 files changed, 309 insertions, 1 deletions

diff --git a/lib/configure b/lib/configure
index ff63816..1953c5a 100755
--- a/lib/configure
+++ b/lib/configure
@@ -141,6 +141,13 @@ case $sys in
 		esac
 		echo >>$c '#define PCI_HAVE_STDINT_H'
 		;;
+	sylixos)
+		echo >>$c '#define PCI_PATH_SYLIXOS_DEVICE "/proc/pci"'
+		echo >>$c '#define PCI_HAVE_64BIT_ADDRESS'
+		echo >>$c '#define PCI_HAVE_PM_SYLIXOS_DEVICE'
+		echo >>$c '#define PCI_SCAN_FUNC "PCI_SCAN_TBL"'
+		IDSDIR="/etc/pci"
+		;;
 	*)
 		echo " Unfortunately, your OS is not supported by the PCI Library"
 		exit 1
diff --git a/lib/init.c b/lib/init.c
index abd4fd8..0e8ef61 100644
--- a/lib/init.c
+++ b/lib/init.c
@@ -62,6 +62,11 @@ static struct pci_methods *pci_methods[PCI_ACCESS_MAX] = {
 #else
   NULL,
 #endif
+#ifdef PCI_HAVE_PM_SYLIXOS_DEVICE
+  &pm_sylixos_device,
+#else
+  NULL,
+#endif
 };
 
 // If PCI_ACCESS_AUTO is selected, we probe the access methods in this order
@@ -74,6 +79,7 @@ static int probe_sequence[] = {
   PCI_ACCESS_NBSD_LIBPCI,
   PCI_ACCESS_OBSD_DEVICE,
   PCI_ACCESS_DARWIN,
+  PCI_ACCESS_SYLIXOS_DEVICE,
   // Low-level methods poking the hardware directly
   PCI_ACCESS_I386_TYPE1,
   PCI_ACCESS_I386_TYPE2,
diff --git a/lib/internal.h b/lib/internal.h
index cbac2a7..09c171d 100644
--- a/lib/internal.h
+++ b/lib/internal.h
@@ -86,4 +86,4 @@ void pci_free_caps(struct pci_dev *);
 
 extern struct pci_methods pm_intel_conf1, pm_intel_conf2, pm_linux_proc,
 	pm_fbsd_device, pm_aix_device, pm_nbsd_libpci, pm_obsd_device,
-	pm_dump, pm_linux_sysfs, pm_darwin;
+	pm_dump, pm_linux_sysfs, pm_darwin, pm_sylixos_device;
diff --git a/lib/pci.h b/lib/pci.h
index 0f96101..d4d436f 100644
--- a/lib/pci.h
+++ b/lib/pci.h
@@ -41,6 +41,7 @@ enum pci_access_type {
   PCI_ACCESS_OBSD_DEVICE,		/* OpenBSD /dev/pci */
   PCI_ACCESS_DUMP,			/* Dump file */
   PCI_ACCESS_DARWIN,			/* Darwin */
+  PCI_ACCESS_SYLIXOS_DEVICE,   /* SylixOS pci */
   PCI_ACCESS_MAX
 };
 
diff --git a/lib/sylixos-device.c b/lib/sylixos-device.c
new file mode 100644
index 0000000..6bb9958
--- /dev/null
+++ b/lib/sylixos-device.c
@@ -0,0 +1,290 @@
+/*
+ *  The PCI Library -- Direct Configuration access via SylixOS Ports
+ *
+ *  Copyright (c) 2018 YuJian.Gong <gongyujian@acoinfo.com>
+ *
+ *  Can be freely distributed and used under the terms of the GNU GPL.
+ */
+
+#define _GNU_SOURCE
+#define  __SYLIXOS_KERNEL
+#define  __SYLIXOS_PCI_DRV
+#include <SylixOS.h>
+#include <stdlib.h>
+#include <string.h>
+
+#include "internal.h"
+
+#define PCI_VENDOR_ID_IS_INVALID(vendor) (((vendor) == 0xffff) || ((vendor) == 0x0000))
+
+typedef struct {
+    struct pci_access *a;
+    byte *busmap;
+    int bus;
+} pci_dev_scan;
+
+static int
+sylixos_pci_traversal (int (*function)(), void *arg, int min_bus, int max_bus)
+{
+  int bus, dev, func;
+  u8 header;
+  u16 vendor;
+
+  if (!function || (min_bus < 0) || (max_bus < 0))
+    {
+      return  (PX_ERROR);
+    }
+
+  min_bus = (min_bus > (PCI_MAX_BUS - 1)) ? (PCI_MAX_BUS - 1) : min_bus;
+  max_bus = (max_bus > (PCI_MAX_BUS - 1)) ? (PCI_MAX_BUS - 1) : max_bus;
+
+  for (bus = min_bus; bus <= max_bus; bus++)
+    {
+      for (dev = 0; dev < PCI_MAX_SLOTS; dev++)
+    {
+      for (func = 0; func < PCI_MAX_FUNCTIONS; func++)
+    {
+      pciConfigInWord(bus, dev, func, PCI_VENDOR_ID, &vendor);
+      if (PCI_VENDOR_ID_IS_INVALID(vendor))
+        {
+          if (func == 0)
+            {
+              break;
+            }
+          continue;
+        }
+
+      if (function(bus, dev, func, arg) != ERROR_NONE)
+        {
+          goto  __out;
+        }
+
+      if (func == 0)
+        {
+          pciConfigInByte(bus, dev, func, PCI_HEADER_TYPE, &header);
+          if ((header & PCI_HEADER_MULTI_FUNC) != PCI_HEADER_MULTI_FUNC)
+            {
+              break;
+            }
+        }
+    }
+    }
+    }
+
+__out:
+  return  (ERROR_NONE);
+}
+
+static int
+pci_dev_list_create (int  bus, int  dev, int  func, void *arg)
+{
+  pci_dev_scan *f = (pci_dev_scan *)arg;
+  struct pci_dev *d;
+  u32 vd;
+
+  f->busmap[bus] = 1;
+  d = pci_alloc_dev(f->a);
+  d->bus = bus;
+  d->dev = dev;
+  d->func = func;
+
+  vd = pci_read_long(d, PCI_VENDOR_ID);
+  d->vendor_id = vd & 0xffff;
+  d->device_id = vd >> 16U;
+  d->known_fields = PCI_FILL_IDENT;
+  d->hdrtype = pci_read_byte(d, PCI_HEADER_TYPE) & 0x7f;
+  pci_link_dev(f->a, d);
+
+  return  (ERROR_NONE);
+}
+
+static void
+pci_generic_scan_bus_tbl(struct pci_access *a, byte *busmap, int bus)
+{
+  pci_dev_scan    f;
+
+  f.a = a;
+  f.busmap = busmap;
+  f.bus = bus;
+
+  sylixos_pci_traversal(pci_dev_list_create, &f, bus, PCI_MAX_BUS);
+}
+
+static void
+sylixos_scan(struct pci_access *a)
+{
+  int se;
+  u8 busmap[256];
+  char *env;
+
+  memset(busmap, 0, sizeof(busmap));
+
+  env = getenv(PCI_SCAN_FUNC);
+  if (!env)
+    {
+      pci_generic_scan_bus(a, busmap, 0);
+      return;
+    }
+
+  se = atoi(env);
+  if (se)
+    {
+      pci_generic_scan_bus_tbl(a, busmap, 0);
+    }
+  else
+    {
+      pci_generic_scan_bus(a, busmap, 0);
+    }
+}
+
+static void
+sylixos_config(struct pci_access *a)
+{
+  pci_define_param(a, "sylixos.path", PCI_PATH_SYLIXOS_DEVICE, "Path to the SylixOS PCI device");
+}
+
+static int
+sylixos_detect(struct pci_access *a)
+{
+  char *name = pci_get_param(a, "sylixos.path");
+
+  if (access(name, R_OK))
+    {
+      a->warning("Cannot open %s", name);
+      return 0;
+    }
+
+  a->debug("...using %s", name);
+
+  return 1;
+}
+
+static void
+sylixos_init(struct pci_access *a)
+{
+  a->fd = -1;
+}
+
+static void
+sylixos_cleanup(struct pci_access *a)
+{
+    a->fd = -1;
+}
+
+static int
+sylixos_read(struct pci_dev *d, int pos, byte *buf, int len)
+{
+  int ret = -1;
+  u8  data_byte = -1;
+  u16 data_word = -1;
+  u32 data_dword = -1;
+
+  if (!(len == 1 || len == 2 || len == 4))
+    {
+      return pci_generic_block_read(d, pos, buf, len);
+    }
+
+  if (pos >= 256)
+    {
+      return 0;
+    }
+
+  switch (len)
+    {
+    case 1:
+      ret = pciConfigInByte(d->bus, d->dev, d->func, pos, &data_byte);
+      if (ret != ERROR_NONE)
+        {
+          return  (0);
+        }
+      buf[0] = (u8)data_byte;
+      break;
+
+    case 2:
+      ret = pciConfigInWord(d->bus, d->dev, d->func, pos, &data_word);
+      if (ret != ERROR_NONE)
+        {
+          return  (0);
+        }
+      ((u16 *) buf)[0] = cpu_to_le16(data_word);
+      break;
+
+    case 4:
+      ret = pciConfigInDword(d->bus, d->dev, d->func, pos, &data_dword);
+      if (ret != ERROR_NONE)
+        {
+          return  (0);
+        }
+      ((u32 *) buf)[0] = cpu_to_le32(data_dword);
+      break;
+    }
+
+  return 1;
+}
+
+static int
+sylixos_write(struct pci_dev *d, int pos, byte *buf, int len)
+{
+  int ret = PX_ERROR;
+  u8 data_byte;
+  u16 data_word;
+  u32 data_dword;
+
+  if (!(len == 1 || len == 2 || len == 4))
+    {
+      return pci_generic_block_write(d, pos, buf, len);
+    }
+
+  if (pos >= 256)
+    {
+      return 0;
+    }
+
+  switch (len)
+    {
+    case 1:
+      data_byte = buf[0];
+      ret = pciConfigOutByte(d->bus, d->dev, d->func, pos, data_byte);
+      if (ret != ERROR_NONE)
+        {
+          return  (0);
+        }
+      break;
+
+    case 2:
+      data_word = le16_to_cpu(((u16 *) buf)[0]);
+      ret = pciConfigOutWord(d->bus, d->dev, d->func, pos, data_word);
+      if (ret != ERROR_NONE)
+        {
+          return  (0);
+        }
+      break;
+
+    case 4:
+      data_dword = le32_to_cpu(((u32 *) buf)[0]);
+      ret = pciConfigOutDword(d->bus, d->dev, d->func, pos, data_dword);
+      if (ret != ERROR_NONE)
+        {
+          return  (0);
+        }
+      break;
+    }
+
+  return 1;
+}
+
+struct pci_methods pm_sylixos_device = {
+  "sylixos-device",
+  "SylixOS /proc/pci device",
+  sylixos_config,					                                    /* config                       */
+  sylixos_detect,
+  sylixos_init,
+  sylixos_cleanup,
+  sylixos_scan,
+  pci_generic_fill_info,
+  sylixos_read,
+  sylixos_write,
+  NULL,					                                                /* read_vpd                     */
+  NULL,					                                                /* init_dev                     */
+  NULL					                                                /* cleanup_dev                  */
+};
diff --git a/lib/sysdep.h b/lib/sysdep.h
index f3756b6..e525dc4 100644
--- a/lib/sysdep.h
+++ b/lib/sysdep.h
@@ -68,6 +68,10 @@ typedef u16 word;
 #endif
 #endif
 
+#ifdef PCI_OS_SYLIXOS
+#include <endian.h>
+#endif
+
 #ifdef PCI_OS_DJGPP
   #define BIG_ENDIAN 4321
   #define LITTLE_ENDIAN	1234