1 files changed, 274 insertions, 0 deletions
diff --git a/nuttx/arch/sim/src/up_ajoystick.c b/nuttx/arch/sim/src/up_ajoystick.c
new file mode 100644
index 000000000..69dd149e8
--- /dev/null
+++ b/nuttx/arch/sim/src/up_ajoystick.c
@@ -0,0 +1,274 @@
+/****************************************************************************
+ * arch/sim/src/up_ajoystick.c
+ *
+ *   Copyright (C) 2014 Gregory Nutt. All rights reserved.
+ *   Author: Gregory Nutt <gnutt@nuttx.org>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ * 3. Neither the name NuttX nor the names of its contributors may be
+ *    used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ *
+ ****************************************************************************/
+
+/****************************************************************************
+ * Included Files
+ ****************************************************************************/
+
+#include <nuttx/config.h>
+
+#include <stdint.h>
+#include <string.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <debug.h>
+
+#include <nuttx/arch.h>
+#include <nuttx/input/ajoystick.h>
+
+#include "up_internal.h"
+
+#ifdef CONFIG_AJOYSTICK
+
+/****************************************************************************
+ * Pre-processor Definitions
+ ****************************************************************************/
+
+# define AJOY_SUPPORTED (AJOY_BUTTON_1_BIT | AJOY_BUTTON_2_BIT | \
+                         AJOY_BUTTON_3_BIT)
+
+/****************************************************************************
+ * Private Types
+ ****************************************************************************/
+
+/****************************************************************************
+ * Private Function Prototypes
+ ****************************************************************************/
+
+static ajoy_buttonset_t ajoy_supported(FAR const struct ajoy_lowerhalf_s *lower);
+static int ajoy_sample(FAR const struct ajoy_lowerhalf_s *lower,
+                       FAR struct ajoy_sample_s *sample);
+static ajoy_buttonset_t ajoy_buttons(FAR const struct ajoy_lowerhalf_s *lower);
+static void ajoy_enable(FAR const struct ajoy_lowerhalf_s *lower,
+                         ajoy_buttonset_t press, ajoy_buttonset_t release,
+                         ajoy_handler_t handler, FAR void *arg);
+
+/****************************************************************************
+ * Private Data
+ ****************************************************************************/
+
+/* This is the button joystick lower half driver interface */
+
+static const struct ajoy_lowerhalf_s g_ajoylower =
+{
+  .al_supported  = ajoy_supported,
+  .al_sample     = ajoy_sample,
+  .al_buttons    = ajoy_buttons,
+  .al_enable     = ajoy_enable,
+};
+
+/* Driver state data */
+
+static volatile bool g_ajoy_valid;         /* True: Sample data is valid */
+static volatile bool g_ajoy_waiting;       /* True: Waiting for button data */
+static sem_t g_ajoy_waitsem;               /* Semaphore used to support waiting */
+static struct ajoy_sample_s g_ajoy_sample; /* Last sample data */
+static ajoy_buttonset_t g_ajoy_buttons;    /* Last buttons set */
+
+/****************************************************************************
+ * Private Functions
+ ****************************************************************************/
+
+/****************************************************************************
+ * Name: ajoy_supported
+ *
+ * Description:
+ *   Return the set of buttons supported on the button joystick device
+ *
+ ****************************************************************************/
+
+static ajoy_buttonset_t ajoy_supported(FAR const struct ajoy_lowerhalf_s *lower)
+{
+  return (ajoy_buttonset_t)AJOY_SUPPORTED;
+}
+
+/****************************************************************************
+ * Name: ajoy_sample
+ *
+ * Description:
+ *   Return the current state of all button joystick buttons
+ *
+ ****************************************************************************/
+
+static int ajoy_sample(FAR const struct ajoy_lowerhalf_s *lower,
+                       FAR struct ajoy_sample_s *sample)
+{
+  memcpy(sample, &g_ajoy_sample, sizeof(struct ajoy_sample_s));
+  g_ajoy_buttons = g_ajoy_sample.as_buttons;
+  g_ajoy_valid = false;
+  return OK;
+}
+
+/****************************************************************************
+ * Name: ajoy_buttons
+ *
+ * Description:
+ *   Return the current state of button data (only)
+ *
+ ****************************************************************************/
+
+static ajoy_buttonset_t ajoy_buttons(FAR const struct ajoy_lowerhalf_s *lower)
+{
+  g_ajoy_valid   = false;
+  g_ajoy_buttons = g_ajoy_sample.as_buttons;
+  return g_ajoy_buttons;
+}
+
+/****************************************************************************
+ * Name: ajoy_enable
+ *
+ * Description:
+ *   Enable interrupts on the selected set of joystick buttons.  And empty
+ *   set will disable all interrupts.
+ *
+ ****************************************************************************/
+
+static void ajoy_enable(FAR const struct ajoy_lowerhalf_s *lower,
+                         ajoy_buttonset_t pressset, ajoy_buttonset_t releaseset,
+                         ajoy_handler_t handler, FAR void *arg)
+{
+  if (handler)
+    {
+      ajoy_buttonset_t changed;
+      ajoy_buttonset_t pressed;
+      ajoy_buttonset_t released;
+
+      g_ajoy_waiting = true;
+      while (!g_ajoy_valid)
+        {
+           (void)sem_wait(&g_ajoy_waitsem);
+
+           if (g_ajoy_valid)
+             {
+               g_ajoy_valid = false;
+               changed = g_ajoy_buttons ^ g_ajoy_sample.as_buttons;
+
+               pressed = changed & (AJOY_SUPPORTED & g_ajoy_buttons);
+               if ((pressed & pressset) != 0 )
+                 {
+                   break;
+                 }
+
+               released = changed & (AJOY_SUPPORTED & ~g_ajoy_buttons);
+               if ((released & releaseset) != 0)
+                 {
+                   break;
+                 }
+             }
+         }
+
+      g_ajoy_waiting = false;
+
+      /* Call the interrupt handler */
+
+      handler(&g_ajoylower, arg);
+    }
+}
+
+/****************************************************************************
+ * Public Functions
+ ****************************************************************************/
+
+/****************************************************************************
+ * Name: sim_ajoy_initialize
+ *
+ * Description:
+ *   Initialize and register the button joystick driver
+ *
+ ****************************************************************************/
+
+int sim_ajoy_initialize(void)
+{
+  int ret;
+
+  /* Initialize the wait semaphore */
+
+  sem_init(&g_ajoy_waitsem, 0, 0);
+
+  /* Register the joystick device as /dev/ajoy0 */
+
+  ret = ajoy_register("/dev/ajoy0", &g_ajoylower);
+  if (ret == OK)
+    {
+      /* Enable X11 event processing from the IDLE loop */
+
+      g_eventloop = 1;
+    }
+}
+
+/****************************************************************************
+ * Name: up_buttonevent
+ ****************************************************************************/
+
+int up_buttonevent(int x, int y, int buttons)
+{
+  /* Same the positional data */
+
+  g_ajoy_sample.as_x = x;
+  g_ajoy_sample.as_y = y;
+
+  /* Map X11 buttons to joystick buttons */
+
+  g_ajoy_sample.as_buttons = 0;
+  if ((buttons & 1) != 0)
+    {
+      g_ajoy_sample.as_buttons |= AJOY_BUTTON_1_BIT;
+    }
+
+  if ((buttons & 1) != 0)
+    {
+      g_ajoy_sample.as_buttons |= AJOY_BUTTON_2_BIT;
+    }
+
+  if ((buttons & 1) != 0)
+    {
+      g_ajoy_sample.as_buttons |= AJOY_BUTTON_3_BIT;
+    }
+
+  /* Sample data is valid */
+
+  g_ajoy_valid = true;
+
+  /* Is there a task waiting for joystick input? */
+
+  if (g_ajoy_waiting)
+    {
+      sem_post(&g_ajoy_waitsem);
+    }
+
+  return OK;
+}
+
+#endif /* CONFIG_AJOYSTICK */