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

Latest commit

 

History

History
855 lines (691 loc) · 21.4 KB

SDL_syshaptic.c

File metadata and controls

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"
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
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;
}
Jul 6, 2008
Jul 6, 2008
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;
Jul 9, 2008
Jul 9, 2008
460
float f; /* Ideally we'd use fixed point math instead of floats... */
Jul 6, 2008
Jul 6, 2008
461
462
463
switch (dir->type) {
case SDL_HAPTIC_POLAR:
Jul 7, 2008
Jul 7, 2008
464
465
/* Linux directions are inverted. */
tmp = (((18000 + dir->dir[0]) % 36000) * 0xFFFF) / 36000;
Jul 6, 2008
Jul 6, 2008
466
return (Uint16) tmp;
Jul 17, 2008
Jul 17, 2008
467
Jul 6, 2008
Jul 6, 2008
468
case SDL_HAPTIC_CARTESIAN:
Jul 9, 2008
Jul 9, 2008
469
/* We must invert "x" and "y" to go clockwise. */
Jul 9, 2008
Jul 9, 2008
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;
Jul 6, 2008
Jul 6, 2008
474
Jul 17, 2008
Jul 17, 2008
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;
Jul 6, 2008
Jul 6, 2008
480
default:
Jul 17, 2008
Jul 17, 2008
481
SDL_SetError("Haptic: Unsupported direction type.");
Jul 6, 2008
Jul 6, 2008
482
483
484
485
486
487
return -1;
}
return 0;
}
Jul 1, 2008
Jul 1, 2008
488
#define CLAMP(x) (((x) > 32767) ? 32767 : x)
Jun 30, 2008
Jun 30, 2008
489
490
/*
* Initializes the linux effect struct from a haptic_effect.
Jul 1, 2008
Jul 1, 2008
491
* Values above 32767 (for unsigned) are unspecified so we must clamp.
Jun 30, 2008
Jun 30, 2008
492
493
*/
static int
Jul 1, 2008
Jul 1, 2008
494
SDL_SYS_ToFFEffect( struct ff_effect * dest, SDL_HapticEffect * src )
Jun 30, 2008
Jun 30, 2008
495
{
Jul 18, 2008
Jul 18, 2008
496
Uint32 tmp;
Jul 1, 2008
Jul 1, 2008
497
498
SDL_HapticConstant *constant;
SDL_HapticPeriodic *periodic;
Jul 1, 2008
Jul 1, 2008
499
500
SDL_HapticCondition *condition;
SDL_HapticRamp *ramp;
Jul 1, 2008
Jul 1, 2008
501
502
/* Clear up */
Jun 30, 2008
Jun 30, 2008
503
SDL_memset(dest, 0, sizeof(struct ff_effect));
Jul 1, 2008
Jul 1, 2008
504
505
switch (src->type) {
Jun 30, 2008
Jun 30, 2008
506
case SDL_HAPTIC_CONSTANT:
Jul 1, 2008
Jul 1, 2008
507
508
509
constant = &src->constant;
/* Header */
Jun 30, 2008
Jun 30, 2008
510
dest->type = FF_CONSTANT;
Jul 6, 2008
Jul 6, 2008
511
dest->direction = SDL_SYS_ToDirection(&constant->direction);
Jul 17, 2008
Jul 17, 2008
512
if (dest->direction < 0) return -1;
Jul 1, 2008
Jul 1, 2008
513
514
/* Replay */
Jul 1, 2008
Jul 1, 2008
515
516
dest->replay.length = CLAMP(constant->length);
dest->replay.delay = CLAMP(constant->delay);
Jul 1, 2008
Jul 1, 2008
517
518
/* Trigger */
Jul 1, 2008
Jul 1, 2008
519
520
dest->trigger.button = CLAMP(constant->button);
dest->trigger.interval = CLAMP(constant->interval);
Jul 1, 2008
Jul 1, 2008
521
522
523
524
525
/* Constant */
dest->u.constant.level = constant->level;
/* Envelope */
Jul 1, 2008
Jul 1, 2008
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);
Jul 1, 2008
Jul 1, 2008
530
531
532
break;
Jul 1, 2008
Jul 1, 2008
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:
Jul 1, 2008
Jul 1, 2008
538
539
540
541
periodic = &src->periodic;
/* Header */
dest->type = FF_PERIODIC;
Jul 6, 2008
Jul 6, 2008
542
dest->direction = SDL_SYS_ToDirection(&periodic->direction);
Jul 17, 2008
Jul 17, 2008
543
if (dest->direction < 0) return -1;
Jul 1, 2008
Jul 1, 2008
544
545
/* Replay */
Jul 1, 2008
Jul 1, 2008
546
547
dest->replay.length = CLAMP(periodic->length);
dest->replay.delay = CLAMP(periodic->delay);
Jul 1, 2008
Jul 1, 2008
548
549
/* Trigger */
Jul 1, 2008
Jul 1, 2008
550
551
dest->trigger.button = CLAMP(periodic->button);
dest->trigger.interval = CLAMP(periodic->interval);
Jul 1, 2008
Jul 1, 2008
552
Jul 1, 2008
Jul 1, 2008
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;
Jul 1, 2008
Jul 1, 2008
564
dest->u.periodic.period = CLAMP(periodic->period);
Jul 1, 2008
Jul 1, 2008
565
566
dest->u.periodic.magnitude = periodic->magnitude;
dest->u.periodic.offset = periodic->offset;
Jul 18, 2008
Jul 18, 2008
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);
Jul 1, 2008
Jul 1, 2008
570
571
/* Envelope */
Jul 1, 2008
Jul 1, 2008
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);
Jun 30, 2008
Jun 30, 2008
576
577
578
break;
Jul 1, 2008
Jul 1, 2008
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 */
Jul 7, 2008
Jul 7, 2008
586
if (condition->type == SDL_HAPTIC_SPRING)
Jul 1, 2008
Jul 1, 2008
587
dest->type = FF_SPRING;
Jul 7, 2008
Jul 7, 2008
588
else if (condition->type == SDL_HAPTIC_DAMPER)
Jul 1, 2008
Jul 1, 2008
589
dest->type = FF_DAMPER;
Jul 7, 2008
Jul 7, 2008
590
else if (condition->type == SDL_HAPTIC_INERTIA)
Jul 1, 2008
Jul 1, 2008
591
dest->type = FF_INERTIA;
Jul 7, 2008
Jul 7, 2008
592
else if (condition->type == SDL_HAPTIC_FRICTION)
Jul 1, 2008
Jul 1, 2008
593
dest->type = FF_FRICTION;
Jul 6, 2008
Jul 6, 2008
594
dest->direction = 0; /* Handled by the condition-specifics. */
Jul 1, 2008
Jul 1, 2008
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);
Jul 6, 2008
Jul 6, 2008
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];
Jul 1, 2008
Jul 1, 2008
619
620
621
622
623
624
625
626
break;
case SDL_HAPTIC_RAMP:
ramp = &src->ramp;
/* Header */
dest->type = FF_RAMP;
Jul 6, 2008
Jul 6, 2008
627
dest->direction = SDL_SYS_ToDirection(&ramp->direction);
Jul 17, 2008
Jul 17, 2008
628
if (dest->direction < 0) return -1;
Jul 1, 2008
Jul 1, 2008
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;
Jun 30, 2008
Jun 30, 2008
651
default:
Jul 10, 2008
Jul 10, 2008
652
SDL_SetError("Haptic: Unknown effect type.");
Jun 30, 2008
Jun 30, 2008
653
654
655
656
657
658
return -1;
}
return 0;
}
Jul 1, 2008
Jul 1, 2008
659
Jun 30, 2008
Jun 30, 2008
660
661
662
663
/*
* Creates a new haptic effect.
*/
int
Jul 1, 2008
Jul 1, 2008
664
665
SDL_SYS_HapticNewEffect(SDL_Haptic * haptic, struct haptic_effect * effect,
SDL_HapticEffect * base)
Jun 30, 2008
Jun 30, 2008
666
{
Jul 1, 2008
Jul 1, 2008
667
668
struct ff_effect * linux_effect;
Jun 30, 2008
Jun 30, 2008
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 */
Jul 1, 2008
Jul 1, 2008
678
679
linux_effect = &effect->hweffect->effect;
if (SDL_SYS_ToFFEffect( linux_effect, base ) != 0) {
Jul 1, 2008
Jul 1, 2008
680
goto new_effect_err;
Jun 30, 2008
Jun 30, 2008
681
}
Jul 1, 2008
Jul 1, 2008
682
linux_effect->id = -1; /* Have the kernel give it an id */
Jun 30, 2008
Jun 30, 2008
683
684
/* Upload the effect */
Jul 1, 2008
Jul 1, 2008
685
if (ioctl(haptic->hwdata->fd, EVIOCSFF, linux_effect) < 0) {
Jul 10, 2008
Jul 10, 2008
686
SDL_SetError("Haptic: Error uploading effect to the device: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
687
goto new_effect_err;
Jun 30, 2008
Jun 30, 2008
688
689
690
}
return 0;
Jul 1, 2008
Jul 1, 2008
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) {
Jul 10, 2008
Jul 10, 2008
718
SDL_SetError("Haptic: Error updating the effect: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
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;
Jun 30, 2008
Jun 30, 2008
726
727
728
729
730
731
732
}
/*
* Runs an effect.
*/
int
Jul 15, 2008
Jul 15, 2008
733
734
SDL_SYS_HapticRunEffect(SDL_Haptic * haptic, struct haptic_effect * effect,
Uint32 iterations)
Jun 30, 2008
Jun 30, 2008
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;
Jul 15, 2008
Jul 15, 2008
741
run.value = (iterations > INT_MAX) ? INT_MAX : iterations;
Jun 30, 2008
Jun 30, 2008
742
743
if (write(haptic->hwdata->fd, (const void*) &run, sizeof(run)) < 0) {
Jul 10, 2008
Jul 10, 2008
744
SDL_SetError("Haptic: Unable to run the effect: %s", strerror(errno));
Jun 30, 2008
Jun 30, 2008
745
746
747
748
749
750
751
return -1;
}
return 0;
}
Jul 1, 2008
Jul 1, 2008
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) {
Jul 10, 2008
Jul 10, 2008
765
SDL_SetError("Haptic: Unable to stop the effect: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
766
767
768
769
770
771
772
return -1;
}
return 0;
}
Jun 30, 2008
Jun 30, 2008
773
/*
Jul 1, 2008
Jul 1, 2008
774
* Frees the effect.
Jun 30, 2008
Jun 30, 2008
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) {
Jul 10, 2008
Jul 10, 2008
780
SDL_SetError("Haptic: Error removing the effect from the device: %s",
Jul 3, 2008
Jul 3, 2008
781
strerror(errno));
Jun 30, 2008
Jun 30, 2008
782
783
784
}
SDL_free(effect->hweffect);
effect->hweffect = NULL;
Jun 30, 2008
Jun 30, 2008
785
786
}
Jun 1, 2008
Jun 1, 2008
787
Jul 3, 2008
Jul 3, 2008
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) {
Jul 10, 2008
Jul 10, 2008
802
SDL_SetError("Haptic: Error getting device status.");
Jul 3, 2008
Jul 3, 2008
803
804
805
806
807
808
809
810
811
812
return -1;
}
return 0;
#endif
return -1;
}
Jul 1, 2008
Jul 1, 2008
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;
Jul 1, 2008
Jul 1, 2008
825
if (write(haptic->hwdata->fd, &ie, sizeof(ie)) < 0) {
Jul 10, 2008
Jul 10, 2008
826
SDL_SetError("Haptic: Error setting gain: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
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) {
Jul 10, 2008
Jul 10, 2008
847
SDL_SetError("Haptic: Error setting autocenter: %s", strerror(errno));
Jul 1, 2008
Jul 1, 2008
848
return -1;
Jul 1, 2008
Jul 1, 2008
849
850
}
Jul 1, 2008
Jul 1, 2008
851
return 0;
Jul 1, 2008
Jul 1, 2008
852
853
854
}
855
#endif /* SDL_HAPTIC_LINUX */