fish

1 files changed, 130 insertions, 0 deletions

diff --git a/input.c b/input.c
new file mode 100644
index 0000000..bb1d82d
--- /dev/null
+++ b/input.c
@@ -0,0 +1,130 @@
+#include "project.h"
+
+input_dev_t *input_devs = NULL;
+
+
+static void
+set_nonblocking (int fd)
+{
+  long arg = 0;
+  arg = fcntl (fd, F_GETFL, arg);
+  arg |= O_NONBLOCK;
+  fcntl (fd, F_SETFL, arg);
+}
+
+static char *
+input_dev_name (int i)
+{
+  static char fn[1024];
+  sprintf (fn, "/dev/input/event%d", i);
+  return fn;
+}
+
+static input_dev_t *
+get_input_dev (int id)
+{
+  input_dev_t *ret;
+  int fd;
+  unsigned short ids[4];
+  char *fn;
+
+  for (ret = input_devs; ret; ret = ret->next)
+    if (ret->id == id)
+      return ret;
+
+
+  fn = input_dev_name (id);
+
+  fd = open (fn, O_RDWR);
+  if (fd < 0)
+    return NULL;
+
+  set_nonblocking (fd);
+
+  ret = malloc (sizeof (*ret));
+  bzero (ret, sizeof (*ret));
+
+  ret->id = id;
+  ret->fd = fd;
+
+  ioctl (fd, EVIOCGID, ids);
+
+  if ((ids[ID_VENDOR] == 0xea0) && (ids[ID_PRODUCT] == 0x2211))
+    ret->blacklistid = 1;
+
+  printf
+    ("New input device %s (%d) bus 0x%x vendor 0x%x product 0x%x version 0x%x\n",
+     fn, id, ids[ID_BUS], ids[ID_VENDOR], ids[ID_PRODUCT], ids[ID_VERSION]);
+
+  ret->next = input_devs;
+  input_devs = ret;
+
+  return ret;
+}
+
+static void
+free_input_dev (input_dev_t * d)
+{
+  printf ("Removid input device %s (%d)\n", input_dev_name (d->id), d->id);
+
+  if (d->fd > -1)
+    close (d->fd);
+  free (d);
+}
+
+
+void
+scan_input_devs (void)
+{
+  DIR *dir = opendir ("/dev/input");
+  struct dirent *de;
+  int i;
+  input_dev_t *id, **idp;
+  int version;
+
+
+  for (idp = &input_devs; (id = *idp);)
+    {
+      id->present = 0;
+      if (access (input_dev_name (id->id), F_OK)
+          || ioctl (id->fd, EVIOCGVERSION, &version))
+        {
+          *idp = id->next;
+          free_input_dev (id);
+        }
+      else
+        {
+          idp = &id->next;
+        }
+    }
+
+  if (dir)
+    {
+      while ((de = readdir (dir)))
+        {
+          if (!strcmp (de->d_name, "event"))
+            continue;
+          i = atoi (de->d_name + 5);
+          id = get_input_dev (i);
+          if (id)
+            id->present = 1;
+        }
+      closedir (dir);
+    }
+
+
+  for (idp = &input_devs; (id = *idp);)
+    {
+      if (!id->present)
+        {
+          *idp = id->next;
+          free_input_dev (id);
+        }
+      else
+        {
+          idp = &id->next;
+        }
+    }
+
+
+}