This repository has been archived by the owner on Feb 11, 2021. It is now read-only.
/
SDL_syshaptic.c
1282 lines (1066 loc) · 35.1 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
/*
SDL - Simple DirectMedia Layer
Copyright (C) 2008 Edgar Simo
This library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either
version 2.1 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
Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
Sam Lantinga
slouken@libsdl.org
*/
#include "SDL_config.h"
#ifdef SDL_HAPTIC_DINPUT
#include "SDL_haptic.h"
#include "../SDL_syshaptic.h"
#include "SDL_joystick.h"
#include "../../joystick/SDL_sysjoystick.h" /* For the real SDL_Joystick */
30
#include "../../joystick/win32/SDL_dxjoystick_c.h" /* For joystick hwdata */
31
32
33
34
#define WIN32_LEAN_AND_MEAN
#include <windows.h>
35
#define DIRECTINPUT_VERSION 0x0700 /* Need at least DirectX 7 for dwStartDelay */
36
#include <dinput.h>
37
#include <dxerr.h>
38
#ifdef _MSC_VER
39
40
41
# pragma comment (lib, "dinput8.lib")
# pragma comment (lib, "dxguid.lib")
# pragma comment (lib, "dxerr.lib")
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
#endif /* _MSC_VER */
/* an ISO hack for VisualC++ */
#ifdef _MSC_VER
#define snprintf _snprintf
#endif /* _MSC_VER */
#define MAX_HAPTICS 32
/*
* List of available haptic devices.
*/
static struct
{
DIDEVICEINSTANCE instance;
SDL_Haptic *haptic;
60
DIDEVCAPS capabilities;
61
62
63
64
65
66
67
68
69
} SDL_hapticlist[MAX_HAPTICS];
/*
* Haptic system hardware data.
*/
struct haptic_hwdata
{
LPDIRECTINPUTDEVICE2 device;
70
71
DWORD axes[3]; /* Axes to use. */
int is_joystick; /* Device is loaded as joystick. */
72
73
74
75
76
77
78
79
80
};
/*
* Haptic system effect data.
*/
struct haptic_hweffect
{
DIEFFECT effect;
81
LPDIRECTINPUTEFFECT ref;
82
83
84
85
86
87
88
89
90
};
/*
* Internal stuff.
*/
static LPDIRECTINPUT dinput = NULL;
91
92
93
94
/*
* External stuff.
*/
extern HINSTANCE SDL_Instance;
95
extern HWND SDL_HelperWindow;
96
97
98
99
100
/*
* Prototypes.
*/
101
102
103
104
105
106
107
108
109
110
static void DI_SetError(const char *str, HRESULT err);
static int DI_GUIDIsSame(const GUID * a, const GUID * b);
static int SDL_SYS_HapticOpenFromInstance(SDL_Haptic * haptic, DIDEVICEINSTANCE instance);
static int SDL_SYS_HapticOpenFromDevice2(SDL_Haptic * haptic, LPDIRECTINPUTDEVICE2 device2);
static DWORD DIGetTriggerButton( Uint16 button );
static int SDL_SYS_SetDirection( DIEFFECT * effect, SDL_HapticDirection *dir, int naxes );
static int SDL_SYS_ToDIEFFECT( SDL_Haptic * haptic, DIEFFECT * dest, SDL_HapticEffect * src );
static void SDL_SYS_HapticFreeDIEFFECT( DIEFFECT * effect, int type );
static REFGUID SDL_SYS_HapticEffectType(SDL_HapticEffect * effect);
/* Callbacks. */
111
static BOOL CALLBACK EnumHapticsCallback(const DIDEVICEINSTANCE * pdidInstance, VOID * pContext);
112
static BOOL CALLBACK DI_EffectCallback(LPCDIEFFECTINFO pei, LPVOID pv);
113
114
115
116
117
118
119
120
121
/*
* Like SDL_SetError but for DX error codes.
*/
static void
DI_SetError(const char *str, HRESULT err)
{
SDL_SetError( "Haptic: %s - %s: %s", str,
122
123
DXGetErrorString(err),
DXGetErrorDescription(err));
124
125
126
}
127
128
129
130
/*
* Checks to see if two GUID are the same.
*/
static int
131
DI_GUIDIsSame(const GUID * a, const GUID * b)
132
133
134
135
136
137
138
139
140
141
{
if (((a)->Data1 == (b)->Data1) &&
((a)->Data2 == (b)->Data2) &&
((a)->Data3 == (b)->Data3) &&
(SDL_strcmp((a)->Data4, (b)->Data4)==0))
return 1;
return 0;
}
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
/*
* Initializes the haptic subsystem.
*/
int
SDL_SYS_HapticInit(void)
{
HRESULT ret;
if (dinput != NULL) { /* Already open. */
SDL_SetError("Haptic: SubSystem already open.");
return -1;
}
/* Clear all the memory. */
SDL_memset(SDL_hapticlist, 0, sizeof(SDL_hapticlist));
SDL_numhaptics = 0;
ret = CoInitialize(NULL);
if (FAILED(ret)) {
DI_SetError("Coinitialize",ret);
return -1;
}
ret = CoCreateInstance(&CLSID_DirectInput, NULL, CLSCTX_INPROC_SERVER,
&IID_IDirectInput, &dinput);
if (FAILED(ret)) {
DI_SetError("CoCreateInstance",ret);
return -1;
}
/* Because we used CoCreateInstance, we need to Initialize it, first. */
ret = IDirectInput_Initialize(dinput, SDL_Instance, DIRECTINPUT_VERSION);
if (FAILED(ret)) {
DI_SetError("Initializing DirectInput device",ret);
return -1;
}
/* Look for haptic devices. */
ret = IDirectInput_EnumDevices( dinput,
182
0, /* Not sure if this is legal, but gets all devices. */
183
EnumHapticsCallback,
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
NULL, DIEDFL_FORCEFEEDBACK | DIEDFL_ATTACHEDONLY);
if (FAILED(ret)) {
DI_SetError("Enumerating DirectInput devices",ret);
return -1;
}
return SDL_numhaptics;
}
/*
* Callback to find the haptic devices.
*/
static BOOL CALLBACK
EnumHapticsCallback(const DIDEVICEINSTANCE * pdidInstance, VOID * pContext)
{
199
200
201
202
HRESULT ret;
LPDIRECTINPUTDEVICE device;
/* Copy the instance over, useful for creating devices. */
203
SDL_memcpy(&SDL_hapticlist[SDL_numhaptics].instance, pdidInstance,
204
sizeof(DIDEVICEINSTANCE));
205
206
/* Open the device */
207
ret = IDirectInput_CreateDevice( dinput, &pdidInstance->guidInstance,
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
&device, NULL );
if (FAILED(ret)) {
/* DI_SetError("Creating DirectInput device",ret); */
return DIENUM_CONTINUE;
}
/* Get capabilities. */
SDL_hapticlist[SDL_numhaptics].capabilities.dwSize = sizeof(DIDEVCAPS);
ret = IDirectInputDevice_GetCapabilities( device,
&SDL_hapticlist[SDL_numhaptics].capabilities );
if (FAILED(ret)) {
/* DI_SetError("Getting device capabilities",ret); */
IDirectInputDevice_Release(device);
return DIENUM_CONTINUE;
}
/* Close up device and count it. */
IDirectInputDevice_Release(device);
226
227
SDL_numhaptics++;
228
/* Watch out for hard limit. */
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
if (SDL_numhaptics >= MAX_HAPTICS)
return DIENUM_STOP;
return DIENUM_CONTINUE;
}
/*
* Return the name of a haptic device, does not need to be opened.
*/
const char *
SDL_SYS_HapticName(int index)
{
return SDL_hapticlist[index].instance.tszProductName;
}
/*
* Callback to get all supported effects.
*/
249
250
#define EFFECT_TEST(e,s) \
if (DI_GUIDIsSame(&pei->guid, &(e))) \
251
252
haptic->supported |= (s)
static BOOL CALLBACK
253
DI_EffectCallback(LPCDIEFFECTINFO pei, LPVOID pv)
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
{
/* Prepare the haptic device. */
SDL_Haptic *haptic = (SDL_Haptic*) pv;
/* Get supported. */
EFFECT_TEST(GUID_Spring, SDL_HAPTIC_SPRING);
EFFECT_TEST(GUID_Damper, SDL_HAPTIC_DAMPER);
EFFECT_TEST(GUID_Inertia, SDL_HAPTIC_INERTIA);
EFFECT_TEST(GUID_Friction, SDL_HAPTIC_FRICTION);
EFFECT_TEST(GUID_ConstantForce, SDL_HAPTIC_CONSTANT);
EFFECT_TEST(GUID_CustomForce, SDL_HAPTIC_CUSTOM);
EFFECT_TEST(GUID_Sine, SDL_HAPTIC_SINE);
EFFECT_TEST(GUID_Square, SDL_HAPTIC_SQUARE);
EFFECT_TEST(GUID_Triangle, SDL_HAPTIC_TRIANGLE);
EFFECT_TEST(GUID_SawtoothUp, SDL_HAPTIC_SAWTOOTHUP);
EFFECT_TEST(GUID_SawtoothDown, SDL_HAPTIC_SAWTOOTHDOWN);
EFFECT_TEST(GUID_RampForce, SDL_HAPTIC_RAMP);
/* Check for more. */
return DIENUM_CONTINUE;
}
277
278
279
280
281
282
/*
* Callback to get supported axes.
*/
static BOOL CALLBACK
DI_DeviceObjectCallback(LPCDIDEVICEOBJECTINSTANCE dev, LPVOID pvRef)
{
283
SDL_Haptic *haptic = (SDL_Haptic *) pvRef;
284
285
if ((dev->dwType & DIDFT_AXIS) && (dev->dwFlags & DIDOI_FFACTUATOR)) {
286
287
haptic->hwdata->axes[haptic->naxes] = dev->dwOfs;
288
289
290
291
292
293
294
295
296
297
298
299
haptic->naxes++;
/* Currently using the artificial limit of 3 axes. */
if (haptic->naxes >= 3) {
return DIENUM_STOP;
}
}
return DIENUM_CONTINUE;
}
300
301
302
303
304
305
306
/*
* Opens the haptic device from the file descriptor.
*
* Steps:
* - Open temporary DirectInputDevice interface.
* - Create DirectInputDevice2 interface.
* - Release DirectInputDevice interface.
307
* - Call SDL_SYS_HapticOpenFromDevice2
308
309
310
311
312
*/
static int
SDL_SYS_HapticOpenFromInstance(SDL_Haptic * haptic, DIDEVICEINSTANCE instance)
{
HRESULT ret;
313
int ret2;
314
315
316
317
318
319
320
321
322
323
324
325
LPDIRECTINPUTDEVICE device;
/* Allocate the hwdata */
haptic->hwdata = (struct haptic_hwdata *)
SDL_malloc(sizeof(*haptic->hwdata));
if (haptic->hwdata == NULL) {
SDL_OutOfMemory();
goto creat_err;
}
SDL_memset(haptic->hwdata, 0, sizeof(*haptic->hwdata));
/* Open the device */
326
327
ret = IDirectInput_CreateDevice( dinput, &instance.guidInstance,
&device, NULL );
328
329
330
331
332
333
334
335
if (FAILED(ret)) {
DI_SetError("Creating DirectInput device",ret);
goto creat_err;
}
/* Now get the IDirectInputDevice2 interface, instead. */
ret = IDirectInputDevice_QueryInterface( device,
&IID_IDirectInputDevice2,
336
(LPVOID *) &haptic->hwdata->device );
337
338
339
340
341
342
343
/* Done with the temporary one now. */
IDirectInputDevice_Release(device);
if (FAILED(ret)) {
DI_SetError("Querying DirectInput interface",ret);
goto creat_err;
}
344
345
346
347
348
349
350
351
352
353
354
355
356
357
ret2 = SDL_SYS_HapticOpenFromDevice2( haptic, haptic->hwdata->device );
if (ret2 < 0) {
goto query_err;
}
return 0;
query_err:
IDirectInputDevice2_Release(haptic->hwdata->device);
creat_err:
if (haptic->hwdata != NULL) {
SDL_free(haptic->hwdata);
haptic->hwdata = NULL;
}
358
return -1;
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
}
/*
* Opens the haptic device from the file descriptor.
*
* Steps:
* - Set cooperative level.
* - Set data format.
* - Acquire exclusiveness.
* - Reset actuators.
* - Get supported featuers.
*/
static int
SDL_SYS_HapticOpenFromDevice2(SDL_Haptic * haptic, LPDIRECTINPUTDEVICE2 device2)
{
HRESULT ret;
377
DIPROPDWORD dipdw;
378
379
380
381
/* We'll use the device2 from now on. */
haptic->hwdata->device = device2;
382
383
/* Grab it exclusively to use force feedback stuff. */
ret =IDirectInputDevice2_SetCooperativeLevel( haptic->hwdata->device,
384
SDL_HelperWindow,
385
386
387
388
389
390
DISCL_EXCLUSIVE | DISCL_BACKGROUND );
if (FAILED(ret)) {
DI_SetError("Setting cooperative level to exclusive",ret);
goto acquire_err;
}
391
392
393
394
395
/* Set data format. */
ret = IDirectInputDevice2_SetDataFormat( haptic->hwdata->device,
&c_dfDIJoystick2 );
if (FAILED(ret)) {
DI_SetError("Setting data format",ret);
396
goto acquire_err;
397
398
}
399
400
401
402
403
404
/* Get number of axes. */
ret = IDirectInputDevice2_EnumObjects( haptic->hwdata->device,
DI_DeviceObjectCallback,
haptic, DIDFT_AXIS );
if (FAILED(ret)) {
DI_SetError("Getting device axes",ret);
405
goto acquire_err;
406
407
}
408
409
410
411
/* Acquire the device. */
ret = IDirectInputDevice2_Acquire(haptic->hwdata->device);
if (FAILED(ret)) {
DI_SetError("Acquiring DirectInput device",ret);
412
goto acquire_err;
413
414
}
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
/* Reset all actuators - just in case. */
ret = IDirectInputDevice2_SendForceFeedbackCommand( haptic->hwdata->device,
DISFFC_RESET );
if (FAILED(ret)) {
DI_SetError("Resetting device",ret);
goto acquire_err;
}
/* Enabling actuators. */
ret = IDirectInputDevice2_SendForceFeedbackCommand( haptic->hwdata->device,
DISFFC_SETACTUATORSON );
if (FAILED(ret)) {
DI_SetError("Enabling actuators",ret);
goto acquire_err;
}
/* Get supported effects. */
432
433
ret = IDirectInputDevice2_EnumEffects( haptic->hwdata->device,
DI_EffectCallback, haptic, DIEFT_ALL );
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
if (FAILED(ret)) {
DI_SetError("Enumerating supported effects",ret);
goto acquire_err;
}
if (haptic->supported == 0) { /* Error since device supports nothing. */
SDL_SetError("Haptic: Internal error on finding supported effects.");
goto acquire_err;
}
/* Check autogain and autocenter. */
dipdw.diph.dwSize = sizeof(DIPROPDWORD);
dipdw.diph.dwHeaderSize = sizeof(DIPROPHEADER);
dipdw.diph.dwObj = 0;
dipdw.diph.dwHow = DIPH_DEVICE;
dipdw.dwData = 10000;
ret = IDirectInputDevice2_SetProperty( haptic->hwdata->device,
DIPROP_FFGAIN, &dipdw.diph );
451
if (!FAILED(ret)) { /* Gain is supported. */
452
453
haptic->supported |= SDL_HAPTIC_GAIN;
}
454
455
dipdw.diph.dwObj = 0;
dipdw.diph.dwHow = DIPH_DEVICE;
456
457
458
dipdw.dwData = DIPROPAUTOCENTER_OFF;
ret = IDirectInputDevice2_SetProperty( haptic->hwdata->device,
DIPROP_AUTOCENTER, &dipdw.diph );
459
if (!FAILED(ret)) { /* Autocenter is supported. */
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
haptic->supported |= SDL_HAPTIC_AUTOCENTER;
}
/* Check maximum effects. */
haptic->neffects = 128; /* TODO actually figure this out. */
haptic->nplaying = 128;
/* Prepare effects memory. */
haptic->effects = (struct haptic_effect *)
SDL_malloc(sizeof(struct haptic_effect) * haptic->neffects);
if (haptic->effects == NULL) {
SDL_OutOfMemory();
goto acquire_err;
}
/* Clear the memory */
SDL_memset(haptic->effects, 0,
sizeof(struct haptic_effect) * haptic->neffects);
return 0;
/* Error handling */
acquire_err:
IDirectInputDevice2_Unacquire(haptic->hwdata->device);
return -1;
}
/*
* Opens a haptic device for usage.
*/
int
SDL_SYS_HapticOpen(SDL_Haptic * haptic)
{
return SDL_SYS_HapticOpenFromInstance( haptic,
SDL_hapticlist[haptic->index].instance );
}
/*
* Opens a haptic device from first mouse it finds for usage.
*/
int
SDL_SYS_HapticMouse(void)
{
505
506
int i;
507
/* Grab the first mouse haptic device we find. */
508
for (i=0; i<SDL_numhaptics; i++) {
509
510
511
if (SDL_hapticlist[i].capabilities.dwDevType == DIDEVTYPE_MOUSE ) {
return i;
}
512
}
513
514
515
516
517
518
519
520
521
522
523
return -1;
}
/*
* Checks to see if a joystick has haptic features.
*/
int
SDL_SYS_JoystickIsHaptic(SDL_Joystick * joystick)
{
524
525
526
527
if (joystick->hwdata->Capabilities.dwFlags & DIDC_FORCEFEEDBACK) {
return SDL_TRUE;
}
528
529
530
531
532
533
534
535
536
537
return SDL_FALSE;
}
/*
* Checks to see if the haptic device and joystick and in reality the same.
*/
int
SDL_SYS_JoystickSameHaptic(SDL_Haptic * haptic, SDL_Joystick * joystick)
{
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
HRESULT ret;
DIDEVICEINSTANCE hap_instance, joy_instance;
/* Get the device instances. */
ret = IDirectInputDevice2_GetDeviceInfo( haptic->hwdata->device,
&hap_instance );
if (FAILED(ret)) {
return 0;
}
ret = IDirectInputDevice2_GetDeviceInfo( joystick->hwdata->InputDevice,
&joy_instance );
if (FAILED(ret)) {
return 0;
}
if (DI_GUIDIsSame(&hap_instance.guidInstance, &joy_instance.guidInstance))
return 1;
556
557
558
559
560
561
562
563
564
565
return 0;
}
/*
* Opens a SDL_Haptic from a SDL_Joystick.
*/
int
SDL_SYS_HapticOpenFromJoystick(SDL_Haptic * haptic, SDL_Joystick * joystick)
{
566
567
568
569
570
571
572
573
574
575
576
int ret;
ret = SDL_SYS_HapticOpenFromDevice2( haptic, joystick->hwdata->InputDevice );
if (ret < 0) {
return -1;
}
/* It's using the joystick device. */
haptic->hwdata->is_joystick = 1;
return 0;
577
578
579
580
581
582
583
584
585
586
587
}
/*
* Closes the haptic device.
*/
void
SDL_SYS_HapticClose(SDL_Haptic * haptic)
{
if (haptic->hwdata) {
588
/* Free effects. */
589
SDL_free(haptic->effects);
590
haptic->effects = NULL;
591
592
593
594
haptic->neffects = 0;
/* Clean up */
IDirectInputDevice2_Unacquire(haptic->hwdata->device);
595
596
597
598
/* Only release if isn't grabbed by a joystick. */
if (haptic->hwdata->is_joystick == 0) {
IDirectInputDevice2_Release(haptic->hwdata->device);
}
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
/* Free */
SDL_free(haptic->hwdata);
haptic->hwdata = NULL;
}
}
/*
* Clean up after system specific haptic stuff
*/
void
SDL_SYS_HapticQuit(void)
{
IDirectInput_Release(dinput);
dinput = NULL;
}
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
/*
* Converts an SDL trigger button to an DIEFFECT trigger button.
*/
static DWORD
DIGetTriggerButton( Uint16 button )
{
DWORD dwTriggerButton;
dwTriggerButton = DIEB_NOTRIGGER;
if (button != 0) {
dwTriggerButton = DIJOFS_BUTTON(button - 1);
}
return dwTriggerButton;
}
636
637
638
639
/*
* Sets the direction.
*/
static int
640
SDL_SYS_SetDirection( DIEFFECT * effect, SDL_HapticDirection *dir, int naxes )
641
642
643
644
645
{
LONG *rglDir;
/* Handle no axes a part. */
if (naxes == 0) {
646
effect->dwFlags |= DIEFF_SPHERICAL; /* Set as default. */
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
effect->rglDirection = NULL;
return 0;
}
/* Has axes. */
rglDir = SDL_malloc( sizeof(LONG) * naxes );
if (rglDir == NULL) {
SDL_OutOfMemory();
return -1;
}
SDL_memset( rglDir, 0, sizeof(LONG) * naxes );
effect->rglDirection = rglDir;
switch (dir->type) {
case SDL_HAPTIC_POLAR:
662
effect->dwFlags |= DIEFF_POLAR;
663
664
665
rglDir[0] = dir->dir[0];
return 0;
case SDL_HAPTIC_CARTESIAN:
666
effect->dwFlags |= DIEFF_CARTESIAN;
667
rglDir[0] = dir->dir[0];
668
669
670
671
if (naxes > 1)
rglDir[1] = dir->dir[1];
if (naxes > 2)
rglDir[2] = dir->dir[2];
672
673
return 0;
case SDL_HAPTIC_SPHERICAL:
674
effect->dwFlags |= DIEFF_SPHERICAL;
675
rglDir[0] = dir->dir[0];
676
677
678
679
if (naxes > 1)
rglDir[1] = dir->dir[1];
if (naxes > 2)
rglDir[2] = dir->dir[2];
680
681
682
683
684
685
686
687
return 0;
default:
SDL_SetError("Haptic: Unknown direction type.");
return -1;
}
}
688
#define CONVERT(x) (((x) > 0x7FFF) ? 10000 : ((x)*10000) / 0x7FFF)
689
/*
690
* Creates the DIEFFECT from a SDL_HapticEffect.
691
692
*/
static int
693
SDL_SYS_ToDIEFFECT( SDL_Haptic * haptic, DIEFFECT * dest, SDL_HapticEffect * src )
694
695
{
int i;
696
697
698
699
700
701
DICONSTANTFORCE *constant;
DIPERIODIC *periodic;
DICONDITION *condition; /* Actually an array of conditions - one per axis. */
DIRAMPFORCE *ramp;
DICUSTOMFORCE *custom;
DIENVELOPE *envelope;
702
703
704
705
706
707
708
709
SDL_HapticConstant *hap_constant;
SDL_HapticPeriodic *hap_periodic;
SDL_HapticCondition *hap_condition;
SDL_HapticRamp *hap_ramp;
SDL_HapticCustom *hap_custom;
DWORD *axes;
/* Set global stuff. */
710
711
SDL_memset(dest, 0, sizeof(DIEFFECT));
dest->dwSize = sizeof(DIEFFECT); /* Set the structure size. */
712
713
dest->dwSamplePeriod = 0; /* Not used by us. */
dest->dwGain = 10000; /* Gain is set globally, not locally. */
714
dest->dwFlags = DIEFF_OBJECTOFFSETS; /* Seems obligatory. */
715
716
/* Envelope. */
717
envelope = SDL_malloc( sizeof(DIENVELOPE) );
718
719
720
721
if (envelope == NULL) {
SDL_OutOfMemory();
return -1;
}
722
SDL_memset(envelope, 0, sizeof(DIENVELOPE));
723
dest->lpEnvelope = envelope;
724
envelope->dwSize = sizeof(DIENVELOPE); /* Always should be this. */
725
726
727
728
729
730
731
732
733
/* Axes. */
dest->cAxes = haptic->naxes;
if (dest->cAxes > 0) {
axes = SDL_malloc(sizeof(DWORD) * dest->cAxes);
if (axes == NULL) {
SDL_OutOfMemory();
return -1;
}
734
axes[0] = haptic->hwdata->axes[0]; /* Always at least one axis. */
735
if (dest->cAxes > 1) {
736
axes[1] = haptic->hwdata->axes[1];
737
738
}
if (dest->cAxes > 2) {
739
axes[2] = haptic->hwdata->axes[2];
740
741
742
743
744
745
746
747
748
}
dest->rgdwAxes = axes;
}
/* The big type handling switch, even bigger then linux's version. */
switch (src->type) {
case SDL_HAPTIC_CONSTANT:
hap_constant = &src->constant;
749
constant = SDL_malloc( sizeof(DICONSTANTFORCE) );
750
751
752
753
if (constant == NULL) {
SDL_OutOfMemory();
return -1;
}
754
SDL_memset(constant, 0, sizeof(DICONSTANTFORCE));
755
756
757
/* Specifics */
constant->lMagnitude = CONVERT(hap_constant->level);
758
dest->cbTypeSpecificParams = sizeof(DICONSTANTFORCE);
759
760
761
762
dest->lpvTypeSpecificParams = constant;
/* Generics */
dest->dwDuration = hap_constant->length * 1000; /* In microseconds. */
763
dest->dwTriggerButton = DIGetTriggerButton(hap_constant->button);
764
765
766
767
768
769
770
771
772
dest->dwTriggerRepeatInterval = hap_constant->interval;
dest->dwStartDelay = hap_constant->delay * 1000; /* In microseconds. */
/* Direction. */
if (SDL_SYS_SetDirection(dest, &hap_constant->direction, dest->cAxes) < 0) {
return -1;
}
/* Envelope */
773
774
775
776
777
778
779
780
781
782
if ((hap_constant->attack_length==0) && (hap_constant->fade_length==0)) {
SDL_free(dest->lpEnvelope);
dest->lpEnvelope = NULL;
}
else {
envelope->dwAttackLevel = CONVERT(hap_constant->attack_level);
envelope->dwAttackTime = hap_constant->attack_length * 1000;
envelope->dwFadeLevel = CONVERT(hap_constant->fade_level);
envelope->dwFadeTime = hap_constant->fade_length * 1000;
}
783
784
785
786
787
788
789
790
791
break;
case SDL_HAPTIC_SINE:
case SDL_HAPTIC_SQUARE:
case SDL_HAPTIC_TRIANGLE:
case SDL_HAPTIC_SAWTOOTHUP:
case SDL_HAPTIC_SAWTOOTHDOWN:
hap_periodic = &src->periodic;
792
periodic = SDL_malloc(sizeof(DIPERIODIC));
793
794
795
796
if (periodic == NULL) {
SDL_OutOfMemory();
return -1;
}
797
SDL_memset(periodic, 0, sizeof(DIPERIODIC));
798
799
800
801
802
803
/* Specifics */
periodic->dwMagnitude = CONVERT(hap_periodic->magnitude);
periodic->lOffset = CONVERT(hap_periodic->offset);
periodic->dwPhase = hap_periodic->phase;
periodic->dwPeriod = hap_periodic->period * 1000;
804
dest->cbTypeSpecificParams = sizeof(DIPERIODIC);
805
806
807
808
dest->lpvTypeSpecificParams = periodic;
/* Generics */
dest->dwDuration = hap_periodic->length * 1000; /* In microseconds. */
809
dest->dwTriggerButton = DIGetTriggerButton(hap_periodic->button);
810
811
812
813
814
815
816
817
818
dest->dwTriggerRepeatInterval = hap_periodic->interval;
dest->dwStartDelay = hap_periodic->delay * 1000; /* In microseconds. */
/* Direction. */
if (SDL_SYS_SetDirection(dest, &hap_periodic->direction, dest->cAxes) < 0) {
return -1;
}
/* Envelope */
819
820
821
822
823
824
825
826
827
828
if ((hap_periodic->attack_length==0) && (hap_periodic->fade_length==0)) {
SDL_free(dest->lpEnvelope);
dest->lpEnvelope = NULL;
}
else {
envelope->dwAttackLevel = CONVERT(hap_periodic->attack_level);
envelope->dwAttackTime = hap_periodic->attack_length * 1000;
envelope->dwFadeLevel = CONVERT(hap_periodic->fade_level);
envelope->dwFadeTime = hap_periodic->fade_length * 1000;
}
829
830
831
832
833
834
835
836
break;
case SDL_HAPTIC_SPRING:
case SDL_HAPTIC_DAMPER:
case SDL_HAPTIC_INERTIA:
case SDL_HAPTIC_FRICTION:
hap_condition = &src->condition;
837
condition = SDL_malloc(sizeof(DICONDITION) * dest->cAxes);
838
839
840
841
if (condition == NULL) {
SDL_OutOfMemory();
return -1;
}
842
SDL_memset(condition, 0, sizeof(DICONDITION));
843
844
/* Specifics */
845
for (i=0; i<(int)dest->cAxes; i++) {
846
847
848
849
850
851
852
condition[i].lOffset = CONVERT(hap_condition->center[i]);
condition[i].lPositiveCoefficient = CONVERT(hap_condition->right_coeff[i]);
condition[i].lNegativeCoefficient = CONVERT(hap_condition->left_coeff[i]);
condition[i].dwPositiveSaturation = CONVERT(hap_condition->right_sat[i]);
condition[i].dwNegativeSaturation = CONVERT(hap_condition->left_sat[i]);
condition[i].lDeadBand = CONVERT(hap_condition->deadband[i]);
}
853
dest->cbTypeSpecificParams = sizeof(DICONDITION) * dest->cAxes;
854
855
856
857
dest->lpvTypeSpecificParams = condition;
/* Generics */
dest->dwDuration = hap_condition->length * 1000; /* In microseconds. */
858
dest->dwTriggerButton = DIGetTriggerButton(hap_condition->button);
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
dest->dwTriggerRepeatInterval = hap_condition->interval;
dest->dwStartDelay = hap_condition->delay * 1000; /* In microseconds. */
/* Direction. */
if (SDL_SYS_SetDirection(dest, &hap_condition->direction, dest->cAxes) < 0) {
return -1;
}
/* Envelope */
/* TODO Check is envelope actually used.
envelope->dwAttackLevel = CONVERT(hap_condition->attack_level);
envelope->dwAttackTime = hap_condition->attack_length * 1000;
envelope->dwFadeLevel = CONVERT(hap_condition->fade_level);
envelope->dwFadeTime = hap_condition->fade_length * 1000;
*/
break;
case SDL_HAPTIC_RAMP:
hap_ramp = &src->ramp;
879
ramp = SDL_malloc(sizeof(DIRAMPFORCE));
880
881
882
883
if (ramp == NULL) {
SDL_OutOfMemory();
return -1;
}
884
SDL_memset(ramp, 0, sizeof(DIRAMPFORCE));
885
886
887
888
/* Specifics */
ramp->lStart = CONVERT(hap_ramp->start);
ramp->lEnd = CONVERT(hap_ramp->end);
889
dest->cbTypeSpecificParams = sizeof(DIRAMPFORCE);
890
891
892
893
dest->lpvTypeSpecificParams = ramp;
/* Generics */
dest->dwDuration = hap_ramp->length * 1000; /* In microseconds. */
894
dest->dwTriggerButton = DIGetTriggerButton(hap_ramp->button);
895
896
897
898
899
900
901
902
903
dest->dwTriggerRepeatInterval = hap_ramp->interval;
dest->dwStartDelay = hap_ramp->delay * 1000; /* In microseconds. */
/* Direction. */
if (SDL_SYS_SetDirection(dest, &hap_ramp->direction, dest->cAxes) < 0) {
return -1;
}
/* Envelope */
904
905
906
907
908
909
910
911
912
913
if ((hap_ramp->attack_length==0) && (hap_ramp->fade_length==0)) {
SDL_free(dest->lpEnvelope);
dest->lpEnvelope = NULL;
}
else {
envelope->dwAttackLevel = CONVERT(hap_ramp->attack_level);
envelope->dwAttackTime = hap_ramp->attack_length * 1000;
envelope->dwFadeLevel = CONVERT(hap_ramp->fade_level);
envelope->dwFadeTime = hap_ramp->fade_length * 1000;
}
914
915
916
917
918
break;
case SDL_HAPTIC_CUSTOM:
hap_custom = &src->custom;
919
custom = SDL_malloc(sizeof(DICUSTOMFORCE));
920
921
922
923
if (custom == NULL) {
SDL_OutOfMemory();
return -1;
}
924
SDL_memset(custom, 0, sizeof(DICUSTOMFORCE));
925
926
927
928
929
930
931
932
933
/* Specifics */
custom->cChannels = hap_custom->channels;
custom->dwSamplePeriod = hap_custom->period * 1000;
custom->cSamples = hap_custom->samples;
custom->rglForceData = SDL_malloc(sizeof(LONG)*custom->cSamples*custom->cChannels);
for (i=0; i<hap_custom->samples*hap_custom->channels; i++) { /* Copy data. */
custom->rglForceData[i] = CONVERT(hap_custom->data[i]);
}
934
dest->cbTypeSpecificParams = sizeof(DICUSTOMFORCE);
935
936
937
938
dest->lpvTypeSpecificParams = custom;
/* Generics */
dest->dwDuration = hap_custom->length * 1000; /* In microseconds. */
939
dest->dwTriggerButton = DIGetTriggerButton(hap_custom->button);
940
941
942
943
944
945
946
947
948
dest->dwTriggerRepeatInterval = hap_custom->interval;
dest->dwStartDelay = hap_custom->delay * 1000; /* In microseconds. */
/* Direction. */
if (SDL_SYS_SetDirection(dest, &hap_custom->direction, dest->cAxes) < 0) {
return -1;
}
/* Envelope */
949
950
951
952
953
954
955
956
957
958
if ((hap_custom->attack_length==0) && (hap_custom->fade_length==0)) {
SDL_free(dest->lpEnvelope);
dest->lpEnvelope = NULL;
}
else {
envelope->dwAttackLevel = CONVERT(hap_custom->attack_level);
envelope->dwAttackTime = hap_custom->attack_length * 1000;
envelope->dwFadeLevel = CONVERT(hap_custom->fade_level);
envelope->dwFadeTime = hap_custom->fade_length * 1000;
}
959
960
961
962
963
964
965
966
967
968
969
970
971
972
break;
default:
SDL_SetError("Haptic: Unknown effect type.");
return -1;
}
return 0;
}
/*
973
* Frees an DIEFFECT allocated by SDL_SYS_ToDIEFFECT.
974
975
*/
static void
976
SDL_SYS_HapticFreeDIEFFECT( DIEFFECT * effect, int type )
977
{
978
DICUSTOMFORCE *custom;
979
980
981
982
983
984
985
986
987
988
989
if (effect->lpEnvelope != NULL) {
SDL_free(effect->lpEnvelope);
effect->lpEnvelope = NULL;
}
if (effect->rgdwAxes != NULL) {
SDL_free(effect->rgdwAxes);
effect->rgdwAxes = NULL;
}
if (effect->lpvTypeSpecificParams != NULL) {
if (type == SDL_HAPTIC_CUSTOM) { /* Must free the custom data. */
990
custom = (DICUSTOMFORCE*) effect->lpvTypeSpecificParams;
991
992
993
994
995
996
997
998
999
1000
SDL_free(custom->rglForceData);
custom->rglForceData = NULL;
}
SDL_free(effect->lpvTypeSpecificParams);
effect->lpvTypeSpecificParams = NULL;
}
if (effect->rglDirection != NULL) {
SDL_free(effect->rglDirection);
effect->rglDirection = NULL;
}