diff src/joystick/os2/SDL_sysjoystick.c @ 1190:173c063d4f55

OS/2 port! This was mostly, if not entirely, written by "Doodle" and "Caetano": doodle@scenergy.dfmk.hu daniel@caetano.eng.br --ryan.
author Ryan C. Gordon <icculus@icculus.org>
date Wed, 23 Nov 2005 07:29:56 +0000
parents
children c9b51268668f
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/joystick/os2/SDL_sysjoystick.c	Wed Nov 23 07:29:56 2005 +0000
@@ -0,0 +1,669 @@
+/*
+    SDL - Simple DirectMedia Layer
+    Copyright (C) 1997-2004 Sam Lantinga
+
+    This library is free software; you can redistribute it and/or
+    modify it under the terms of the GNU Library General Public
+    License as published by the Free Software Foundation; either
+    version 2 of the License, or (at your option) any later version.
+
+    This library is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+    Library General Public License for more details.
+
+    You should have received a copy of the GNU Library General Public
+    License along with this library; if not, write to the Free
+    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+
+    Sam Lantinga
+    slouken@libsdl.org
+*/
+
+#ifdef SAVE_RCSID
+static char rcsid =
+ "@(#) $Id$";
+#endif
+
+/* OS/2 Joystick driver, contributed by Daniel Caetano */
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <mem.h>
+
+#define INCL_DOSDEVICES
+#define INCL_DOSDEVIOCTL
+#define INCL_DOSMEMMGR
+#include <os2.h>
+#include "joyos2.h"
+
+#include "SDL_error.h"
+#include "SDL_joystick.h"
+#include "SDL_sysjoystick.h"
+#include "SDL_joystick_c.h"
+
+HFILE hJoyPort = NULL;		/* Joystick GAME$ Port Address */
+#define MAX_JOYSTICKS	2	/* Maximum of two joysticks */
+#define MAX_AXES	4			/* each joystick can have up to 4 axes */
+#define MAX_BUTTONS	8		/* 8 buttons */
+#define MAX_HATS	0			/* 0 hats - OS/2 doesn't support it */
+#define MAX_BALLS	0			/* and 0 balls - OS/2 doesn't support it */
+#define AXIS_MIN -32768		/* minimum value for axes coordinate */
+#define AXIS_MAX 32767		/* maximum value for axes coordinate */
+#define MAX_JOYNAME	128	/* Joystick name may have 128 characters */
+/* limit axes to 256 possible positions to filter out noise */
+#define JOY_AXIS_THRESHOLD (((AXIS_MAX)-(AXIS_MIN))/256)
+/* Calc Button Flag for buttons A to D */
+#define JOY_BUTTON_FLAG(n) (1<<n)
+
+/* Joystick data... hold information about detected devices */
+struct _SYS_JoyData
+{
+Sint8					id;								// Device ID
+char					szDeviceName[MAX_JOYNAME];	// Device Name
+char					axes;								// Number of axes
+char					buttons;							// Number of buttons
+char					hats;								// Number of buttons
+char					balls;							// Number of buttons
+int					axes_min[MAX_AXES];			// minimum callibration value for axes
+int					axes_med[MAX_AXES];			// medium callibration value for axes
+int					axes_max[MAX_AXES];			// maximum callibration value for axes
+int					buttoncalc[4];					// Used for buttons 5, 6, 7 and 8.
+} SYS_JoyData[MAX_JOYSTICKS];
+
+
+/* Structure used to convert data from OS/2 driver format to SDL format */
+struct joystick_hwdata
+{
+Sint8					id;
+struct _transaxes
+	{
+	int offset;					/* Center Offset */
+	float scale1;				/* Center to left/up Scale */
+	float scale2;				/* Center to right/down Scale */
+	} transaxes[MAX_AXES];
+};
+
+/* Structure used to get values from Joystick Environment Variable */
+struct _joycfg
+{
+char	name[MAX_JOYNAME];
+unsigned int	axes;
+unsigned int	buttons;
+unsigned int	hats;
+unsigned int	balls;
+};
+
+/* OS/2 Implementation Function Prototypes */
+APIRET joyPortOpen(HFILE * hGame);
+void joyPortClose(HFILE * hGame);
+int joyGetData(char *joyenv, char *name, char stopchar, size_t maxchars);
+int joyGetEnv(struct _joycfg * joydata);
+
+
+
+/************************************************************************/
+/* Function to scan the system for joysticks.									*/
+/* This function should set SDL_numjoysticks to the number of available	*/
+/* joysticks.  Joystick 0 should be the system default joystick.			*/
+/* It should return 0, or -1 on an unrecoverable fatal error.				*/
+/************************************************************************/
+int SDL_SYS_JoystickInit(void)
+{
+APIRET rc;											/* Generic OS/2 return code */
+GAME_PORT_STRUCT	stJoyStatus;				/* Joystick Status Structure */
+GAME_PARM_STRUCT	stGameParms;				/* Joystick Parameter Structure */
+GAME_CALIB_STRUCT	stGameCalib;				/* Calibration Struct */
+ULONG ulDataLen;									/* Size of data */
+ULONG ulLastTick;						/* Tick Counter for timing operations */
+Uint8 maxdevs;										/* Maximum number of devices */
+Uint8 numdevs;										/* Number of present devices */
+Uint8 maxbut;										/* Maximum number of buttons... */
+Uint8 i;												/* Temporary Count Vars */
+Uint8 ucNewJoystickMask;										/* Mask for Joystick Detection */
+struct _joycfg joycfg;							/* Joy Configuration from envvar */
+
+
+/* Get Max Number of Devices */
+rc = joyPortOpen(&hJoyPort); /* Open GAME$ port */
+if (rc != 0) return 0;	/* Cannot open... report no joystick */
+ulDataLen = sizeof(stGameParms);
+rc = DosDevIOCtl(hJoyPort, IOCTL_CAT_USER, GAME_GET_PARMS,
+	NULL, 0, NULL, &stGameParms, ulDataLen, &ulDataLen); /* Ask device info */
+if (rc != 0)
+	{
+	joyPortClose(&hJoyPort);
+	SDL_SetError("Could not read joystick port.");
+	return -1;
+	}
+if (stGameParms.useA != 0) maxdevs++;
+if (stGameParms.useB != 0) maxdevs++;
+if ( maxdevs > MAX_JOYSTICKS ) maxdevs = MAX_JOYSTICKS;
+
+/* Defines min/max axes values (callibration) */
+ulDataLen = sizeof(stGameCalib);
+rc = DosDevIOCtl(hJoyPort, IOCTL_CAT_USER, GAME_GET_CALIB,
+	NULL, 0, NULL, &stGameCalib, ulDataLen, &ulDataLen);
+if (rc != 0)
+	{
+	joyPortClose(&hJoyPort);
+	SDL_SetError("Could not read callibration data.");
+	return -1;
+	}
+
+/* Determine how many joysticks are active */
+numdevs = 0;	/* Points no device */
+ucNewJoystickMask = 0x0F;	/* read all 4 joystick axis */
+ulDataLen = sizeof(ucNewJoystickMask);
+rc = DosDevIOCtl(hJoyPort, IOCTL_CAT_USER, GAME_PORT_RESET,
+		&ucNewJoystickMask, ulDataLen, &ulDataLen, NULL, 0, NULL);
+if (rc == 0)
+	{
+	ulDataLen = sizeof(stJoyStatus);
+	rc = DosDevIOCtl(hJoyPort, IOCTL_CAT_USER, GAME_PORT_GET,
+		NULL, 0, NULL, &stJoyStatus, ulDataLen, &ulDataLen);
+	if (rc != 0)
+		{
+		joyPortClose(&hJoyPort);
+		SDL_SetError("Could not call joystick port.");
+		return -1;
+		}
+	ulLastTick = stJoyStatus.ulJs_Ticks;
+	while (stJoyStatus.ulJs_Ticks == ulLastTick)
+		{
+		rc = DosDevIOCtl(hJoyPort, IOCTL_CAT_USER, GAME_PORT_GET,
+			NULL, 0, NULL, &stJoyStatus, ulDataLen, &ulDataLen);
+		}
+	if ((stJoyStatus.ucJs_JoyStickMask & 0x03) > 0) numdevs++;
+	if (((stJoyStatus.ucJs_JoyStickMask >> 2) & 0x03) > 0) numdevs++;
+	}
+
+if (numdevs>maxdevs) numdevs=maxdevs;
+
+/* If *any* joystick was detected... Let's configure SDL for them */
+if (numdevs > 0)
+	{
+	/* Verify if it is a "user defined" joystick */
+	if (joyGetEnv(&joycfg))
+		{
+		GAME_3POS_STRUCT * axis[4];
+		axis[0] = &stGameCalib.Ax;
+		axis[1] = &stGameCalib.Ay;
+		axis[2] = &stGameCalib.Bx;
+		axis[3] = &stGameCalib.By;
+		/* Say it has one device only (user defined is always one device only) */
+		numdevs = 1;
+		/* Define Device 0 as... */
+		SYS_JoyData[0].id=0;
+		/* Define Number of Axes... up to 4 */
+		if (joycfg.axes>MAX_AXES) joycfg.axes = MAX_AXES;
+		SYS_JoyData[0].axes = joycfg.axes;
+		/* Define number of buttons... 8 if 2 axes, 6 if 3 axes and 4 if 4 axes */
+		maxbut = MAX_BUTTONS;
+		if (joycfg.axes>2) maxbut-=((joycfg.axes-2)<<1); /* MAX_BUTTONS - 2*(axes-2) */
+		if (joycfg.buttons > maxbut) joycfg.buttons = maxbut;
+		SYS_JoyData[0].buttons = joycfg.buttons;
+		/* Define number of hats */
+		if (joycfg.hats > MAX_HATS) joycfg.hats = MAX_HATS;
+		SYS_JoyData[0].hats = joycfg.hats;
+		/* Define number of balls */
+		if (joycfg.balls > MAX_BALLS) joycfg.balls = MAX_BALLS;
+		SYS_JoyData[0].balls = joycfg.balls;
+		/* Initialize Axes Callibration Values */
+		for (i=0; i<joycfg.axes; i++)
+			{
+			SYS_JoyData[0].axes_min[i] = axis[i]->lower;
+			SYS_JoyData[0].axes_med[i] = axis[i]->centre;
+			SYS_JoyData[0].axes_max[i] = axis[i]->upper;
+			}
+		/* Initialize Buttons 5 to 8 structures */
+		if (joycfg.buttons>=5) SYS_JoyData[0].buttoncalc[0]=((axis[2]->lower+axis[3]->centre)>>1);
+		if (joycfg.buttons>=6) SYS_JoyData[0].buttoncalc[1]=((axis[3]->lower+axis[3]->centre)>>1);
+		if (joycfg.buttons>=7) SYS_JoyData[0].buttoncalc[2]=((axis[2]->upper+axis[3]->centre)>>1);
+		if (joycfg.buttons>=8) SYS_JoyData[0].buttoncalc[3]=((axis[3]->upper+axis[3]->centre)>>1);
+		/* Intialize Joystick Name */
+		strcpy (SYS_JoyData[0].szDeviceName,joycfg.name);
+		}
+	/* Default Init ... autoconfig */
+	else
+		{
+		/* if two devices were detected... configure as Joy1 4 axis and Joy2 2 axis */
+		if (numdevs==2)
+			{
+			/* Define Device 0 as 4 axes, 4 buttons */
+			SYS_JoyData[0].id=0;
+			SYS_JoyData[0].axes = 4;
+			SYS_JoyData[0].buttons = 4;
+			SYS_JoyData[0].hats = 0;
+			SYS_JoyData[0].balls = 0;
+			SYS_JoyData[0].axes_min[0] = stGameCalib.Ax.lower;
+			SYS_JoyData[0].axes_med[0] = stGameCalib.Ax.centre;
+			SYS_JoyData[0].axes_max[0] = stGameCalib.Ax.upper;
+			SYS_JoyData[0].axes_min[1] = stGameCalib.Ay.lower;
+			SYS_JoyData[0].axes_med[1] = stGameCalib.Ay.centre;
+			SYS_JoyData[0].axes_max[1] = stGameCalib.Ay.upper;
+			SYS_JoyData[0].axes_min[2] = stGameCalib.Bx.lower;
+			SYS_JoyData[0].axes_med[2] = stGameCalib.Bx.centre;
+			SYS_JoyData[0].axes_max[2] = stGameCalib.Bx.upper;
+			SYS_JoyData[0].axes_min[3] = stGameCalib.By.lower;
+			SYS_JoyData[0].axes_med[3] = stGameCalib.By.centre;
+			SYS_JoyData[0].axes_max[3] = stGameCalib.By.upper;
+			/* Define Device 1 as 2 axes, 2 buttons */
+			SYS_JoyData[1].id=1;
+			SYS_JoyData[1].axes = 2;
+			SYS_JoyData[1].buttons = 2;
+			SYS_JoyData[1].hats = 0;
+			SYS_JoyData[1].balls = 0;
+			SYS_JoyData[1].axes_min[0] = stGameCalib.Bx.lower;
+			SYS_JoyData[1].axes_med[0] = stGameCalib.Bx.centre;
+			SYS_JoyData[1].axes_max[0] = stGameCalib.Bx.upper;
+			SYS_JoyData[1].axes_min[1] = stGameCalib.By.lower;
+			SYS_JoyData[1].axes_med[1] = stGameCalib.By.centre;
+			SYS_JoyData[1].axes_max[1] = stGameCalib.By.upper;
+			}
+		/* One joystick only? */
+		else
+			{
+			/* If it is joystick A... */
+			if ((stJoyStatus.ucJs_JoyStickMask & 0x03) > 0)
+				{
+				/* Define Device 0 as 2 axes, 4 buttons */
+				SYS_JoyData[0].id=0;
+				SYS_JoyData[0].axes = 2;
+				SYS_JoyData[0].buttons = 4;
+				SYS_JoyData[0].hats = 0;
+				SYS_JoyData[0].balls = 0;
+				SYS_JoyData[0].axes_min[0] = stGameCalib.Ax.lower;
+				SYS_JoyData[0].axes_med[0] = stGameCalib.Ax.centre;
+				SYS_JoyData[0].axes_max[0] = stGameCalib.Ax.upper;
+				SYS_JoyData[0].axes_min[1] = stGameCalib.Ay.lower;
+				SYS_JoyData[0].axes_med[1] = stGameCalib.Ay.centre;
+				SYS_JoyData[0].axes_max[1] = stGameCalib.Ay.upper;
+				}
+			/* If not, it is joystick B */
+			else
+				{
+				/* Define Device 1 as 2 axes, 2 buttons */
+				SYS_JoyData[0].id=1;
+				SYS_JoyData[0].axes = 2;
+				SYS_JoyData[0].buttons = 2;
+				SYS_JoyData[0].hats = 0;
+				SYS_JoyData[0].balls = 0;
+				SYS_JoyData[0].axes_min[0] = stGameCalib.Bx.lower;
+				SYS_JoyData[0].axes_med[0] = stGameCalib.Bx.centre;
+				SYS_JoyData[0].axes_max[0] = stGameCalib.Bx.upper;
+				SYS_JoyData[0].axes_min[1] = stGameCalib.By.lower;
+				SYS_JoyData[0].axes_med[1] = stGameCalib.By.centre;
+				SYS_JoyData[0].axes_max[1] = stGameCalib.By.upper;
+				}
+			}
+		/* Hack to define Joystick Port Names */
+		if ( numdevs > maxdevs ) numdevs = maxdevs;
+		for (i=0; i<numdevs; i++) sprintf (SYS_JoyData[i].szDeviceName,"Default Joystick %c",'A'+SYS_JoyData[i].id);
+		}
+	}
+/* Return the number of devices found */
+return(numdevs);
+}
+
+
+
+/***********************************************************/
+/* Function to get the device-dependent name of a joystick */
+/***********************************************************/
+const char *SDL_SYS_JoystickName(int index)
+{
+/* No need to verify if device exists, already done in upper layer */
+return(SYS_JoyData[index].szDeviceName);
+}
+
+
+
+/******************************************************************************/
+/* Function to open a joystick for use.													*/
+/* The joystick to open is specified by the index field of the joystick.		*/
+/* This should fill the nbuttons and naxes fields of the joystick structure.	*/
+/* It returns 0, or -1 if there is an error.												*/
+/******************************************************************************/
+int SDL_SYS_JoystickOpen(SDL_Joystick *joystick)
+{
+int index;		/* Index shortcut for index in joystick structure */
+int i;			/* Generic Counter */
+
+/* allocate memory for system specific hardware data */
+joystick->hwdata = (struct joystick_hwdata *) malloc(sizeof(*joystick->hwdata));
+if (joystick->hwdata == NULL)
+	{
+	SDL_OutOfMemory();
+	return(-1);
+	}
+/* Reset Hardware Data */
+memset(joystick->hwdata, 0, sizeof(*joystick->hwdata));
+
+/* ShortCut Pointer */
+index = joystick->index;
+/* Define offsets and scales for all axes */
+joystick->hwdata->id = SYS_JoyData[index].id;
+for ( i = 0; i < MAX_AXES; ++i )
+	{
+	if ( (i<2) || i < SYS_JoyData[index].axes )
+		{
+		joystick->hwdata->transaxes[i].offset = ((AXIS_MAX + AXIS_MIN)>>1) - SYS_JoyData[index].axes_med[i];
+		//joystick->hwdata->transaxes[i].scale = (float)((AXIS_MAX - AXIS_MIN)/(SYS_JoyData[index].axes_max[i]-SYS_JoyData[index].axes_min[i]));
+		joystick->hwdata->transaxes[i].scale1 = (float)abs((AXIS_MIN/SYS_JoyData[index].axes_min[i]));
+		joystick->hwdata->transaxes[i].scale2 = (float)abs((AXIS_MAX/SYS_JoyData[index].axes_max[i]));
+		}
+	else
+		{
+		joystick->hwdata->transaxes[i].offset = 0;
+		//joystick->hwdata->transaxes[i].scale = 1.0; /* Just in case */
+		joystick->hwdata->transaxes[i].scale1 = 1.0; /* Just in case */
+		joystick->hwdata->transaxes[i].scale2 = 1.0; /* Just in case */
+		}
+	}
+
+/* fill nbuttons, naxes, and nhats fields */
+joystick->nbuttons = SYS_JoyData[index].buttons;
+joystick->naxes = SYS_JoyData[index].axes;
+/* joystick->nhats = SYS_JoyData[index].hats; */
+joystick->nhats = 0; /* No support for hats at this time */
+/* joystick->nballs = SYS_JoyData[index].balls; */
+joystick->nballs = 0; /* No support for balls at this time */
+return 0;
+}
+
+
+
+/***************************************************************************/
+/* Function to update the state of a joystick - called as a device poll.	*/
+/* This function shouldn't update the joystick structure directly,			*/
+/* but instead should call SDL_PrivateJoystick*() to deliver events			*/
+/* and update joystick device state.													*/
+/***************************************************************************/
+void SDL_SYS_JoystickUpdate(SDL_Joystick *joystick)
+{
+APIRET rc;									/* Generic OS/2 return code */
+int index;									/* index shortcurt to joystick index */
+int i;										/* Generic counter */
+int normbut;								/* Number of buttons reported by joystick */
+int corr;									/* Correction for button names */
+Sint16 value, change;					/* Values used to update axis values */
+struct _transaxes *transaxes;			/* Shortcut for Correction structure */
+Uint32 pos[MAX_AXES];					/* Vector to inform the Axis status */
+ULONG ulDataLen;							/* Size of data */
+GAME_STATUS_STRUCT stGameStatus;		/* Joystick Status Structure */
+
+ulDataLen = sizeof(stGameStatus);
+rc = DosDevIOCtl(hJoyPort, IOCTL_CAT_USER, GAME_GET_STATUS,
+	NULL, 0, NULL, &stGameStatus, ulDataLen, &ulDataLen);
+if (rc != 0)
+	{
+	SDL_SetError("Could not read joystick status.");
+	return; /* Could not read data */
+	}
+
+/* Shortcut pointer */
+index = joystick->index;
+/* joystick motion events */
+
+if (SYS_JoyData[index].id == 0)
+	{
+	pos[0] = stGameStatus.curdata.A.x;
+	pos[1] = stGameStatus.curdata.A.y;
+	if (SYS_JoyData[index].axes >= 3)	pos[2] = stGameStatus.curdata.B.x;
+	else pos[2]=0;
+	if (SYS_JoyData[index].axes >= 4)	pos[3] = stGameStatus.curdata.B.y;
+	else pos[3]=0;
+	pos[4]=0;	/* OS/2 basic drivers do not support more than 4 axes joysticks */
+	pos[5]=0;
+	}
+else if (SYS_JoyData[index].id == 1)
+	{
+	pos[0] = stGameStatus.curdata.B.x;
+	pos[1] = stGameStatus.curdata.B.y;
+	pos[2]=0;
+	pos[3]=0;
+	pos[4]=0;
+	pos[5]=0;
+	}
+
+/* Corrects the movements using the callibration */
+transaxes = joystick->hwdata->transaxes;
+for (i = 0; i < joystick->naxes; i++)
+	{
+	value = pos[i] + transaxes[i].offset;
+	if (value<0)
+		{
+		value*=transaxes[i].scale1;
+		if (value>0) value = AXIS_MIN;
+		}
+	else
+		{
+		value*=transaxes[i].scale2;
+		if (value<0) value = AXIS_MAX;
+		}
+	change = (value - joystick->axes[i]);
+	if ( (change < -JOY_AXIS_THRESHOLD) || (change > JOY_AXIS_THRESHOLD) )
+		{
+		SDL_PrivateJoystickAxis(joystick, (Uint8)i, (Sint16)value);
+		}
+	}
+
+/* joystick button A to D events */
+if (SYS_JoyData[index].id == 1) corr = 2;
+else corr = 0;
+normbut=4;	/* Number of normal buttons */
+if (joystick->nbuttons<normbut) normbut = joystick->nbuttons;
+for ( i = corr; (i-corr) < normbut; ++i )
+	{
+	/*
+		Button A: 1110 0000
+		Button B: 1101 0000
+		Button C: 1011 0000
+		Button D: 0111 0000
+	*/
+	if ( (~stGameStatus.curdata.butMask)>>4 & JOY_BUTTON_FLAG(i) )
+		{
+		if ( ! joystick->buttons[i-corr] )
+			{
+			SDL_PrivateJoystickButton(joystick, (Uint8)(i-corr), SDL_PRESSED);
+			}
+		}
+	else
+		{
+		if ( joystick->buttons[i-corr] )
+			{
+			SDL_PrivateJoystickButton(joystick, (Uint8)(i-corr), SDL_RELEASED);
+			}
+		}
+	}
+
+/* Joystick button E to H buttons */
+	/*
+		Button E: Axis 2 X Left
+		Button F: Axis 2 Y Up
+		Button G: Axis 2 X Right
+		Button H: Axis 2 Y Down
+	*/
+if (joystick->nbuttons>=5)
+	{
+	if (stGameStatus.curdata.B.x < SYS_JoyData[index].buttoncalc[0]) SDL_PrivateJoystickButton(joystick, (Uint8)4, SDL_PRESSED);
+	else SDL_PrivateJoystickButton(joystick, (Uint8)4, SDL_RELEASED);
+	}
+if (joystick->nbuttons>=6)
+	{
+	if (stGameStatus.curdata.B.y < SYS_JoyData[index].buttoncalc[1]) SDL_PrivateJoystickButton(joystick, (Uint8)5, SDL_PRESSED);
+	else SDL_PrivateJoystickButton(joystick, (Uint8)5, SDL_RELEASED);
+	}
+if (joystick->nbuttons>=7)
+	{
+	if (stGameStatus.curdata.B.x > SYS_JoyData[index].buttoncalc[2]) SDL_PrivateJoystickButton(joystick, (Uint8)6, SDL_PRESSED);
+	else SDL_PrivateJoystickButton(joystick, (Uint8)6, SDL_RELEASED);
+	}
+if (joystick->nbuttons>=8)
+	{
+	if (stGameStatus.curdata.B.y > SYS_JoyData[index].buttoncalc[3]) SDL_PrivateJoystickButton(joystick, (Uint8)7, SDL_PRESSED);
+	else SDL_PrivateJoystickButton(joystick, (Uint8)7, SDL_RELEASED);
+	}
+
+/* joystick hat events */
+/* Not Supported under OS/2 */
+/* joystick ball events */
+/* Not Supported under OS/2 */
+}
+
+
+
+/******************************************/
+/* Function to close a joystick after use */
+/******************************************/
+void SDL_SYS_JoystickClose(SDL_Joystick *joystick)
+{
+if (joystick->hwdata != NULL)
+	{
+	/* free system specific hardware data */
+	free(joystick->hwdata);
+	}
+}
+
+
+
+/********************************************************************/
+/* Function to perform any system-specific joystick related cleanup */
+/********************************************************************/
+void SDL_SYS_JoystickQuit(void)
+{
+joyPortClose(&hJoyPort);
+}
+
+
+
+/************************/
+/************************/
+/* OS/2 Implementations */
+/************************/
+/************************/
+
+
+/*****************************************/
+/* Open Joystick Port, if not opened yet */
+/*****************************************/
+APIRET joyPortOpen(HFILE * hGame)
+{
+APIRET		rc;				/* Generic Return Code */
+ULONG			ulAction;		/* ? */
+ULONG			ulVersion;		/* Version of joystick driver */
+ULONG			ulDataLen;		/* Size of version data */
+
+/* Verifies if joyport is not already open... */
+if (*hGame != NULL) return 0;
+/* Open GAME$ for read */
+rc = DosOpen((PSZ)GAMEPDDNAME, hGame, &ulAction, 0, FILE_READONLY,
+	FILE_OPEN, OPEN_ACCESS_READONLY | OPEN_SHARE_DENYNONE, NULL);
+if (rc != 0)
+	{
+	SDL_SetError("Could not open Joystick Port.");
+	return -1;
+	}
+	
+/* Get Joystick Driver Version... must be 2.0 or higher */
+ulVersion = 0;
+ulDataLen = sizeof(ulVersion);
+rc = DosDevIOCtl( *hGame, IOCTL_CAT_USER, GAME_GET_VERSION,
+	NULL, 0, NULL, &ulVersion, ulDataLen, &ulDataLen);
+if (rc != 0)
+	{
+	joyPortClose(hGame);
+	SDL_SetError("Could not get Joystick Driver version.");
+	return -1;	
+	}
+if (ulVersion < GAME_VERSION)
+	{
+	joyPortClose(hGame);
+	SDL_SetError("Driver too old. At least IBM driver version 2.0 required.");
+	return -1;
+	}
+return 0;
+}
+
+
+
+/****************************/
+/* Close JoyPort, if opened */
+/****************************/
+void joyPortClose(HFILE * hGame)
+{
+if (*hGame != NULL) DosClose(*hGame);
+*hGame = NULL;
+}
+
+
+
+/***************************/
+/* Get SDL Joystick EnvVar */
+/***************************/
+int joyGetEnv(struct _joycfg * joydata)
+{
+char *joyenv;				/* Pointer to tested character */
+char tempnumber[5];		/* Temporary place to put numeric texts */
+
+joyenv = getenv("SDL_OS2_JOYSTICK");
+if (joyenv == NULL) return 0;
+/* Joystick Environment is defined! */
+while (*joyenv==' ' && *joyenv!=0) joyenv++; /* jump spaces... */
+/* If the string name starts with '... get if fully */
+if (*joyenv=='\'') joyenv+=joyGetData(++joyenv,joydata->name,'\'',sizeof(joydata->name));
+/* If not, get it until the next space */
+else if (*joyenv=='\"') joyenv+=joyGetData(++joyenv,joydata->name,'\"',sizeof(joydata->name));
+else joyenv+=joyGetData(joyenv,joydata->name,' ',sizeof(joydata->name));
+/* Now get the number of axes */
+while (*joyenv==' ' && *joyenv!=0) joyenv++; /* jump spaces... */
+joyenv+=joyGetData(joyenv,tempnumber,' ',sizeof(tempnumber));
+joydata->axes = atoi(tempnumber);
+/* Now get the number of buttons */
+while (*joyenv==' ' && *joyenv!=0) joyenv++; /* jump spaces... */
+joyenv+=joyGetData(joyenv,tempnumber,' ',sizeof(tempnumber));
+joydata->buttons = atoi(tempnumber);
+/* Now get the number of hats */
+while (*joyenv==' ' && *joyenv!=0) joyenv++; /* jump spaces... */
+joyenv+=joyGetData(joyenv,tempnumber,' ',sizeof(tempnumber));
+joydata->hats = atoi(tempnumber);
+/* Now get the number of balls */
+while (*joyenv==' ' && *joyenv!=0) joyenv++; /* jump spaces... */
+joyenv+=joyGetData(joyenv,tempnumber,' ',sizeof(tempnumber));
+joydata->balls = atoi(tempnumber);
+return 1;
+}
+
+
+
+/************************************************************************/
+/* Get a text from in the string starting in joyenv until it finds		*/
+/* the stopchar or maxchars is reached. The result is placed in name.	*/
+/************************************************************************/
+int joyGetData(char *joyenv, char *name, char stopchar, size_t maxchars)
+{
+char *nameptr;			/* Pointer to the selected character */
+int chcnt=0;			/* Count how many characters where copied */
+
+nameptr=name;
+while (*joyenv!=stopchar && *joyenv!=0)
+	{
+	if (nameptr<(name+(maxchars-1)))
+		{
+		*nameptr = *joyenv; /* Only copy if smaller than maximum */
+		nameptr++;
+		}
+	chcnt++;
+	joyenv++;
+	}
+if (*joyenv==stopchar)
+	{
+	joyenv++; /* Jump stopchar */
+	chcnt++;
+	}
+*nameptr = 0; /* Mark last byte */
+return chcnt;
+}
+
+