Splitting the platform-specific joystick "Raw Read" code into its own functions
git-svn-id: https://svn.code.sf.net/p/freeglut/code/trunk@1023 7f0cb862-5218-0410-a997-914c9d46530a
This commit is contained in:
fayjf
parent
74bd5d3da6
commit
8ab31e17c0
@ -388,6 +388,7 @@ static void fghJoystickAddHatElement ( SFG_Joystick* joy, CFDictionaryRef hat );
|
|||||||
|
|
||||||
|
|
||||||
/* External function declarations (mostly platform-specific) */
|
/* External function declarations (mostly platform-specific) */
|
||||||
|
extern void fgPlatformJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes );
|
||||||
extern void fgPlatformJoystickOpen( SFG_Joystick* joy );
|
extern void fgPlatformJoystickOpen( SFG_Joystick* joy );
|
||||||
extern void fgPlatformJoystickInit( SFG_Joystick *fgJoystick[], int ident );
|
extern void fgPlatformJoystickInit( SFG_Joystick *fgJoystick[], int ident );
|
||||||
extern void fgPlatformJoystickClose ( int ident );
|
extern void fgPlatformJoystickClose ( int ident );
|
||||||
@ -403,16 +404,6 @@ static SFG_Joystick *fgJoystick [ MAX_NUM_JOYSTICKS ];
|
|||||||
*/
|
*/
|
||||||
static void fghJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes )
|
static void fghJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes )
|
||||||
{
|
{
|
||||||
#if TARGET_HOST_MS_WINDOWS && !defined(_WIN32_WCE)
|
|
||||||
MMRESULT status;
|
|
||||||
#else
|
|
||||||
int status;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__NetBSD__)
|
|
||||||
int len;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
/* Defaults */
|
/* Defaults */
|
||||||
@ -426,291 +417,7 @@ static void fghJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes )
|
|||||||
if( joy->error )
|
if( joy->error )
|
||||||
return;
|
return;
|
||||||
|
|
||||||
#if TARGET_HOST_MACINTOSH
|
fgPlatformJoystickRawRead ( joy, buttons, axes );
|
||||||
if ( buttons )
|
|
||||||
{
|
|
||||||
*buttons = 0;
|
|
||||||
|
|
||||||
for ( i = 0; i < joy->num_buttons; i++ )
|
|
||||||
{
|
|
||||||
UInt32 state;
|
|
||||||
int err = ISpElement_GetSimpleState ( isp_elem [ i + isp_num_axis ], &state);
|
|
||||||
ISP_CHECK_ERR(err)
|
|
||||||
|
|
||||||
*buttons |= state << i;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( axes )
|
|
||||||
{
|
|
||||||
for ( i = 0; i < joy->num_axes; i++ )
|
|
||||||
{
|
|
||||||
UInt32 state;
|
|
||||||
int err = ISpElement_GetSimpleState ( isp_elem [ i ], &state );
|
|
||||||
ISP_CHECK_ERR(err)
|
|
||||||
|
|
||||||
axes [i] = (float) state;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if TARGET_HOST_MAC_OSX
|
|
||||||
if ( buttons != NULL )
|
|
||||||
{
|
|
||||||
*buttons = 0;
|
|
||||||
|
|
||||||
for ( i = 0; i < joy->num_buttons; i++ )
|
|
||||||
{
|
|
||||||
IOHIDEventStruct hidEvent;
|
|
||||||
(*(joy->hidDev))->getElementValue ( joy->hidDev, buttonCookies[i], &hidEvent );
|
|
||||||
if ( hidEvent.value )
|
|
||||||
*buttons |= 1 << i;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( axes != NULL )
|
|
||||||
{
|
|
||||||
for ( i = 0; i < joy->num_axes; i++ )
|
|
||||||
{
|
|
||||||
IOHIDEventStruct hidEvent;
|
|
||||||
(*(joy->hidDev))->getElementValue ( joy->hidDev, axisCookies[i], &hidEvent );
|
|
||||||
axes[i] = hidEvent.value;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if TARGET_HOST_MS_WINDOWS && !defined(_WIN32_WCE)
|
|
||||||
status = joyGetPosEx( joy->js_id, &joy->js );
|
|
||||||
|
|
||||||
if ( status != JOYERR_NOERROR )
|
|
||||||
{
|
|
||||||
joy->error = GL_TRUE;
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( buttons )
|
|
||||||
*buttons = joy->js.dwButtons;
|
|
||||||
|
|
||||||
if ( axes )
|
|
||||||
{
|
|
||||||
/*
|
|
||||||
* WARNING - Fall through case clauses!!
|
|
||||||
*/
|
|
||||||
switch ( joy->num_axes )
|
|
||||||
{
|
|
||||||
case 8:
|
|
||||||
/* Generate two POV axes from the POV hat angle.
|
|
||||||
* Low 16 bits of js.dwPOV gives heading (clockwise from ahead) in
|
|
||||||
* hundredths of a degree, or 0xFFFF when idle.
|
|
||||||
*/
|
|
||||||
if ( ( joy->js.dwPOV & 0xFFFF ) == 0xFFFF )
|
|
||||||
{
|
|
||||||
axes [ 6 ] = 0.0;
|
|
||||||
axes [ 7 ] = 0.0;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
/* This is the contentious bit: how to convert angle to X/Y.
|
|
||||||
* wk: I know of no define for PI that we could use here:
|
|
||||||
* SG_PI would pull in sg, M_PI is undefined for MSVC
|
|
||||||
* But the accuracy of the value of PI is very unimportant at
|
|
||||||
* this point.
|
|
||||||
*/
|
|
||||||
float s = (float) sin ( ( joy->js.dwPOV & 0xFFFF ) * ( 0.01 * 3.1415926535f / 180.0f ) );
|
|
||||||
float c = (float) cos ( ( joy->js.dwPOV & 0xFFFF ) * ( 0.01 * 3.1415926535f / 180.0f ) );
|
|
||||||
|
|
||||||
/* Convert to coordinates on a square so that North-East
|
|
||||||
* is (1,1) not (.7,.7), etc.
|
|
||||||
* s and c cannot both be zero so we won't divide by zero.
|
|
||||||
*/
|
|
||||||
if ( fabs ( s ) < fabs ( c ) )
|
|
||||||
{
|
|
||||||
axes [ 6 ] = ( c < 0.0 ) ? -s/c : s/c ;
|
|
||||||
axes [ 7 ] = ( c < 0.0 ) ? -1.0f : 1.0f;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
axes [ 6 ] = ( s < 0.0 ) ? -1.0f : 1.0f;
|
|
||||||
axes [ 7 ] = ( s < 0.0 ) ? -c/s : c/s ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
case 6: axes[5] = (float) joy->js.dwVpos;
|
|
||||||
case 5: axes[4] = (float) joy->js.dwUpos;
|
|
||||||
case 4: axes[3] = (float) joy->js.dwRpos;
|
|
||||||
case 3: axes[2] = (float) joy->js.dwZpos;
|
|
||||||
case 2: axes[1] = (float) joy->js.dwYpos;
|
|
||||||
case 1: axes[0] = (float) joy->js.dwXpos;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if TARGET_HOST_POSIX_X11
|
|
||||||
# if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__NetBSD__)
|
|
||||||
if ( joy->os->is_analog )
|
|
||||||
{
|
|
||||||
int status = read ( joy->os->fd, &joy->os->ajs, sizeof(joy->os->ajs) );
|
|
||||||
if ( status != sizeof(joy->os->ajs) ) {
|
|
||||||
perror ( joy->os->fname );
|
|
||||||
joy->error = GL_TRUE;
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
if ( buttons != NULL )
|
|
||||||
*buttons = ( joy->os->ajs.b1 ? 1 : 0 ) | ( joy->os->ajs.b2 ? 2 : 0 );
|
|
||||||
|
|
||||||
if ( axes != NULL )
|
|
||||||
{
|
|
||||||
axes[0] = (float) joy->os->ajs.x;
|
|
||||||
axes[1] = (float) joy->os->ajs.y;
|
|
||||||
}
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
# ifdef HAVE_USB_JS
|
|
||||||
while ( ( len = read ( joy->os->fd, joy->os->hid_data_buf, joy->os->hid_dlen ) ) == joy->os->hid_dlen )
|
|
||||||
{
|
|
||||||
struct hid_item *h;
|
|
||||||
|
|
||||||
for ( h = joy->os->hids; h; h = h->next )
|
|
||||||
{
|
|
||||||
int d = hid_get_data ( joy->os->hid_data_buf, h );
|
|
||||||
|
|
||||||
int page = HID_PAGE ( h->usage );
|
|
||||||
int usage = HID_USAGE ( h->usage );
|
|
||||||
|
|
||||||
if ( page == HUP_GENERIC_DESKTOP )
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
for ( i = 0; i < joy->num_axes; i++ )
|
|
||||||
if (joy->os->axes_usage[i] == usage)
|
|
||||||
{
|
|
||||||
if (usage == HUG_HAT_SWITCH)
|
|
||||||
{
|
|
||||||
if (d < 0 || d > 8)
|
|
||||||
d = 0; /* safety */
|
|
||||||
joy->os->cache_axes[i] = (float)hatmap_x[d];
|
|
||||||
joy->os->cache_axes[i + 1] = (float)hatmap_y[d];
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
joy->os->cache_axes[i] = (float)d;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
else if (page == HUP_BUTTON)
|
|
||||||
{
|
|
||||||
if (usage > 0 && usage < _JS_MAX_BUTTONS + 1)
|
|
||||||
{
|
|
||||||
if (d)
|
|
||||||
joy->os->cache_buttons |= (1 << ( usage - 1 ));
|
|
||||||
else
|
|
||||||
joy->os->cache_buttons &= ~(1 << ( usage - 1 ));
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#ifdef HAVE_ERRNO_H
|
|
||||||
if ( len < 0 && errno != EAGAIN )
|
|
||||||
#else
|
|
||||||
if ( len < 0 )
|
|
||||||
#endif
|
|
||||||
{
|
|
||||||
perror( joy->os->fname );
|
|
||||||
joy->error = 1;
|
|
||||||
}
|
|
||||||
if ( buttons != NULL ) *buttons = joy->os->cache_buttons;
|
|
||||||
if ( axes != NULL )
|
|
||||||
memcpy ( axes, joy->os->cache_axes, sizeof(float) * joy->num_axes );
|
|
||||||
# endif
|
|
||||||
# endif
|
|
||||||
|
|
||||||
# ifdef JS_NEW
|
|
||||||
|
|
||||||
while ( 1 )
|
|
||||||
{
|
|
||||||
status = read ( joy->fd, &joy->js, sizeof(struct js_event) );
|
|
||||||
|
|
||||||
if ( status != sizeof( struct js_event ) )
|
|
||||||
{
|
|
||||||
#ifdef HAVE_ERRNO_H
|
|
||||||
if ( errno == EAGAIN )
|
|
||||||
{
|
|
||||||
/* Use the old values */
|
|
||||||
if ( buttons )
|
|
||||||
*buttons = joy->tmp_buttons;
|
|
||||||
if ( axes )
|
|
||||||
memcpy( axes, joy->tmp_axes,
|
|
||||||
sizeof( float ) * joy->num_axes );
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
fgWarning ( "%s", joy->fname );
|
|
||||||
joy->error = GL_TRUE;
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
switch ( joy->js.type & ~JS_EVENT_INIT )
|
|
||||||
{
|
|
||||||
case JS_EVENT_BUTTON:
|
|
||||||
if( joy->js.value == 0 ) /* clear the flag */
|
|
||||||
joy->tmp_buttons &= ~( 1 << joy->js.number );
|
|
||||||
else
|
|
||||||
joy->tmp_buttons |= ( 1 << joy->js.number );
|
|
||||||
break;
|
|
||||||
|
|
||||||
case JS_EVENT_AXIS:
|
|
||||||
if ( joy->js.number < joy->num_axes )
|
|
||||||
{
|
|
||||||
joy->tmp_axes[ joy->js.number ] = ( float )joy->js.value;
|
|
||||||
|
|
||||||
if( axes )
|
|
||||||
memcpy( axes, joy->tmp_axes, sizeof(float) * joy->num_axes );
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
fgWarning ( "PLIB_JS: Unrecognised /dev/js return!?!" );
|
|
||||||
|
|
||||||
/* use the old values */
|
|
||||||
|
|
||||||
if ( buttons != NULL ) *buttons = joy->tmp_buttons;
|
|
||||||
if ( axes != NULL )
|
|
||||||
memcpy ( axes, joy->tmp_axes, sizeof(float) * joy->num_axes );
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
if( buttons )
|
|
||||||
*buttons = joy->tmp_buttons;
|
|
||||||
}
|
|
||||||
# else
|
|
||||||
|
|
||||||
status = read( joy->fd, &joy->js, JS_RETURN );
|
|
||||||
|
|
||||||
if ( status != JS_RETURN )
|
|
||||||
{
|
|
||||||
fgWarning( "%s", joy->fname );
|
|
||||||
joy->error = GL_TRUE;
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( buttons )
|
|
||||||
# if defined( __FreeBSD__ ) || defined(__FreeBSD_kernel__) || defined( __NetBSD__ )
|
|
||||||
*buttons = ( joy->js.b1 ? 1 : 0 ) | ( joy->js.b2 ? 2 : 0 ); /* XXX Should not be here -- BSD is handled earlier */
|
|
||||||
# else
|
|
||||||
*buttons = joy->js.buttons;
|
|
||||||
# endif
|
|
||||||
|
|
||||||
if ( axes )
|
|
||||||
{
|
|
||||||
axes[ 0 ] = (float) joy->js.x;
|
|
||||||
axes[ 1 ] = (float) joy->js.y;
|
|
||||||
}
|
|
||||||
# endif
|
|
||||||
#endif
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@ -934,6 +641,38 @@ static void fghJoystickAddHatElement ( SFG_Joystick *joy, CFDictionaryRef button
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
#if TARGET_HOST_MACINTOSH
|
#if TARGET_HOST_MACINTOSH
|
||||||
|
void fgPlatformJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes )
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
|
||||||
|
if ( buttons )
|
||||||
|
{
|
||||||
|
*buttons = 0;
|
||||||
|
|
||||||
|
for ( i = 0; i < joy->num_buttons; i++ )
|
||||||
|
{
|
||||||
|
UInt32 state;
|
||||||
|
int err = ISpElement_GetSimpleState ( isp_elem [ i + isp_num_axis ], &state);
|
||||||
|
ISP_CHECK_ERR(err)
|
||||||
|
|
||||||
|
*buttons |= state << i;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( axes )
|
||||||
|
{
|
||||||
|
for ( i = 0; i < joy->num_axes; i++ )
|
||||||
|
{
|
||||||
|
UInt32 state;
|
||||||
|
int err = ISpElement_GetSimpleState ( isp_elem [ i ], &state );
|
||||||
|
ISP_CHECK_ERR(err)
|
||||||
|
|
||||||
|
axes [i] = (float) state;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
void fgPlatformJoystickOpen( SFG_Joystick* joy )
|
void fgPlatformJoystickOpen( SFG_Joystick* joy )
|
||||||
{
|
{
|
||||||
int i = 0;
|
int i = 0;
|
||||||
@ -1056,6 +795,35 @@ void fgPlatformJoystickClose ( int ident )
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if TARGET_HOST_MAC_OSX
|
#if TARGET_HOST_MAC_OSX
|
||||||
|
void fgPlatformJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes )
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
|
||||||
|
if ( buttons != NULL )
|
||||||
|
{
|
||||||
|
*buttons = 0;
|
||||||
|
|
||||||
|
for ( i = 0; i < joy->num_buttons; i++ )
|
||||||
|
{
|
||||||
|
IOHIDEventStruct hidEvent;
|
||||||
|
(*(joy->hidDev))->getElementValue ( joy->hidDev, buttonCookies[i], &hidEvent );
|
||||||
|
if ( hidEvent.value )
|
||||||
|
*buttons |= 1 << i;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( axes != NULL )
|
||||||
|
{
|
||||||
|
for ( i = 0; i < joy->num_axes; i++ )
|
||||||
|
{
|
||||||
|
IOHIDEventStruct hidEvent;
|
||||||
|
(*(joy->hidDev))->getElementValue ( joy->hidDev, axisCookies[i], &hidEvent );
|
||||||
|
axes[i] = hidEvent.value;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
void fgPlatformJoystickOpen( SFG_Joystick* joy )
|
void fgPlatformJoystickOpen( SFG_Joystick* joy )
|
||||||
{
|
{
|
||||||
IOReturn rv;
|
IOReturn rv;
|
||||||
@ -1170,6 +938,181 @@ void fgPlatformJoystickClose ( int ident )
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if TARGET_HOST_POSIX_X11
|
#if TARGET_HOST_POSIX_X11
|
||||||
|
void fgPlatformJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes )
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
|
||||||
|
int i;
|
||||||
|
|
||||||
|
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__NetBSD__)
|
||||||
|
int len;
|
||||||
|
|
||||||
|
if ( joy->os->is_analog )
|
||||||
|
{
|
||||||
|
int status = read ( joy->os->fd, &joy->os->ajs, sizeof(joy->os->ajs) );
|
||||||
|
if ( status != sizeof(joy->os->ajs) ) {
|
||||||
|
perror ( joy->os->fname );
|
||||||
|
joy->error = GL_TRUE;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
if ( buttons != NULL )
|
||||||
|
*buttons = ( joy->os->ajs.b1 ? 1 : 0 ) | ( joy->os->ajs.b2 ? 2 : 0 );
|
||||||
|
|
||||||
|
if ( axes != NULL )
|
||||||
|
{
|
||||||
|
axes[0] = (float) joy->os->ajs.x;
|
||||||
|
axes[1] = (float) joy->os->ajs.y;
|
||||||
|
}
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
# ifdef HAVE_USB_JS
|
||||||
|
while ( ( len = read ( joy->os->fd, joy->os->hid_data_buf, joy->os->hid_dlen ) ) == joy->os->hid_dlen )
|
||||||
|
{
|
||||||
|
struct hid_item *h;
|
||||||
|
|
||||||
|
for ( h = joy->os->hids; h; h = h->next )
|
||||||
|
{
|
||||||
|
int d = hid_get_data ( joy->os->hid_data_buf, h );
|
||||||
|
|
||||||
|
int page = HID_PAGE ( h->usage );
|
||||||
|
int usage = HID_USAGE ( h->usage );
|
||||||
|
|
||||||
|
if ( page == HUP_GENERIC_DESKTOP )
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
for ( i = 0; i < joy->num_axes; i++ )
|
||||||
|
if (joy->os->axes_usage[i] == usage)
|
||||||
|
{
|
||||||
|
if (usage == HUG_HAT_SWITCH)
|
||||||
|
{
|
||||||
|
if (d < 0 || d > 8)
|
||||||
|
d = 0; /* safety */
|
||||||
|
joy->os->cache_axes[i] = (float)hatmap_x[d];
|
||||||
|
joy->os->cache_axes[i + 1] = (float)hatmap_y[d];
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
joy->os->cache_axes[i] = (float)d;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else if (page == HUP_BUTTON)
|
||||||
|
{
|
||||||
|
if (usage > 0 && usage < _JS_MAX_BUTTONS + 1)
|
||||||
|
{
|
||||||
|
if (d)
|
||||||
|
joy->os->cache_buttons |= (1 << ( usage - 1 ));
|
||||||
|
else
|
||||||
|
joy->os->cache_buttons &= ~(1 << ( usage - 1 ));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
# ifdef HAVE_ERRNO_H
|
||||||
|
if ( len < 0 && errno != EAGAIN )
|
||||||
|
# else
|
||||||
|
if ( len < 0 )
|
||||||
|
# endif
|
||||||
|
{
|
||||||
|
perror( joy->os->fname );
|
||||||
|
joy->error = 1;
|
||||||
|
}
|
||||||
|
if ( buttons != NULL ) *buttons = joy->os->cache_buttons;
|
||||||
|
if ( axes != NULL )
|
||||||
|
memcpy ( axes, joy->os->cache_axes, sizeof(float) * joy->num_axes );
|
||||||
|
# endif
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef JS_NEW
|
||||||
|
|
||||||
|
while ( 1 )
|
||||||
|
{
|
||||||
|
status = read ( joy->fd, &joy->js, sizeof(struct js_event) );
|
||||||
|
|
||||||
|
if ( status != sizeof( struct js_event ) )
|
||||||
|
{
|
||||||
|
# ifdef HAVE_ERRNO_H
|
||||||
|
if ( errno == EAGAIN )
|
||||||
|
{
|
||||||
|
/* Use the old values */
|
||||||
|
if ( buttons )
|
||||||
|
*buttons = joy->tmp_buttons;
|
||||||
|
if ( axes )
|
||||||
|
memcpy( axes, joy->tmp_axes,
|
||||||
|
sizeof( float ) * joy->num_axes );
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
# endif
|
||||||
|
|
||||||
|
fgWarning ( "%s", joy->fname );
|
||||||
|
joy->error = GL_TRUE;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
switch ( joy->js.type & ~JS_EVENT_INIT )
|
||||||
|
{
|
||||||
|
case JS_EVENT_BUTTON:
|
||||||
|
if( joy->js.value == 0 ) /* clear the flag */
|
||||||
|
joy->tmp_buttons &= ~( 1 << joy->js.number );
|
||||||
|
else
|
||||||
|
joy->tmp_buttons |= ( 1 << joy->js.number );
|
||||||
|
break;
|
||||||
|
|
||||||
|
case JS_EVENT_AXIS:
|
||||||
|
if ( joy->js.number < joy->num_axes )
|
||||||
|
{
|
||||||
|
joy->tmp_axes[ joy->js.number ] = ( float )joy->js.value;
|
||||||
|
|
||||||
|
if( axes )
|
||||||
|
memcpy( axes, joy->tmp_axes, sizeof(float) * joy->num_axes );
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
fgWarning ( "PLIB_JS: Unrecognised /dev/js return!?!" );
|
||||||
|
|
||||||
|
/* use the old values */
|
||||||
|
|
||||||
|
if ( buttons != NULL ) *buttons = joy->tmp_buttons;
|
||||||
|
if ( axes != NULL )
|
||||||
|
memcpy ( axes, joy->tmp_axes, sizeof(float) * joy->num_axes );
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if( buttons )
|
||||||
|
*buttons = joy->tmp_buttons;
|
||||||
|
}
|
||||||
|
#else
|
||||||
|
|
||||||
|
status = read( joy->fd, &joy->js, JS_RETURN );
|
||||||
|
|
||||||
|
if ( status != JS_RETURN )
|
||||||
|
{
|
||||||
|
fgWarning( "%s", joy->fname );
|
||||||
|
joy->error = GL_TRUE;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( buttons )
|
||||||
|
# if defined( __FreeBSD__ ) || defined(__FreeBSD_kernel__) || defined( __NetBSD__ )
|
||||||
|
*buttons = ( joy->js.b1 ? 1 : 0 ) | ( joy->js.b2 ? 2 : 0 ); /* XXX Should not be here -- BSD is handled earlier */
|
||||||
|
# else
|
||||||
|
*buttons = joy->js.buttons;
|
||||||
|
# endif
|
||||||
|
|
||||||
|
if ( axes )
|
||||||
|
{
|
||||||
|
axes[ 0 ] = (float) joy->js.x;
|
||||||
|
axes[ 1 ] = (float) joy->js.y;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
void fgPlatformJoystickOpen( SFG_Joystick* joy )
|
void fgPlatformJoystickOpen( SFG_Joystick* joy )
|
||||||
{
|
{
|
||||||
#if defined( __FreeBSD__ ) || defined(__FreeBSD_kernel__) || defined( __NetBSD__ )
|
#if defined( __FreeBSD__ ) || defined(__FreeBSD_kernel__) || defined( __NetBSD__ )
|
||||||
|
|||||||
@ -36,6 +36,78 @@
|
|||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void fgPlatformJoystickRawRead( SFG_Joystick* joy, int* buttons, float* axes )
|
||||||
|
{
|
||||||
|
MMRESULT status;
|
||||||
|
|
||||||
|
status = joyGetPosEx( joy->js_id, &joy->js );
|
||||||
|
|
||||||
|
if ( status != JOYERR_NOERROR )
|
||||||
|
{
|
||||||
|
joy->error = GL_TRUE;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( buttons )
|
||||||
|
*buttons = joy->js.dwButtons;
|
||||||
|
|
||||||
|
if ( axes )
|
||||||
|
{
|
||||||
|
/*
|
||||||
|
* WARNING - Fall through case clauses!!
|
||||||
|
*/
|
||||||
|
switch ( joy->num_axes )
|
||||||
|
{
|
||||||
|
case 8:
|
||||||
|
/* Generate two POV axes from the POV hat angle.
|
||||||
|
* Low 16 bits of js.dwPOV gives heading (clockwise from ahead) in
|
||||||
|
* hundredths of a degree, or 0xFFFF when idle.
|
||||||
|
*/
|
||||||
|
if ( ( joy->js.dwPOV & 0xFFFF ) == 0xFFFF )
|
||||||
|
{
|
||||||
|
axes [ 6 ] = 0.0;
|
||||||
|
axes [ 7 ] = 0.0;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* This is the contentious bit: how to convert angle to X/Y.
|
||||||
|
* wk: I know of no define for PI that we could use here:
|
||||||
|
* SG_PI would pull in sg, M_PI is undefined for MSVC
|
||||||
|
* But the accuracy of the value of PI is very unimportant at
|
||||||
|
* this point.
|
||||||
|
*/
|
||||||
|
float s = (float) sin ( ( joy->js.dwPOV & 0xFFFF ) * ( 0.01 * 3.1415926535f / 180.0f ) );
|
||||||
|
float c = (float) cos ( ( joy->js.dwPOV & 0xFFFF ) * ( 0.01 * 3.1415926535f / 180.0f ) );
|
||||||
|
|
||||||
|
/* Convert to coordinates on a square so that North-East
|
||||||
|
* is (1,1) not (.7,.7), etc.
|
||||||
|
* s and c cannot both be zero so we won't divide by zero.
|
||||||
|
*/
|
||||||
|
if ( fabs ( s ) < fabs ( c ) )
|
||||||
|
{
|
||||||
|
axes [ 6 ] = ( c < 0.0 ) ? -s/c : s/c ;
|
||||||
|
axes [ 7 ] = ( c < 0.0 ) ? -1.0f : 1.0f;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
axes [ 6 ] = ( s < 0.0 ) ? -1.0f : 1.0f;
|
||||||
|
axes [ 7 ] = ( s < 0.0 ) ? -c/s : c/s ;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
case 6: axes[5] = (float) joy->js.dwVpos;
|
||||||
|
case 5: axes[4] = (float) joy->js.dwUpos;
|
||||||
|
case 4: axes[3] = (float) joy->js.dwRpos;
|
||||||
|
case 3: axes[2] = (float) joy->js.dwZpos;
|
||||||
|
case 2: axes[1] = (float) joy->js.dwYpos;
|
||||||
|
case 1: axes[0] = (float) joy->js.dwXpos;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* Inspired by
|
/* Inspired by
|
||||||
http://msdn.microsoft.com/archive/en-us/dnargame/html/msdn_sidewind3d.asp
|
http://msdn.microsoft.com/archive/en-us/dnargame/html/msdn_sidewind3d.asp
|
||||||
*/
|
*/
|
||||||
|
|||||||
Reference in New Issue
Block a user