262 lines
8.5 KiB
C
262 lines
8.5 KiB
C
/****************************************************************************
|
|
* 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 bool g_ajoy_valid; /* True: Sample data is valid */
|
|
static struct ajoy_sample_s g_ajoy_sample; /* Last sample data */
|
|
static ajoy_buttonset_t g_ajoy_buttons; /* Last buttons set */
|
|
|
|
static ajoy_handler_t g_ajoy_handler; /* "Interrupt" handler */
|
|
static void *g_ajoy_arg; /* Handler argument */
|
|
static ajoy_buttonset_t g_ajoy_pset; /* Set of press waited for */
|
|
static ajoy_buttonset_t g_ajoy_rset; /* Set of releases waited for */
|
|
|
|
/****************************************************************************
|
|
* 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 press, ajoy_buttonset_t release,
|
|
ajoy_handler_t handler, FAR void *arg)
|
|
{
|
|
g_ajoy_handler = NULL;
|
|
g_ajoy_pset = press;
|
|
g_ajoy_rset = release;
|
|
g_ajoy_arg = arg;
|
|
g_ajoy_handler = handler;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: sim_ajoy_initialize
|
|
*
|
|
* Description:
|
|
* Initialize and register the button joystick driver
|
|
*
|
|
****************************************************************************/
|
|
|
|
int sim_ajoy_initialize(void)
|
|
{
|
|
int ret;
|
|
|
|
/* 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;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: up_buttonevent
|
|
****************************************************************************/
|
|
|
|
int up_buttonevent(int x, int y, int buttons)
|
|
{
|
|
ajoy_buttonset_t changed;
|
|
ajoy_buttonset_t pressed;
|
|
ajoy_buttonset_t released;
|
|
|
|
/* 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 & 2) != 0)
|
|
{
|
|
g_ajoy_sample.as_buttons |= AJOY_BUTTON_2_BIT;
|
|
}
|
|
|
|
if ((buttons & 4) != 0)
|
|
{
|
|
g_ajoy_sample.as_buttons |= AJOY_BUTTON_3_BIT;
|
|
}
|
|
|
|
/* Sample data is valid */
|
|
|
|
g_ajoy_valid = true;
|
|
|
|
/* Is there an "interrupt" handler attached? */
|
|
|
|
if (g_ajoy_handler)
|
|
{
|
|
/* Check button presses */
|
|
|
|
changed = g_ajoy_buttons ^ g_ajoy_sample.as_buttons;
|
|
if (changed != 0)
|
|
{
|
|
pressed = changed & (AJOY_SUPPORTED & g_ajoy_pset);
|
|
released = changed & (AJOY_SUPPORTED & ~g_ajoy_rset);
|
|
if ((pressed & g_ajoy_pset) != 0 || (released & g_ajoy_rset) != 0)
|
|
{
|
|
/* Call the interrupt handler */
|
|
|
|
g_ajoy_handler(&g_ajoylower, g_ajoy_arg);
|
|
}
|
|
}
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
|
|
#endif /* CONFIG_AJOYSTICK */
|