This repository has been archived by the owner on Feb 11, 2021. It is now read-only.
/
SDL_syshaptic.c
855 lines (691 loc) · 21.4 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
/*
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"
24
#ifdef SDL_HAPTIC_LINUX
25
26
27
#include "SDL_haptic.h"
#include "../SDL_syshaptic.h"
28
29
30
#include "SDL_joystick.h"
#include "../../joystick/SDL_sysjoystick.h" /* For the real SDL_Joystick */
#include "../../joystick/linux/SDL_sysjoystick_c.h" /* For joystick hwdata */
31
32
33
34
35
36
37
38
#include <unistd.h> /* close */
#include <linux/input.h>
#include <sys/ioctl.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <linux/limits.h>
39
#include <limits.h> /* INT_MAX */
40
#include <string.h>
41
#include <errno.h>
42
43
44
45
46
#include <math.h>
#ifndef M_PI
# define M_PI 3.14159265358979323846
#endif
47
48
49
50
51
#define MAX_HAPTICS 32
52
53
54
/*
* List of available haptic devices.
*/
55
56
57
58
59
60
static struct
{
char *fname;
SDL_Haptic *haptic;
} SDL_hapticlist[MAX_HAPTICS];
61
62
63
64
/*
* Haptic system hardware data.
*/
65
66
67
struct haptic_hwdata
{
int fd;
68
char *fname; /* Points to the name in SDL_hapticlist. */
69
70
71
};
72
73
74
75
76
/*
* Haptic system effect data.
*/
struct haptic_hweffect
{
77
struct ff_effect effect; /* The linux kernel effect structure. */
78
79
80
};
81
82
83
84
85
#define test_bit(nr, addr) \
(((1UL << ((nr) & 31)) & (((const unsigned int *) addr)[(nr) >> 5])) != 0)
#define EV_TEST(ev,f) \
if (test_bit((ev), features)) ret |= (f);
86
87
88
89
/*
* Test whether a device has haptic properties.
* Returns available properties or 0 if there are none.
*/
90
91
92
93
94
95
static int
EV_IsHaptic(int fd)
{
unsigned int ret;
unsigned long features[1 + FF_MAX/sizeof(unsigned long)];
96
/* Ask device for what it has. */
97
ret = 0;
98
if (ioctl(fd, EVIOCGBIT(EV_FF, sizeof(features)), features) < 0) {
99
SDL_SetError("Haptic: Unable to get device's features: %s", strerror(errno));
100
101
return -1;
}
102
103
/* Convert supported features to SDL_HAPTIC platform-neutral features. */
104
EV_TEST(FF_CONSTANT, SDL_HAPTIC_CONSTANT);
105
106
107
108
109
EV_TEST(FF_PERIODIC, SDL_HAPTIC_SINE |
SDL_HAPTIC_SQUARE |
SDL_HAPTIC_TRIANGLE |
SDL_HAPTIC_SAWTOOTHUP |
SDL_HAPTIC_SAWTOOTHDOWN);
110
111
112
113
114
EV_TEST(FF_RAMP, SDL_HAPTIC_RAMP);
EV_TEST(FF_SPRING, SDL_HAPTIC_SPRING);
EV_TEST(FF_FRICTION, SDL_HAPTIC_FRICTION);
EV_TEST(FF_DAMPER, SDL_HAPTIC_DAMPER);
EV_TEST(FF_INERTIA, SDL_HAPTIC_INERTIA);
115
EV_TEST(FF_CUSTOM, SDL_HAPTIC_CUSTOM);
116
117
118
EV_TEST(FF_GAIN, SDL_HAPTIC_GAIN);
EV_TEST(FF_AUTOCENTER, SDL_HAPTIC_AUTOCENTER);
119
/* Return what it supports. */
120
121
122
return ret;
}
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
/*
* Tests whether a device is a mouse or not.
*/
static int
EV_IsMouse(int fd)
{
unsigned long argp[40];
/* Ask for supported features. */
if (ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(argp)), argp) < 0) {
return -1;
}
/* Currently we only test for BTN_MOUSE which can give fake positives. */
if (test_bit(BTN_MOUSE,argp) != 0) {
return 1;
}
return 0;
}
145
146
147
/*
* Initializes the haptic subsystem by finding available devices.
*/
148
149
150
151
152
153
154
155
156
157
158
159
160
161
int
SDL_SYS_HapticInit(void)
{
const char joydev_pattern[] = "/dev/input/event%d";
dev_t dev_nums[MAX_HAPTICS];
char path[PATH_MAX];
struct stat sb;
int fd;
int i, j, k;
int duplicate;
int numhaptics;
numhaptics = 0;
162
163
164
165
/*
* Limit amount of checks to MAX_HAPTICS since we may or may not have
* permission to some or all devices.
*/
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
i = 0;
for (j = 0; j < MAX_HAPTICS; ++j) {
snprintf(path, PATH_MAX, joydev_pattern, i++);
/* check to see if file exists */
if (stat(path,&sb) != 0)
break;
/* check for duplicates */
duplicate = 0;
for (k = 0; (k < numhaptics) && !duplicate; ++k) {
if (sb.st_rdev == dev_nums[k]) {
duplicate = 1;
}
}
if (duplicate) {
continue;
}
/* try to open */
fd = open(path, O_RDWR, 0);
if (fd < 0) continue;
#ifdef DEBUG_INPUT_EVENTS
printf("Checking %s\n", path);
#endif
/* see if it works */
195
if (EV_IsHaptic(fd) > 0) {
196
197
198
199
200
201
202
203
204
205
206
207
SDL_hapticlist[numhaptics].fname = SDL_strdup(path);
SDL_hapticlist[numhaptics].haptic = NULL;
dev_nums[numhaptics] = sb.st_rdev;
++numhaptics;
}
close(fd);
}
return numhaptics;
}
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
/*
* Gets the name from a file descriptor.
*/
static const char *
SDL_SYS_HapticNameFromFD(int fd)
{
static char namebuf[128];
/* We use the evdev name ioctl. */
if (ioctl(fd, EVIOCGNAME(sizeof(namebuf)), namebuf) <= 0) {
return NULL;
}
return namebuf;
}
225
226
227
/*
* Return the name of a haptic device, does not need to be opened.
*/
228
229
230
231
const char *
SDL_SYS_HapticName(int index)
{
int fd;
232
const char *name;
233
234
/* Open the haptic device. */
235
236
name = NULL;
fd = open(SDL_hapticlist[index].fname, O_RDONLY, 0);
237
238
if (fd >= 0) {
239
240
241
name = SDL_SYS_HapticNameFromFD(fd);
if (name==NULL) {
242
/* No name found, return device character device */
243
244
245
246
247
248
249
250
251
name = SDL_hapticlist[index].fname;
}
}
close(fd);
return name;
}
252
/*
253
* Opens the haptic device from the file descriptor.
254
*/
255
256
static int
SDL_SYS_HapticOpenFromFD(SDL_Haptic * haptic, int fd)
257
{
258
259
const char *name;
260
261
/* Allocate the hwdata */
haptic->hwdata = (struct haptic_hwdata *)
262
SDL_malloc(sizeof(*haptic->hwdata));
263
264
if (haptic->hwdata == NULL) {
SDL_OutOfMemory();
265
goto open_err;
266
267
}
SDL_memset(haptic->hwdata, 0, sizeof(*haptic->hwdata));
268
269
/* Set the data. */
270
haptic->hwdata->fd = fd;
271
haptic->supported = EV_IsHaptic(fd);
272
haptic->naxes = 2; /* Hardcoded for now, not sure if it's possible to find out. */
273
274
275
/* Set the effects */
if (ioctl(fd, EVIOCGEFFECTS, &haptic->neffects) < 0) {
276
SDL_SetError("Haptic: Unable to query device memory: %s", strerror(errno));
277
278
goto open_err;
}
279
haptic->nplaying = haptic->neffects; /* Linux makes no distinction. */
280
281
282
283
284
285
haptic->effects = (struct haptic_effect *)
SDL_malloc(sizeof(struct haptic_effect) * haptic->neffects);
if (haptic->effects == NULL) {
SDL_OutOfMemory();
goto open_err;
}
286
287
288
/* Clear the memory */
SDL_memset(haptic->effects, 0,
sizeof(struct haptic_effect) * haptic->neffects);
289
290
return 0;
291
292
293
294
295
296
297
298
299
/* Error handling */
open_err:
close(fd);
if (haptic->hwdata != NULL) {
free(haptic->hwdata);
haptic->hwdata = NULL;
}
return -1;
300
301
302
}
303
304
305
306
307
308
309
/*
* Opens a haptic device for usage.
*/
int
SDL_SYS_HapticOpen(SDL_Haptic * haptic)
{
int fd;
310
int ret;
311
312
313
314
/* Open the character device */
fd = open(SDL_hapticlist[haptic->index].fname, O_RDWR, 0);
if (fd < 0) {
315
SDL_SetError("Haptic: Unable to open %s: %s",
316
SDL_hapticlist[haptic->index], strerror(errno));
317
318
return -1;
}
319
320
321
322
323
324
325
326
327
328
/* Try to create the haptic. */
ret = SDL_SYS_HapticOpenFromFD(haptic,fd); /* Already closes on error. */
if (ret < 0) {
return -1;
}
/* Set the fname. */
haptic->hwdata->fname = SDL_hapticlist[haptic->index].fname;
return 0;
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
}
/*
* Opens a haptic device from first mouse it finds for usage.
*/
int
SDL_SYS_HapticMouse(void)
{
int fd;
int i;
for (i=0; i<SDL_numhaptics; i++) {
/* Open the device. */
fd = open(SDL_hapticlist[i].fname, O_RDWR, 0);
if (fd < 0) {
346
SDL_SetError("Haptic: Unable to open %s: %s",
347
348
349
350
351
352
353
354
355
356
357
358
359
360
SDL_hapticlist[i], strerror(errno));
return -1;
}
if (EV_IsMouse(fd)) {
close(fd);
return i;
}
close(fd);
}
return -1;
}
361
362
363
364
365
366
367
368
/*
* Checks to see if a joystick has haptic features.
*/
int
SDL_SYS_JoystickIsHaptic(SDL_Joystick * joystick)
{
369
370
371
372
373
374
375
376
377
378
return EV_IsHaptic(joystick->hwdata->fd);
}
/*
* Checks to see if the haptic device and joystick and in reality the same.
*/
int
SDL_SYS_JoystickSameHaptic(SDL_Haptic * haptic, SDL_Joystick * joystick)
{
379
380
381
/* We are assuming linux is using evdev which should trump the old
* joystick methods. */
if (SDL_strcmp(joystick->hwdata->fname,haptic->hwdata->fname)==0) {
382
return 1;
383
}
384
385
386
387
388
389
390
391
392
393
return 0;
}
/*
* Opens a SDL_Haptic from a SDL_Joystick.
*/
int
SDL_SYS_HapticOpenFromJoystick(SDL_Haptic * haptic, SDL_Joystick * joystick)
{
394
int i;
395
int fd;
396
397
398
399
400
401
402
403
404
405
406
int ret;
/* Find the joystick in the haptic list. */
for (i=0; i<MAX_HAPTICS; i++) {
if (SDL_hapticlist[i].fname != NULL) {
if (SDL_strcmp(SDL_hapticlist[i].fname, joystick->hwdata->fname)==0) {
haptic->index = i;
}
}
}
407
fd = open(joystick->hwdata->fname, O_RDWR, 0);
408
409
410
411
412
413
414
ret = SDL_SYS_HapticOpenFromFD(haptic,fd); /* Already closes on error. */
if (ret < 0) {
return -1;
}
haptic->hwdata->fname = SDL_hapticlist[haptic->index].fname;
return 0;
415
416
417
}
418
419
420
421
422
423
/*
* Closes the haptic device.
*/
void
SDL_SYS_HapticClose(SDL_Haptic * haptic)
{
424
425
426
427
428
429
430
if (haptic->hwdata) {
/* Clean up */
close(haptic->hwdata->fd);
/* Free */
SDL_free(haptic->hwdata);
431
SDL_free(haptic->effects);
432
}
433
434
435
/* Clear the rest. */
SDL_memset(haptic, 0, sizeof(SDL_Haptic));
436
437
438
}
439
440
441
/*
* Clean up after system specific haptic stuff
*/
442
443
444
445
446
447
448
449
450
451
452
void
SDL_SYS_HapticQuit(void)
{
int i;
for (i=0; SDL_hapticlist[i].fname != NULL; i++) {
SDL_free(SDL_hapticlist[i].fname);
}
SDL_hapticlist[0].fname = NULL;
}
453
454
455
456
457
458
459
/*
* Returns the ff_effect usable direction from a SDL_HapticDirection.
*/
static Uint16
SDL_SYS_ToDirection( SDL_HapticDirection * dir )
{
Uint32 tmp;
460
float f; /* Ideally we'd use fixed point math instead of floats... */
461
462
463
switch (dir->type) {
case SDL_HAPTIC_POLAR:
464
465
/* Linux directions are inverted. */
tmp = (((18000 + dir->dir[0]) % 36000) * 0xFFFF) / 36000;
466
return (Uint16) tmp;
467
468
case SDL_HAPTIC_CARTESIAN:
469
/* We must invert "x" and "y" to go clockwise. */
470
471
472
473
f = atan2(dir->dir[0], dir->dir[1]);
tmp = (int)(f*18000./M_PI) % 36000;
tmp = (tmp * 0xFFFF) / 36000;
return (Uint16) tmp;
474
475
476
477
478
479
case SDL_HAPTIC_SPHERICAL:
tmp = (36000 - dir->dir[0]) + 27000; /* Convert to polars */
tmp = (((18000 + tmp) % 36000) * 0xFFFF) / 36000;
return (Uint16) tmp;
480
default:
481
SDL_SetError("Haptic: Unsupported direction type.");
482
483
484
485
486
487
return -1;
}
return 0;
}
488
#define CLAMP(x) (((x) > 32767) ? 32767 : x)
489
490
/*
* Initializes the linux effect struct from a haptic_effect.
491
* Values above 32767 (for unsigned) are unspecified so we must clamp.
492
493
*/
static int
494
SDL_SYS_ToFFEffect( struct ff_effect * dest, SDL_HapticEffect * src )
495
{
496
Uint32 tmp;
497
498
SDL_HapticConstant *constant;
SDL_HapticPeriodic *periodic;
499
500
SDL_HapticCondition *condition;
SDL_HapticRamp *ramp;
501
502
/* Clear up */
503
SDL_memset(dest, 0, sizeof(struct ff_effect));
504
505
switch (src->type) {
506
case SDL_HAPTIC_CONSTANT:
507
508
509
constant = &src->constant;
/* Header */
510
dest->type = FF_CONSTANT;
511
dest->direction = SDL_SYS_ToDirection(&constant->direction);
512
if (dest->direction < 0) return -1;
513
514
/* Replay */
515
516
dest->replay.length = CLAMP(constant->length);
dest->replay.delay = CLAMP(constant->delay);
517
518
/* Trigger */
519
520
dest->trigger.button = CLAMP(constant->button);
dest->trigger.interval = CLAMP(constant->interval);
521
522
523
524
525
/* Constant */
dest->u.constant.level = constant->level;
/* Envelope */
526
527
528
529
dest->u.constant.envelope.attack_length = CLAMP(constant->attack_length);
dest->u.constant.envelope.attack_level = CLAMP(constant->attack_level);
dest->u.constant.envelope.fade_length = CLAMP(constant->fade_length);
dest->u.constant.envelope.fade_level = CLAMP(constant->fade_level);
530
531
532
break;
533
534
535
536
537
case SDL_HAPTIC_SINE:
case SDL_HAPTIC_SQUARE:
case SDL_HAPTIC_TRIANGLE:
case SDL_HAPTIC_SAWTOOTHUP:
case SDL_HAPTIC_SAWTOOTHDOWN:
538
539
540
541
periodic = &src->periodic;
/* Header */
dest->type = FF_PERIODIC;
542
dest->direction = SDL_SYS_ToDirection(&periodic->direction);
543
if (dest->direction < 0) return -1;
544
545
/* Replay */
546
547
dest->replay.length = CLAMP(periodic->length);
dest->replay.delay = CLAMP(periodic->delay);
548
549
/* Trigger */
550
551
dest->trigger.button = CLAMP(periodic->button);
dest->trigger.interval = CLAMP(periodic->interval);
552
553
554
555
556
557
558
559
560
561
562
563
/* Periodic */
if (periodic->type == SDL_HAPTIC_SINE)
dest->u.periodic.waveform = FF_SINE;
else if (periodic->type == SDL_HAPTIC_SQUARE)
dest->u.periodic.waveform = FF_SQUARE;
else if (periodic->type == SDL_HAPTIC_TRIANGLE)
dest->u.periodic.waveform = FF_TRIANGLE;
else if (periodic->type == SDL_HAPTIC_SAWTOOTHUP)
dest->u.periodic.waveform = FF_SAW_UP;
else if (periodic->type == SDL_HAPTIC_SAWTOOTHDOWN)
dest->u.periodic.waveform = FF_SAW_DOWN;
564
dest->u.periodic.period = CLAMP(periodic->period);
565
566
dest->u.periodic.magnitude = periodic->magnitude;
dest->u.periodic.offset = periodic->offset;
567
568
569
/* Phase is calculated based of offset from period and then clamped. */
tmp = ((periodic->phase % 36000) * dest->u.periodic.period) / 36000;
dest->u.periodic.phase = CLAMP(tmp);
570
571
/* Envelope */
572
573
574
575
dest->u.periodic.envelope.attack_length = CLAMP(periodic->attack_length);
dest->u.periodic.envelope.attack_level = CLAMP(periodic->attack_level);
dest->u.periodic.envelope.fade_length = CLAMP(periodic->fade_length);
dest->u.periodic.envelope.fade_level = CLAMP(periodic->fade_level);
576
577
578
break;
579
580
581
582
583
584
585
case SDL_HAPTIC_SPRING:
case SDL_HAPTIC_DAMPER:
case SDL_HAPTIC_INERTIA:
case SDL_HAPTIC_FRICTION:
condition = &src->condition;
/* Header */
586
if (condition->type == SDL_HAPTIC_SPRING)
587
dest->type = FF_SPRING;
588
else if (condition->type == SDL_HAPTIC_DAMPER)
589
dest->type = FF_DAMPER;
590
else if (condition->type == SDL_HAPTIC_INERTIA)
591
dest->type = FF_INERTIA;
592
else if (condition->type == SDL_HAPTIC_FRICTION)
593
dest->type = FF_FRICTION;
594
dest->direction = 0; /* Handled by the condition-specifics. */
595
596
597
598
599
600
601
602
603
/* Replay */
dest->replay.length = CLAMP(condition->length);
dest->replay.delay = CLAMP(condition->delay);
/* Trigger */
dest->trigger.button = CLAMP(condition->button);
dest->trigger.interval = CLAMP(condition->interval);
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
/* Condition */
/* X axis */
dest->u.condition[0].right_saturation = CLAMP(condition->right_sat[0]);
dest->u.condition[0].left_saturation = CLAMP(condition->left_sat[0]);
dest->u.condition[0].right_coeff = condition->right_coeff[0];
dest->u.condition[0].left_coeff = condition->left_coeff[0];
dest->u.condition[0].deadband = CLAMP(condition->deadband[0]);
dest->u.condition[0].center = condition->center[0];
/* Y axis */
dest->u.condition[1].right_saturation = CLAMP(condition->right_sat[1]);
dest->u.condition[1].left_saturation = CLAMP(condition->left_sat[1]);
dest->u.condition[1].right_coeff = condition->right_coeff[1];
dest->u.condition[1].left_coeff = condition->left_coeff[1];
dest->u.condition[1].deadband = CLAMP(condition->deadband[1]);
dest->u.condition[1].center = condition->center[1];
619
620
621
622
623
624
625
626
break;
case SDL_HAPTIC_RAMP:
ramp = &src->ramp;
/* Header */
dest->type = FF_RAMP;
627
dest->direction = SDL_SYS_ToDirection(&ramp->direction);
628
if (dest->direction < 0) return -1;
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
/* Replay */
dest->replay.length = CLAMP(ramp->length);
dest->replay.delay = CLAMP(ramp->delay);
/* Trigger */
dest->trigger.button = CLAMP(ramp->button);
dest->trigger.interval = CLAMP(ramp->interval);
/* Ramp */
dest->u.ramp.start_level = ramp->start;
dest->u.ramp.end_level = ramp->end;
/* Envelope */
dest->u.ramp.envelope.attack_length = CLAMP(ramp->attack_length);
dest->u.ramp.envelope.attack_level = CLAMP(ramp->attack_level);
dest->u.ramp.envelope.fade_length = CLAMP(ramp->fade_length);
dest->u.ramp.envelope.fade_level = CLAMP(ramp->fade_level);
break;
651
default:
652
SDL_SetError("Haptic: Unknown effect type.");
653
654
655
656
657
658
return -1;
}
return 0;
}
659
660
661
662
663
/*
* Creates a new haptic effect.
*/
int
664
665
SDL_SYS_HapticNewEffect(SDL_Haptic * haptic, struct haptic_effect * effect,
SDL_HapticEffect * base)
666
{
667
668
struct ff_effect * linux_effect;
669
670
671
672
673
674
675
676
677
/* Allocate the hardware effect */
effect->hweffect = (struct haptic_hweffect *)
SDL_malloc(sizeof(struct haptic_hweffect));
if (effect->hweffect == NULL) {
SDL_OutOfMemory();
return -1;
}
/* Prepare the ff_effect */
678
679
linux_effect = &effect->hweffect->effect;
if (SDL_SYS_ToFFEffect( linux_effect, base ) != 0) {
680
goto new_effect_err;
681
}
682
linux_effect->id = -1; /* Have the kernel give it an id */
683
684
/* Upload the effect */
685
if (ioctl(haptic->hwdata->fd, EVIOCSFF, linux_effect) < 0) {
686
SDL_SetError("Haptic: Error uploading effect to the device: %s", strerror(errno));
687
goto new_effect_err;
688
689
690
}
return 0;
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
new_effect_err:
free(effect->hweffect);
effect->hweffect = NULL;
return -1;
}
/*
* Updates an effect.
*
* Note: Dynamically updating the direction can in some cases force
* the effect to restart and run once.
*/
int SDL_SYS_HapticUpdateEffect(SDL_Haptic * haptic,
struct haptic_effect * effect, SDL_HapticEffect * data)
{
struct ff_effect linux_effect;
/* Create the new effect */
if (SDL_SYS_ToFFEffect( &linux_effect, data ) != 0) {
return -1;
}
linux_effect.id = effect->hweffect->effect.id;
/* See if it can be uploaded. */
if (ioctl(haptic->hwdata->fd, EVIOCSFF, &linux_effect) < 0) {
718
SDL_SetError("Haptic: Error updating the effect: %s", strerror(errno));
719
720
721
722
723
724
725
return -1;
}
/* Copy the new effect into memory. */
SDL_memcpy( &effect->hweffect->effect, &linux_effect, sizeof(struct ff_effect) );
return effect->hweffect->effect.id;
726
727
728
729
730
731
732
}
/*
* Runs an effect.
*/
int
733
734
SDL_SYS_HapticRunEffect(SDL_Haptic * haptic, struct haptic_effect * effect,
Uint32 iterations)
735
736
737
738
739
740
{
struct input_event run;
/* Prepare to run the effect */
run.type = EV_FF;
run.code = effect->hweffect->effect.id;
741
run.value = (iterations > INT_MAX) ? INT_MAX : iterations;
742
743
if (write(haptic->hwdata->fd, (const void*) &run, sizeof(run)) < 0) {
744
SDL_SetError("Haptic: Unable to run the effect: %s", strerror(errno));
745
746
747
748
749
750
751
return -1;
}
return 0;
}
752
753
754
755
756
757
758
759
760
761
762
763
764
/*
* Stops an effect.
*/
int
SDL_SYS_HapticStopEffect(SDL_Haptic * haptic, struct haptic_effect * effect)
{
struct input_event stop;
stop.type = EV_FF;
stop.code = effect->hweffect->effect.id;
stop.value = 0;
if (write(haptic->hwdata->fd, (const void*) &stop, sizeof(stop)) < 0) {
765
SDL_SetError("Haptic: Unable to stop the effect: %s", strerror(errno));
766
767
768
769
770
771
772
return -1;
}
return 0;
}
773
/*
774
* Frees the effect.
775
776
777
778
779
*/
void
SDL_SYS_HapticDestroyEffect(SDL_Haptic * haptic, struct haptic_effect * effect)
{
if (ioctl(haptic->hwdata->fd, EVIOCRMFF, effect->hweffect->effect.id) < 0) {
780
SDL_SetError("Haptic: Error removing the effect from the device: %s",
781
strerror(errno));
782
783
784
}
SDL_free(effect->hweffect);
effect->hweffect = NULL;
785
786
}
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
/*
* Gets the status of a haptic effect.
*/
int
SDL_SYS_HapticGetEffectStatus(SDL_Haptic * haptic, struct haptic_effect * effect)
{
#if 0 /* Not supported atm. */
struct input_event ie;
ie.type = EV_FF;
ie.type = EV_FF_STATUS;
ie.code = effect->hweffect->effect.id;
if (write(haptic->hwdata->fd, &ie, sizeof(ie)) < 0) {
802
SDL_SetError("Haptic: Error getting device status.");
803
804
805
806
807
808
809
810
811
812
return -1;
}
return 0;
#endif
return -1;
}
813
814
815
816
817
818
819
820
821
822
823
824
/*
* Sets the gain.
*/
int
SDL_SYS_HapticSetGain(SDL_Haptic * haptic, int gain)
{
struct input_event ie;
ie.type = EV_FF;
ie.code = FF_GAIN;
ie.value = (0xFFFFUL * gain) / 100;
825
if (write(haptic->hwdata->fd, &ie, sizeof(ie)) < 0) {
826
SDL_SetError("Haptic: Error setting gain: %s", strerror(errno));
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
return -1;
}
return 0;
}
/*
* Sets the autocentering.
*/
int
SDL_SYS_HapticSetAutocenter(SDL_Haptic * haptic, int autocenter)
{
struct input_event ie;
ie.type = EV_FF;
ie.code = FF_AUTOCENTER;
ie.value = (0xFFFFUL * autocenter) / 100;
if (write(haptic->hwdata->fd, &ie, sizeof(ie)) < 0) {
847
SDL_SetError("Haptic: Error setting autocenter: %s", strerror(errno));
848
return -1;
849
850
}
851
return 0;
852
853
854
}
855
#endif /* SDL_HAPTIC_LINUX */