Mercurial > sdl-ios-xcode
view src/joystick/os2/SDL_sysjoystick.c @ 1206:aac47040c6d7
Patched to compile on gcc 2.95.3.
author | Ryan C. Gordon <icculus@icculus.org> |
---|---|
date | Mon, 19 Dec 2005 06:58:51 +0000 |
parents | 173c063d4f55 |
children | c9b51268668f |
line wrap: on
line source
/* 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; }