--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/sjoy.cc	Thu Jun 02 17:51:41 2011 +0900
@@ -0,0 +1,144 @@
+// Copyright(C) 2001 Sony Computer Entertainment Inc. All Rights Reserved.
+//
+// "sjoy.c"
+//
+//
+#include <stdio.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <assert.h>
+
+
+#include "sjoy.h"
+
+#define N_JOY   2
+
+static char *g_devName[N_JOY] = {
+  "/dev/js0",
+  "/dev/js1",
+};
+
+static int g_fd[N_JOY] = {
+  -1, -1,
+};
+
+//static __u32 g_button[N_JOY];   // max 32 buttons per joystick
+//static __s16 g_axis[N_JOY][2];  // max 2 axis per joystick
+
+//----------------------------------------------------------------------
+int sjoy_open(void)
+{
+  int joy;
+        
+  sjoy_close();
+        
+  for (joy = 0; joy < N_JOY; joy++) {
+    assert(g_fd[joy] == -1);
+    g_fd[joy] = open(g_devName[joy], O_RDONLY | O_NONBLOCK);
+    if (g_fd[joy] < 0) {
+      fprintf(stderr, "can't open %s\n", g_devName[joy]);
+      fprintf(stderr,
+	      "You don't have permission, or should load module for joysticks.\n"
+	      "How to load joystick module:\n"
+	      "    # modprobe ps2pad\n");
+      return -1;
+    }
+  }
+        
+  return 0;
+}
+
+//----------------------------------------------------------------------
+int sjoy_close(void)
+{
+  int joy;
+  int fail = 0;
+        
+  for (joy = 0; joy < N_JOY; joy++) {
+    if (g_fd[joy] >= 0) {
+      fail |= close(g_fd[joy]);
+    }
+    g_fd[joy] = -1;
+  }
+        
+  return fail ? -1 : 0;
+}
+
+/* 適当に自作:miya */
+struct js_event
+{
+  int type;
+  int number;
+  int value;
+};
+
+int g_button[10];
+int g_axis[10][10];
+
+#define JS_EVENT_INIT 1
+#define JS_EVENT_BUTTON 2
+#define JS_EVENT_AXIS 3
+/* ここまで適当に自作:miya */
+
+
+//----------------------------------------------------------------------
+void sjoy_poll(void)
+{
+  int joy;
+        
+  for (joy = 0; joy < N_JOY; joy++) {
+    if (g_fd[joy] < 0) {
+      continue;
+    }
+    for (; ;) {
+      struct js_event e;
+      int n = read(g_fd[joy], &e, sizeof(e));
+      if (n != sizeof(e)) {
+	break;
+      }
+      switch (e.type & ~JS_EVENT_INIT) {
+      case JS_EVENT_BUTTON:
+	g_button[joy] &= ~(1 << e.number);
+	g_button[joy] |= (e.value << e.number);
+	break;
+                                
+      case JS_EVENT_AXIS:
+	g_axis[joy][e.number] = e.value;
+	break;
+                                
+      default:
+	assert(0);
+	break;
+      }
+    }
+  }
+
+}
+
+//----------------------------------------------------------------------
+int sjoy_get_button(int joy)
+{
+  return g_button[joy];
+}
+
+//----------------------------------------------------------------------
+int sjoy_get_axis(int joy, int axis)
+{
+  return g_axis[joy][axis];
+}
+
+//----------------------------------------------------------------------
+int sjoy_get_ps2_button(int joy)
+{
+  int w = g_button[joy];
+  int a0 = g_axis[joy][0];
+  int a1 = g_axis[joy][1];
+  int th = 0x4000;
+        
+  w |= (a0 < -th) ? SJOY_PS2_L_LEFT : 0;
+  w |= (a1 > th) ? SJOY_PS2_L_DOWN : 0;
+  w |= (a0 > th) ? SJOY_PS2_L_RIGHT : 0;
+  w |= (a1 < -th) ? SJOY_PS2_L_UP : 0;
+        
+  return w;
+}