Skip to content
This repository has been archived by the owner on Feb 11, 2021. It is now read-only.

Latest commit

 

History

History
883 lines (711 loc) · 22.2 KB

SDL_syshaptic.c

File metadata and controls

883 lines (711 loc) · 22.2 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"
Jul 3, 2008
Jul 3, 2008
24
#ifdef SDL_HAPTIC_LINUX
25
26
27
#include "SDL_haptic.h"
#include "../SDL_syshaptic.h"
Jul 2, 2008
Jul 2, 2008
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>
Jul 10, 2008
Jul 10, 2008
39
#include <limits.h> /* INT_MAX */
40
#include <string.h>
Jul 3, 2008
Jul 3, 2008
41
#include <errno.h>
Jul 9, 2008
Jul 9, 2008
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
Jun 1, 2008
Jun 1, 2008
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];
Jun 1, 2008
Jun 1, 2008
61
62
63
64
/*
* Haptic system hardware data.
*/
65
66
67
struct haptic_hwdata
{
int fd;
Jul 17, 2008
Jul 17, 2008
68
char *fname; /* Points to the name in SDL_hapticlist. */
69
70
71
};
Jun 30, 2008
Jun 30, 2008
72
73
74
75
76
/*
* Haptic system effect data.
*/
struct haptic_hweffect
{
Jul 9, 2008
Jul 9, 2008
77
struct ff_effect effect; /* The linux kernel effect structure. */
Jun 30, 2008
Jun 30, 2008
78
79
80
};
Jun 1, 2008
Jun 1, 2008
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);
Jun 1, 2008
Jun 1, 2008
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)];
Jul 10, 2008
Jul 10, 2008
96
/* Ask device for what it has. */
97
ret = 0;
Jul 10, 2008
Jul 10, 2008
98
if (ioctl(fd, EVIOCGBIT(EV_FF, sizeof(features)), features) < 0) {
Jul 10, 2008
Jul 10, 2008
99
SDL_SetError("Haptic: Unable to get device's features: %s", strerror(errno));
Jul 2, 2008
Jul 2, 2008
100
101
return -1;
}
Jul 10, 2008
Jul 10, 2008
103
/* Convert supported features to SDL_HAPTIC platform-neutral features. */
104
EV_TEST(FF_CONSTANT, SDL_HAPTIC_CONSTANT);
Jul 1, 2008
Jul 1, 2008
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);
Jul 1, 2008
Jul 1, 2008
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);
Jul 10, 2008
Jul 10, 2008
119
/* Return what it supports. */
120
121
122
return ret;
}
Jul 10, 2008
Jul 10, 2008
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;
}
Jul 6, 2008
Jul 6, 2008
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;
Jul 10, 2008
Jul 10, 2008
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 */
Jul 2, 2008
Jul 2, 2008
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;
}
Jul 17, 2008
Jul 17, 2008
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;
}
Jun 1, 2008
Jun 1, 2008
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;
Jul 17, 2008
Jul 17, 2008
232
const char *name;
Jul 10, 2008
Jul 10, 2008
234
/* Open the haptic device. */
235
236
name = NULL;
fd = open(SDL_hapticlist[index].fname, O_RDONLY, 0);
Jul 10, 2008
Jul 10, 2008
237
238
if (fd >= 0) {
Jul 10, 2008
Jul 10, 2008
239
Jul 17, 2008
Jul 17, 2008
240
241
name = SDL_SYS_HapticNameFromFD(fd);
if (name==NULL) {
Jul 10, 2008
Jul 10, 2008
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;
}
Jun 1, 2008
Jun 1, 2008
252
/*
Jul 2, 2008
Jul 2, 2008
253
* Opens the haptic device from the file descriptor.
Jun 1, 2008
Jun 1, 2008
254
*/
Jul 2, 2008
Jul 2, 2008
255
256
static int
SDL_SYS_HapticOpenFromFD(SDL_Haptic * haptic, int fd)
Jul 17, 2008
Jul 17, 2008
258
259
const char *name;
Jun 23, 2008
Jun 23, 2008
260
261
/* Allocate the hwdata */
haptic->hwdata = (struct haptic_hwdata *)
Jun 30, 2008
Jun 30, 2008
262
SDL_malloc(sizeof(*haptic->hwdata));
Jun 23, 2008
Jun 23, 2008
263
264
if (haptic->hwdata == NULL) {
SDL_OutOfMemory();
Jun 30, 2008
Jun 30, 2008
265
goto open_err;
Jun 23, 2008
Jun 23, 2008
266
267
}
SDL_memset(haptic->hwdata, 0, sizeof(*haptic->hwdata));
Jul 10, 2008
Jul 10, 2008
268
Jul 17, 2008
Jul 17, 2008
269
/* Set the data. */
Jun 23, 2008
Jun 23, 2008
270
haptic->hwdata->fd = fd;
Jun 30, 2008
Jun 30, 2008
271
haptic->supported = EV_IsHaptic(fd);
Jul 17, 2008
Jul 17, 2008
272
haptic->naxes = 2; /* Hardcoded for now, not sure if it's possible to find out. */
Jun 30, 2008
Jun 30, 2008
274
275
/* Set the effects */
if (ioctl(fd, EVIOCGEFFECTS, &haptic->neffects) < 0) {
Jul 10, 2008
Jul 10, 2008
276
SDL_SetError("Haptic: Unable to query device memory: %s", strerror(errno));
Jun 30, 2008
Jun 30, 2008
277
278
goto open_err;
}
Jul 10, 2008
Jul 10, 2008
279
haptic->nplaying = haptic->neffects; /* Linux makes no distinction. */
Jun 30, 2008
Jun 30, 2008
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;
}
Jul 1, 2008
Jul 1, 2008
286
287
288
/* Clear the memory */
SDL_memset(haptic->effects, 0,
sizeof(struct haptic_effect) * haptic->neffects);
Jun 30, 2008
Jun 30, 2008
289
290
return 0;
Jun 30, 2008
Jun 30, 2008
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
}
Jul 2, 2008
Jul 2, 2008
303
304
305
306
307
308
309
/*
* Opens a haptic device for usage.
*/
int
SDL_SYS_HapticOpen(SDL_Haptic * haptic)
{
int fd;
Jul 17, 2008
Jul 17, 2008
310
int ret;
Jul 2, 2008
Jul 2, 2008
311
312
313
314
/* Open the character device */
fd = open(SDL_hapticlist[haptic->index].fname, O_RDWR, 0);
if (fd < 0) {
Jul 10, 2008
Jul 10, 2008
315
SDL_SetError("Haptic: Unable to open %s: %s",
Jul 3, 2008
Jul 3, 2008
316
SDL_hapticlist[haptic->index], strerror(errno));
Jul 2, 2008
Jul 2, 2008
317
318
return -1;
}
Jul 17, 2008
Jul 17, 2008
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;
Jul 10, 2008
Jul 10, 2008
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) {
Jul 10, 2008
Jul 10, 2008
346
SDL_SetError("Haptic: Unable to open %s: %s",
Jul 10, 2008
Jul 10, 2008
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;
}
Jul 2, 2008
Jul 2, 2008
361
362
Jul 2, 2008
Jul 2, 2008
363
364
365
366
367
368
/*
* Checks to see if a joystick has haptic features.
*/
int
SDL_SYS_JoystickIsHaptic(SDL_Joystick * joystick)
{
Jul 2, 2008
Jul 2, 2008
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)
{
Jul 17, 2008
Jul 17, 2008
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) {
Jul 2, 2008
Jul 2, 2008
382
return 1;
Jul 2, 2008
Jul 2, 2008
383
}
Jul 2, 2008
Jul 2, 2008
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)
{
Jul 17, 2008
Jul 17, 2008
394
int i;
Jul 2, 2008
Jul 2, 2008
395
int fd;
Jul 17, 2008
Jul 17, 2008
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;
}
}
}
Jul 2, 2008
Jul 2, 2008
407
fd = open(joystick->hwdata->fname, O_RDWR, 0);
Jul 17, 2008
Jul 17, 2008
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;
Jul 2, 2008
Jul 2, 2008
415
416
417
}
Jun 1, 2008
Jun 1, 2008
418
419
420
421
422
423
/*
* Closes the haptic device.
*/
void
SDL_SYS_HapticClose(SDL_Haptic * haptic)
{
Jun 23, 2008
Jun 23, 2008
424
425
426
427
428
429
430
if (haptic->hwdata) {
/* Clean up */
close(haptic->hwdata->fd);
/* Free */
SDL_free(haptic->hwdata);
Jun 30, 2008
Jun 30, 2008
431
SDL_free(haptic->effects);
Jun 23, 2008
Jun 23, 2008
432
}
Jul 17, 2008
Jul 17, 2008
433
434
435
/* Clear the rest. */
SDL_memset(haptic, 0, sizeof(SDL_Haptic));
Jun 1, 2008
Jun 1, 2008
436
437
438
}
Jun 30, 2008
Jun 30, 2008
439
440
441
/*
* Clean up after system specific haptic stuff
*/
Jun 1, 2008
Jun 1, 2008
442
443
444
445
446
447
void
SDL_SYS_HapticQuit(void)
{
int i;
for (i=0; SDL_hapticlist[i].fname != NULL; i++) {
Jul 18, 2008
Jul 18, 2008
448
449
450
/* Opened and not closed haptics are leaked, this is on purpose.
* Close your haptic devices after usage. */
Jun 1, 2008
Jun 1, 2008
451
452
453
454
455
SDL_free(SDL_hapticlist[i].fname);
}
SDL_hapticlist[0].fname = NULL;
}
Jul 30, 2008
Jul 30, 2008
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
/*
* Converts an SDL button to a ff_trigger button.
*/
static Uint16
SDL_SYS_ToButton( Uint16 button )
{
Uint16 ff_button;
ff_button = 0;
if (button != 0) {
ff_button = BTN_GAMEPAD + button - 1;
}
return ff_button;
}
Jul 6, 2008
Jul 6, 2008
475
476
477
478
479
480
481
/*
* Returns the ff_effect usable direction from a SDL_HapticDirection.
*/
static Uint16
SDL_SYS_ToDirection( SDL_HapticDirection * dir )
{
Uint32 tmp;
Jul 9, 2008
Jul 9, 2008
482
float f; /* Ideally we'd use fixed point math instead of floats... */
Jul 6, 2008
Jul 6, 2008
483
484
485
switch (dir->type) {
case SDL_HAPTIC_POLAR:
Jul 7, 2008
Jul 7, 2008
486
487
/* Linux directions are inverted. */
tmp = (((18000 + dir->dir[0]) % 36000) * 0xFFFF) / 36000;
Jul 6, 2008
Jul 6, 2008
488
return (Uint16) tmp;
Jul 17, 2008
Jul 17, 2008
489
Jul 6, 2008
Jul 6, 2008
490
case SDL_HAPTIC_CARTESIAN:
Jul 9, 2008
Jul 9, 2008
491
/* We must invert "x" and "y" to go clockwise. */
Jul 9, 2008
Jul 9, 2008
492
493
494
495
f = atan2(dir->dir[0], dir->dir[1]);
tmp = (int)(f*18000./M_PI) % 36000;
tmp = (tmp * 0xFFFF) / 36000;
return (Uint16) tmp;
Jul 6, 2008
Jul 6, 2008
496
Jul 17, 2008
Jul 17, 2008
497
498
499
500
501
case SDL_HAPTIC_SPHERICAL:
tmp = (36000 - dir->dir[0]) + 27000; /* Convert to polars */
tmp = (((18000 + tmp) % 36000) * 0xFFFF) / 36000;
return (Uint16) tmp;
Jul 6, 2008
Jul 6, 2008
502
default:
Jul 17, 2008
Jul 17, 2008
503
SDL_SetError("Haptic: Unsupported direction type.");
Jul 6, 2008
Jul 6, 2008
504
505
506
507
508
509
return -1;
}
return 0;
}
Jul 30, 2008
Jul 30, 2008
510
Jul 1, 2008
Jul 1, 2008
511
#define CLAMP(x) (((x) > 32767) ? 32767 : x)
Jun 30, 2008
Jun 30, 2008
512
513
/*
* Initializes the linux effect struct from a haptic_effect.
Jul 1, 2008
Jul 1, 2008
514
* Values above 32767 (for unsigned) are unspecified so we must clamp.
Jun 30, 2008
Jun 30, 2008
515
516
*/
static int
Jul 1, 2008
Jul 1, 2008
517
SDL_SYS_ToFFEffect( struct ff_effect * dest, SDL_HapticEffect * src )
Jun 30, 2008
Jun 30, 2008
518
{
Jul 18, 2008
Jul 18, 2008
519
Uint32 tmp;
Jul 1, 2008
Jul 1, 2008
520
521
SDL_HapticConstant *constant;
SDL_HapticPeriodic *periodic;
Jul 1, 2008
Jul 1, 2008
522
523
SDL_HapticCondition *condition;
SDL_HapticRamp *ramp;
Jul 1, 2008
Jul 1, 2008
524
525
/* Clear up */
Jun 30, 2008
Jun 30, 2008
526
SDL_memset(dest, 0, sizeof(struct ff_effect));
Jul 1, 2008
Jul 1, 2008
527
528
switch (src->type) {
Jun 30, 2008
Jun 30, 2008
529
case SDL_HAPTIC_CONSTANT:
Jul 1, 2008
Jul 1, 2008
530
531
532
constant = &src->constant;
/* Header */
Jun 30, 2008
Jun 30, 2008
533
dest->type = FF_CONSTANT;
Jul 6, 2008
Jul 6, 2008
534
dest->direction = SDL_SYS_ToDirection(&constant->direction);
Jul 17, 2008
Jul 17, 2008
535
if (dest->direction < 0) return -1;
Jul 1, 2008
Jul 1, 2008
536
537
/* Replay */
Jul 20, 2008
Jul 20, 2008
538
539
dest->replay.length = (constant->length == SDL_HAPTIC_INFINITY) ?
0 : CLAMP(constant->length);
Jul 1, 2008
Jul 1, 2008
540
dest->replay.delay = CLAMP(constant->delay);
Jul 1, 2008
Jul 1, 2008
541
542
/* Trigger */
Jul 30, 2008
Jul 30, 2008
543
dest->trigger.button = SDL_SYS_ToButton(constant->button);
Jul 1, 2008
Jul 1, 2008
544
dest->trigger.interval = CLAMP(constant->interval);
Jul 1, 2008
Jul 1, 2008
545
546
547
548
549
/* Constant */
dest->u.constant.level = constant->level;
/* Envelope */
Jul 1, 2008
Jul 1, 2008
550
551
552
553
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);
Jul 1, 2008
Jul 1, 2008
554
555
556
break;
Jul 1, 2008
Jul 1, 2008
557
558
559
560
561
case SDL_HAPTIC_SINE:
case SDL_HAPTIC_SQUARE:
case SDL_HAPTIC_TRIANGLE:
case SDL_HAPTIC_SAWTOOTHUP:
case SDL_HAPTIC_SAWTOOTHDOWN:
Jul 1, 2008
Jul 1, 2008
562
563
564
565
periodic = &src->periodic;
/* Header */
dest->type = FF_PERIODIC;
Jul 6, 2008
Jul 6, 2008
566
dest->direction = SDL_SYS_ToDirection(&periodic->direction);
Jul 17, 2008
Jul 17, 2008
567
if (dest->direction < 0) return -1;
Jul 1, 2008
Jul 1, 2008
568
569
/* Replay */
Jul 20, 2008
Jul 20, 2008
570
571
dest->replay.length = (periodic->length == SDL_HAPTIC_INFINITY) ?
0 : CLAMP(periodic->length);
Jul 1, 2008
Jul 1, 2008
572
dest->replay.delay = CLAMP(periodic->delay);
Jul 1, 2008
Jul 1, 2008
573
574
/* Trigger */
Jul 30, 2008
Jul 30, 2008
575
dest->trigger.button = SDL_SYS_ToButton(periodic->button);
Jul 1, 2008
Jul 1, 2008
576
dest->trigger.interval = CLAMP(periodic->interval);
Jul 1, 2008
Jul 1, 2008
577
Jul 1, 2008
Jul 1, 2008
578
579
580
581
582
583
584
585
586
587
588
/* 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;
Jul 1, 2008
Jul 1, 2008
589
dest->u.periodic.period = CLAMP(periodic->period);
Jul 1, 2008
Jul 1, 2008
590
591
dest->u.periodic.magnitude = periodic->magnitude;
dest->u.periodic.offset = periodic->offset;
Jul 18, 2008
Jul 18, 2008
592
593
594
/* 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);
Jul 1, 2008
Jul 1, 2008
595
596
/* Envelope */
Jul 1, 2008
Jul 1, 2008
597
598
599
600
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);
Jun 30, 2008
Jun 30, 2008
601
602
603
break;
Jul 1, 2008
Jul 1, 2008
604
605
606
607
608
609
610
case SDL_HAPTIC_SPRING:
case SDL_HAPTIC_DAMPER:
case SDL_HAPTIC_INERTIA:
case SDL_HAPTIC_FRICTION:
condition = &src->condition;
/* Header */
Jul 7, 2008
Jul 7, 2008
611
if (condition->type == SDL_HAPTIC_SPRING)
Jul 1, 2008
Jul 1, 2008
612
dest->type = FF_SPRING;
Jul 7, 2008
Jul 7, 2008
613
else if (condition->type == SDL_HAPTIC_DAMPER)
Jul 1, 2008
Jul 1, 2008
614
dest->type = FF_DAMPER;
Jul 7, 2008
Jul 7, 2008
615
else if (condition->type == SDL_HAPTIC_INERTIA)
Jul 1, 2008
Jul 1, 2008
616
dest->type = FF_INERTIA;
Jul 7, 2008
Jul 7, 2008
617
else if (condition->type == SDL_HAPTIC_FRICTION)
Jul 1, 2008
Jul 1, 2008
618
dest->type = FF_FRICTION;
Jul 6, 2008
Jul 6, 2008
619
dest->direction = 0; /* Handled by the condition-specifics. */
Jul 1, 2008
Jul 1, 2008
620
621
/* Replay */
Jul 20, 2008
Jul 20, 2008
622
623
dest->replay.length = (condition->length == SDL_HAPTIC_INFINITY) ?
0 : CLAMP(condition->length);
Jul 1, 2008
Jul 1, 2008
624
625
626
dest->replay.delay = CLAMP(condition->delay);
/* Trigger */
Jul 30, 2008
Jul 30, 2008
627
dest->trigger.button = SDL_SYS_ToButton(condition->button);
Jul 1, 2008
Jul 1, 2008
628
629
dest->trigger.interval = CLAMP(condition->interval);
Jul 6, 2008
Jul 6, 2008
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
/* 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];
Jul 1, 2008
Jul 1, 2008
645
646
647
648
649
650
651
652
break;
case SDL_HAPTIC_RAMP:
ramp = &src->ramp;
/* Header */
dest->type = FF_RAMP;
Jul 6, 2008
Jul 6, 2008
653
dest->direction = SDL_SYS_ToDirection(&ramp->direction);
Jul 17, 2008
Jul 17, 2008
654
if (dest->direction < 0) return -1;
Jul 1, 2008
Jul 1, 2008
655
656
/* Replay */
Jul 20, 2008
Jul 20, 2008
657
658
dest->replay.length = (ramp->length == SDL_HAPTIC_INFINITY) ?
0 : CLAMP(ramp->length);
Jul 1, 2008
Jul 1, 2008
659
660
661
dest->replay.delay = CLAMP(ramp->delay);
/* Trigger */
Jul 30, 2008
Jul 30, 2008
662
dest->trigger.button = SDL_SYS_ToButton(ramp->button);
Jul 1, 2008
Jul 1, 2008
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
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;
Jun 30, 2008
Jun 30, 2008
678
default:
Jul 10, 2008
Jul 10, 2008
679
SDL_SetError("Haptic: Unknown effect type.");
Jun 30, 2008
Jun 30, 2008
680
681
682
683
684
685
return -1;
}
return 0;
}
Jul 1, 2008
Jul 1, 2008
686
Jun 30, 2008
Jun 30, 2008
687
688
689
690
/*
* Creates a new haptic effect.
*/
int
Jul 1, 2008
Jul 1, 2008
691
692
SDL_SYS_HapticNewEffect(SDL_Haptic * haptic, struct haptic_effect * effect,
SDL_HapticEffect * base)
Jun 30, 2008
Jun 30, 2008
693
{
Jul 1, 2008
Jul 1, 2008
694
695
struct ff_effect * linux_effect;
Jun 30, 2008
Jun 30, 2008
696
697
698
699
700
701
702
703
704
/* 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 */
Jul 1, 2008
Jul 1, 2008
705
706
linux_effect = &effect->hweffect->effect;
if (SDL_SYS_ToFFEffect( linux_effect, base ) != 0) {
Jul 1, 2008
Jul 1, 2008
707
goto new_effect_err;
Jun 30, 2008
Jun 30, 2008
708
}
Jul 1, 2008
Jul 1, 2008
709
linux_effect->id = -1; /* Have the kernel give it an id */
Jun 30, 2008
Jun 30, 2008
710
711
/* Upload the effect */
Jul 1, 2008
Jul 1, 2008
712
if (ioctl(haptic->hwdata->fd, EVIOCSFF, linux_effect) < 0) {
Jul 10, 2008
Jul 10, 2008
713
SDL_SetError("Haptic: Error uploading effect to the device: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
714
goto new_effect_err;
Jun 30, 2008
Jun 30, 2008
715
716
717
}
return 0;
Jul 1, 2008
Jul 1, 2008
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
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) {
Jul 10, 2008
Jul 10, 2008
745
SDL_SetError("Haptic: Error updating the effect: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
746
747
748
749
750
751
752
return -1;
}
/* Copy the new effect into memory. */
SDL_memcpy( &effect->hweffect->effect, &linux_effect, sizeof(struct ff_effect) );
return effect->hweffect->effect.id;
Jun 30, 2008
Jun 30, 2008
753
754
755
756
757
758
759
}
/*
* Runs an effect.
*/
int
Jul 15, 2008
Jul 15, 2008
760
761
SDL_SYS_HapticRunEffect(SDL_Haptic * haptic, struct haptic_effect * effect,
Uint32 iterations)
Jun 30, 2008
Jun 30, 2008
762
763
764
765
766
767
{
struct input_event run;
/* Prepare to run the effect */
run.type = EV_FF;
run.code = effect->hweffect->effect.id;
Jul 20, 2008
Jul 20, 2008
768
/* We don't actually have infinity here, so we just do INT_MAX which is pretty damn close. */
Jul 15, 2008
Jul 15, 2008
769
run.value = (iterations > INT_MAX) ? INT_MAX : iterations;
Jun 30, 2008
Jun 30, 2008
770
771
if (write(haptic->hwdata->fd, (const void*) &run, sizeof(run)) < 0) {
Jul 10, 2008
Jul 10, 2008
772
SDL_SetError("Haptic: Unable to run the effect: %s", strerror(errno));
Jun 30, 2008
Jun 30, 2008
773
774
775
776
777
778
779
return -1;
}
return 0;
}
Jul 1, 2008
Jul 1, 2008
780
781
782
783
784
785
786
787
788
789
790
791
792
/*
* 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) {
Jul 10, 2008
Jul 10, 2008
793
SDL_SetError("Haptic: Unable to stop the effect: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
794
795
796
797
798
799
800
return -1;
}
return 0;
}
Jun 30, 2008
Jun 30, 2008
801
/*
Jul 1, 2008
Jul 1, 2008
802
* Frees the effect.
Jun 30, 2008
Jun 30, 2008
803
804
805
806
807
*/
void
SDL_SYS_HapticDestroyEffect(SDL_Haptic * haptic, struct haptic_effect * effect)
{
if (ioctl(haptic->hwdata->fd, EVIOCRMFF, effect->hweffect->effect.id) < 0) {
Jul 10, 2008
Jul 10, 2008
808
SDL_SetError("Haptic: Error removing the effect from the device: %s",
Jul 3, 2008
Jul 3, 2008
809
strerror(errno));
Jun 30, 2008
Jun 30, 2008
810
811
812
}
SDL_free(effect->hweffect);
effect->hweffect = NULL;
Jun 30, 2008
Jun 30, 2008
813
814
}
Jun 1, 2008
Jun 1, 2008
815
Jul 3, 2008
Jul 3, 2008
816
817
818
819
820
821
822
823
824
825
826
827
828
829
/*
* 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) {
Jul 10, 2008
Jul 10, 2008
830
SDL_SetError("Haptic: Error getting device status.");
Jul 3, 2008
Jul 3, 2008
831
832
833
834
835
836
837
838
839
840
return -1;
}
return 0;
#endif
return -1;
}
Jul 1, 2008
Jul 1, 2008
841
842
843
844
845
846
847
848
849
850
851
852
/*
* 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;
Jul 1, 2008
Jul 1, 2008
853
if (write(haptic->hwdata->fd, &ie, sizeof(ie)) < 0) {
Jul 10, 2008
Jul 10, 2008
854
SDL_SetError("Haptic: Error setting gain: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
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) {
Jul 10, 2008
Jul 10, 2008
875
SDL_SetError("Haptic: Error setting autocenter: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
876
return -1;
Jul 1, 2008
Jul 1, 2008
877
878
}
Jul 1, 2008
Jul 1, 2008
879
return 0;
Jul 1, 2008
Jul 1, 2008
880
881
882
}
883
#endif /* SDL_HAPTIC_LINUX */