123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134 |
- /*
- Simple DirectMedia Layer
- Copyright (C) 1997-2025 Sam Lantinga <[email protected]>
- This software is provided 'as-is', without any express or implied
- warranty. In no event will the authors be held liable for any damages
- arising from the use of this software.
- Permission is granted to anyone to use this software for any purpose,
- including commercial applications, and to alter it and redistribute it
- freely, subject to the following restrictions:
- 1. The origin of this software must not be misrepresented; you must not
- claim that you wrote the original software. If you use this software
- in a product, an acknowledgment in the product documentation would be
- appreciated but is not required.
- 2. Altered source versions must be plainly marked as such, and must not be
- misrepresented as being the original software.
- 3. This notice may not be removed or altered from any source distribution.
- */
- #include "SDL_internal.h"
- #ifdef SDL_HAPTIC_LINUX
- #include "../SDL_syshaptic.h"
- #include "../../joystick/SDL_sysjoystick.h" // For the real SDL_Joystick
- #include "../../joystick/linux/SDL_sysjoystick_c.h" // For joystick hwdata
- #include "../../core/linux/SDL_evdev_capabilities.h"
- #include "../../core/linux/SDL_udev.h"
- #include <unistd.h> // close
- #include <linux/input.h> // Force feedback linux stuff.
- #include <fcntl.h> // O_RDWR
- #include <limits.h> // INT_MAX
- #include <errno.h> // errno
- #include <string.h> // strerror
- #include <sys/stat.h> // stat
- #define MAX_HAPTICS 32 // It's doubtful someone has more then 32 evdev
- static bool MaybeAddDevice(const char *path);
- #ifdef SDL_USE_LIBUDEV
- static bool MaybeRemoveDevice(const char *path);
- static void haptic_udev_callback(SDL_UDEV_deviceevent udev_type, int udev_class, const char *devpath);
- #endif // SDL_USE_LIBUDEV
- /*
- * List of available haptic devices.
- */
- typedef struct SDL_hapticlist_item
- {
- SDL_HapticID instance_id;
- char *fname; // Dev path name (like /dev/input/event1)
- SDL_Haptic *haptic; // Associated haptic.
- dev_t dev_num;
- struct SDL_hapticlist_item *next;
- } SDL_hapticlist_item;
- /*
- * Haptic system hardware data.
- */
- struct haptic_hwdata
- {
- int fd; // File descriptor of the device.
- char *fname; // Points to the name in SDL_hapticlist.
- };
- /*
- * Haptic system effect data.
- */
- struct haptic_hweffect
- {
- struct ff_effect effect; // The linux kernel effect structure.
- };
- static SDL_hapticlist_item *SDL_hapticlist = NULL;
- static SDL_hapticlist_item *SDL_hapticlist_tail = NULL;
- static int numhaptics = 0;
- #define EV_TEST(ev, f) \
- if (test_bit((ev), features)) { \
- ret |= (f); \
- }
- /*
- * Test whether a device has haptic properties.
- * Returns available properties or 0 if there are none.
- */
- static Uint32 EV_IsHaptic(int fd)
- {
- unsigned long features[1 + FF_MAX / sizeof(unsigned long)];
- Uint32 ret = 0;
- // Ask device for what it has.
- if (ioctl(fd, EVIOCGBIT(EV_FF, sizeof(features)), features) < 0) {
- SDL_SetError("Haptic: Unable to get device's features: %s", strerror(errno));
- return 0;
- }
- // Convert supported features to SDL_HAPTIC platform-neutral features.
- EV_TEST(FF_CONSTANT, SDL_HAPTIC_CONSTANT);
- EV_TEST(FF_SINE, SDL_HAPTIC_SINE);
- EV_TEST(FF_SQUARE, SDL_HAPTIC_SQUARE);
- EV_TEST(FF_TRIANGLE, SDL_HAPTIC_TRIANGLE);
- EV_TEST(FF_SAW_UP, SDL_HAPTIC_SAWTOOTHUP);
- EV_TEST(FF_SAW_DOWN, SDL_HAPTIC_SAWTOOTHDOWN);
- 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);
- EV_TEST(FF_CUSTOM, SDL_HAPTIC_CUSTOM);
- EV_TEST(FF_GAIN, SDL_HAPTIC_GAIN);
- EV_TEST(FF_AUTOCENTER, SDL_HAPTIC_AUTOCENTER);
- EV_TEST(FF_RUMBLE, SDL_HAPTIC_LEFTRIGHT);
- // Return what it supports.
- return ret;
- }
- /*
- * Tests whether a device is a mouse or not.
- */
- static bool EV_IsMouse(int fd)
- {
- unsigned long argp[40];
- // Ask for supported features.
- if (ioctl(fd, EVIOCGBIT(EV_KEY, sizeof(argp)), argp) < 0) {
- return false;
- }
- // Currently we only test for BTN_MOUSE which can give fake positives.
- if (test_bit(BTN_MOUSE, argp) != 0) {
- return true;
- }
- return true;
- }
- /*
- * Initializes the haptic subsystem by finding available devices.
- */
- bool SDL_SYS_HapticInit(void)
- {
- const char joydev_pattern[] = "/dev/input/event%d";
- char path[PATH_MAX];
- int i, j;
- /*
- * Limit amount of checks to MAX_HAPTICS since we may or may not have
- * permission to some or all devices.
- */
- i = 0;
- for (j = 0; j < MAX_HAPTICS; ++j) {
- (void)SDL_snprintf(path, PATH_MAX, joydev_pattern, i++);
- MaybeAddDevice(path);
- }
- #ifdef SDL_USE_LIBUDEV
- if (!SDL_UDEV_Init()) {
- return SDL_SetError("Could not initialize UDEV");
- }
- if (!SDL_UDEV_AddCallback(haptic_udev_callback)) {
- SDL_UDEV_Quit();
- return SDL_SetError("Could not setup haptic <-> udev callback");
- }
- // Force a scan to build the initial device list
- SDL_UDEV_Scan();
- #endif // SDL_USE_LIBUDEV
- return true;
- }
- int SDL_SYS_NumHaptics(void)
- {
- return numhaptics;
- }
- static SDL_hapticlist_item *HapticByDevIndex(int device_index)
- {
- SDL_hapticlist_item *item = SDL_hapticlist;
- if ((device_index < 0) || (device_index >= numhaptics)) {
- return NULL;
- }
- while (device_index > 0) {
- SDL_assert(item != NULL);
- --device_index;
- item = item->next;
- }
- return item;
- }
- static SDL_hapticlist_item *HapticByInstanceID(SDL_HapticID instance_id)
- {
- SDL_hapticlist_item *item;
- for (item = SDL_hapticlist; item; item = item->next) {
- if (instance_id == item->instance_id) {
- return item;
- }
- }
- return NULL;
- }
- #ifdef SDL_USE_LIBUDEV
- static void haptic_udev_callback(SDL_UDEV_deviceevent udev_type, int udev_class, const char *devpath)
- {
- if (!devpath || !(udev_class & SDL_UDEV_DEVICE_JOYSTICK)) {
- return;
- }
- switch (udev_type) {
- case SDL_UDEV_DEVICEADDED:
- MaybeAddDevice(devpath);
- break;
- case SDL_UDEV_DEVICEREMOVED:
- MaybeRemoveDevice(devpath);
- break;
- default:
- break;
- }
- }
- #endif // SDL_USE_LIBUDEV
- static bool MaybeAddDevice(const char *path)
- {
- struct stat sb;
- int fd;
- Uint32 supported;
- SDL_hapticlist_item *item;
- if (!path) {
- return false;
- }
- // try to open
- fd = open(path, O_RDWR | O_CLOEXEC, 0);
- if (fd < 0) {
- return false;
- }
- // get file status
- if (fstat(fd, &sb) != 0) {
- close(fd);
- return false;
- }
- // check for duplicates
- for (item = SDL_hapticlist; item; item = item->next) {
- if (item->dev_num == sb.st_rdev) {
- close(fd);
- return false; // duplicate.
- }
- }
- #ifdef DEBUG_INPUT_EVENTS
- printf("Checking %s\n", path);
- #endif
- // see if it works
- supported = EV_IsHaptic(fd);
- close(fd);
- if (!supported) {
- return false;
- }
- item = (SDL_hapticlist_item *)SDL_calloc(1, sizeof(SDL_hapticlist_item));
- if (!item) {
- return false;
- }
- item->instance_id = SDL_GetNextObjectID();
- item->fname = SDL_strdup(path);
- if (!item->fname) {
- SDL_free(item);
- return false;
- }
- item->dev_num = sb.st_rdev;
- // TODO: should we add instance IDs?
- if (!SDL_hapticlist_tail) {
- SDL_hapticlist = SDL_hapticlist_tail = item;
- } else {
- SDL_hapticlist_tail->next = item;
- SDL_hapticlist_tail = item;
- }
- ++numhaptics;
- // !!! TODO: Send a haptic add event?
- return true;
- }
- #ifdef SDL_USE_LIBUDEV
- static bool MaybeRemoveDevice(const char *path)
- {
- SDL_hapticlist_item *item;
- SDL_hapticlist_item *prev = NULL;
- if (!path) {
- return false;
- }
- for (item = SDL_hapticlist; item; item = item->next) {
- // found it, remove it.
- if (SDL_strcmp(path, item->fname) == 0) {
- const bool result = item->haptic ? true : false;
- if (prev) {
- prev->next = item->next;
- } else {
- SDL_assert(SDL_hapticlist == item);
- SDL_hapticlist = item->next;
- }
- if (item == SDL_hapticlist_tail) {
- SDL_hapticlist_tail = prev;
- }
- // Need to decrement the haptic count
- --numhaptics;
- // !!! TODO: Send a haptic remove event?
- SDL_free(item->fname);
- SDL_free(item);
- return result;
- }
- prev = item;
- }
- return false;
- }
- #endif // SDL_USE_LIBUDEV
- /*
- * Return the instance ID of a haptic device, does not need to be opened.
- */
- SDL_HapticID SDL_SYS_HapticInstanceID(int index)
- {
- SDL_hapticlist_item *item;
- item = HapticByDevIndex(index);
- if (item) {
- return item->instance_id;
- }
- return 0;
- }
- /*
- * 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;
- }
- /*
- * Return the name of a haptic device, does not need to be opened.
- */
- const char *SDL_SYS_HapticName(int index)
- {
- SDL_hapticlist_item *item;
- int fd;
- const char *name = NULL;
- item = HapticByDevIndex(index);
- if (item) {
- // Open the haptic device.
- fd = open(item->fname, O_RDONLY | O_CLOEXEC, 0);
- if (fd >= 0) {
- name = SDL_SYS_HapticNameFromFD(fd);
- if (!name) {
- // No name found, return device character device
- name = item->fname;
- }
- close(fd);
- }
- }
- return name;
- }
- /*
- * Opens the haptic device from the file descriptor.
- */
- static bool SDL_SYS_HapticOpenFromFD(SDL_Haptic *haptic, int fd)
- {
- // Allocate the hwdata
- haptic->hwdata = (struct haptic_hwdata *)
- SDL_calloc(1, sizeof(*haptic->hwdata));
- if (!haptic->hwdata) {
- goto open_err;
- }
- // Set the data.
- haptic->hwdata->fd = fd;
- haptic->supported = EV_IsHaptic(fd);
- haptic->naxes = 2; // Hardcoded for now, not sure if it's possible to find out.
- // Set the effects
- if (ioctl(fd, EVIOCGEFFECTS, &haptic->neffects) < 0) {
- SDL_SetError("Haptic: Unable to query device memory: %s",
- strerror(errno));
- goto open_err;
- }
- haptic->nplaying = haptic->neffects; // Linux makes no distinction.
- haptic->effects = (struct haptic_effect *)
- SDL_malloc(sizeof(struct haptic_effect) * haptic->neffects);
- if (!haptic->effects) {
- goto open_err;
- }
- // Clear the memory
- SDL_memset(haptic->effects, 0,
- sizeof(struct haptic_effect) * haptic->neffects);
- return true;
- // Error handling
- open_err:
- close(fd);
- if (haptic->hwdata) {
- SDL_free(haptic->hwdata);
- haptic->hwdata = NULL;
- }
- return false;
- }
- /*
- * Opens a haptic device for usage.
- */
- bool SDL_SYS_HapticOpen(SDL_Haptic *haptic)
- {
- int fd;
- SDL_hapticlist_item *item;
- item = HapticByInstanceID(haptic->instance_id);
- // Open the character device
- fd = open(item->fname, O_RDWR | O_CLOEXEC, 0);
- if (fd < 0) {
- return SDL_SetError("Haptic: Unable to open %s: %s",
- item->fname, strerror(errno));
- }
- // Try to create the haptic.
- if (!SDL_SYS_HapticOpenFromFD(haptic, fd)) {
- // Already closes on error.
- return false;
- }
- // Set the fname.
- haptic->hwdata->fname = SDL_strdup(item->fname);
- return true;
- }
- /*
- * Opens a haptic device from first mouse it finds for usage.
- */
- int SDL_SYS_HapticMouse(void)
- {
- int fd;
- int device_index = 0;
- SDL_hapticlist_item *item;
- for (item = SDL_hapticlist; item; item = item->next) {
- // Open the device.
- fd = open(item->fname, O_RDWR | O_CLOEXEC, 0);
- if (fd < 0) {
- return SDL_SetError("Haptic: Unable to open %s: %s",
- item->fname, strerror(errno));
- }
- // Is it a mouse?
- if (EV_IsMouse(fd)) {
- close(fd);
- return device_index;
- }
- close(fd);
- ++device_index;
- }
- return -1;
- }
- /*
- * Checks to see if a joystick has haptic features.
- */
- bool SDL_SYS_JoystickIsHaptic(SDL_Joystick *joystick)
- {
- #ifdef SDL_JOYSTICK_LINUX
- SDL_AssertJoysticksLocked();
- if (joystick->driver != &SDL_LINUX_JoystickDriver) {
- return false;
- }
- if (EV_IsHaptic(joystick->hwdata->fd)) {
- return true;
- }
- #endif
- return false;
- }
- /*
- * Checks to see if the haptic device and joystick are in reality the same.
- */
- bool SDL_SYS_JoystickSameHaptic(SDL_Haptic *haptic, SDL_Joystick *joystick)
- {
- #ifdef SDL_JOYSTICK_LINUX
- SDL_AssertJoysticksLocked();
- if (joystick->driver != &SDL_LINUX_JoystickDriver) {
- return false;
- }
- /* We are assuming Linux is using evdev which should trump the old
- * joystick methods. */
- if (SDL_strcmp(joystick->hwdata->fname, haptic->hwdata->fname) == 0) {
- return true;
- }
- #endif
- return false;
- }
- /*
- * Opens a SDL_Haptic from a SDL_Joystick.
- */
- bool SDL_SYS_HapticOpenFromJoystick(SDL_Haptic *haptic, SDL_Joystick *joystick)
- {
- #ifdef SDL_JOYSTICK_LINUX
- int fd;
- SDL_hapticlist_item *item;
- const char *name;
- SDL_AssertJoysticksLocked();
- if (joystick->driver != &SDL_LINUX_JoystickDriver) {
- return false;
- }
- // Find the joystick in the haptic list.
- for (item = SDL_hapticlist; item; item = item->next) {
- if (SDL_strcmp(item->fname, joystick->hwdata->fname) == 0) {
- haptic->instance_id = item->instance_id;
- break;
- }
- }
- fd = open(joystick->hwdata->fname, O_RDWR | O_CLOEXEC, 0);
- if (fd < 0) {
- return SDL_SetError("Haptic: Unable to open %s: %s",
- joystick->hwdata->fname, strerror(errno));
- }
- if (!SDL_SYS_HapticOpenFromFD(haptic, fd)) {
- // Already closes on error.
- return false;
- }
- haptic->hwdata->fname = SDL_strdup(joystick->hwdata->fname);
- name = SDL_SYS_HapticNameFromFD(fd);
- if (name) {
- haptic->name = SDL_strdup(name);
- }
- return true;
- #else
- return false;
- #endif
- }
- /*
- * Closes the haptic device.
- */
- void SDL_SYS_HapticClose(SDL_Haptic *haptic)
- {
- if (haptic->hwdata) {
- // Free effects.
- SDL_free(haptic->effects);
- haptic->effects = NULL;
- haptic->neffects = 0;
- // Clean up
- close(haptic->hwdata->fd);
- // Free
- SDL_free(haptic->hwdata->fname);
- SDL_free(haptic->hwdata);
- haptic->hwdata = NULL;
- }
- // Clear the rest.
- SDL_memset(haptic, 0, sizeof(SDL_Haptic));
- }
- /*
- * Clean up after system specific haptic stuff
- */
- void SDL_SYS_HapticQuit(void)
- {
- SDL_hapticlist_item *item = NULL;
- SDL_hapticlist_item *next = NULL;
- for (item = SDL_hapticlist; item; item = next) {
- next = item->next;
- /* Opened and not closed haptics are leaked, this is on purpose.
- * Close your haptic devices after usage. */
- SDL_free(item->fname);
- SDL_free(item);
- }
- #ifdef SDL_USE_LIBUDEV
- SDL_UDEV_DelCallback(haptic_udev_callback);
- SDL_UDEV_Quit();
- #endif // SDL_USE_LIBUDEV
- numhaptics = 0;
- SDL_hapticlist = NULL;
- SDL_hapticlist_tail = NULL;
- }
- /*
- * Converts an SDL button to a ff_trigger button.
- */
- static Uint16 SDL_SYS_ToButton(Uint16 button)
- {
- Uint16 ff_button;
- ff_button = 0;
- /*
- * Not sure what the proper syntax is because this actually isn't implemented
- * in the current kernel from what I've seen (2.6.26).
- */
- if (button != 0) {
- ff_button = BTN_GAMEPAD + button - 1;
- }
- return ff_button;
- }
- /*
- * Initializes the ff_effect usable direction from a SDL_HapticDirection.
- */
- static bool SDL_SYS_ToDirection(Uint16 *dest, const SDL_HapticDirection *src)
- {
- Uint32 tmp;
- switch (src->type) {
- case SDL_HAPTIC_POLAR:
- tmp = ((src->dir[0] % 36000) * 0x8000) / 18000; // convert to range [0,0xFFFF]
- *dest = (Uint16)tmp;
- break;
- case SDL_HAPTIC_SPHERICAL:
- /*
- We convert to polar, because that's the only supported direction on Linux.
- The first value of a spherical direction is practically the same as a
- Polar direction, except that we have to add 90 degrees. It is the angle
- from EAST {1,0} towards SOUTH {0,1}.
- --> add 9000
- --> finally convert to [0,0xFFFF] as in case SDL_HAPTIC_POLAR.
- */
- tmp = ((src->dir[0]) + 9000) % 36000; // Convert to polars
- tmp = (tmp * 0x8000) / 18000; // convert to range [0,0xFFFF]
- *dest = (Uint16)tmp;
- break;
- case SDL_HAPTIC_CARTESIAN:
- if (!src->dir[1]) {
- *dest = (src->dir[0] >= 0 ? 0x4000 : 0xC000);
- } else if (!src->dir[0]) {
- *dest = (src->dir[1] >= 0 ? 0x8000 : 0);
- } else {
- float f = SDL_atan2f(src->dir[1], src->dir[0]); // Ideally we'd use fixed point math instead of floats...
- /*
- SDL_atan2 takes the parameters: Y-axis-value and X-axis-value (in that order)
- - Y-axis-value is the second coordinate (from center to SOUTH)
- - X-axis-value is the first coordinate (from center to EAST)
- We add 36000, because SDL_atan2 also returns negative values. Then we practically
- have the first spherical value. Therefore we proceed as in case
- SDL_HAPTIC_SPHERICAL and add another 9000 to get the polar value.
- --> add 45000 in total
- --> finally convert to [0,0xFFFF] as in case SDL_HAPTIC_POLAR.
- */
- tmp = (((Sint32)(f * 18000.0 / SDL_PI_D)) + 45000) % 36000;
- tmp = (tmp * 0x8000) / 18000; // convert to range [0,0xFFFF]
- *dest = (Uint16)tmp;
- }
- break;
- case SDL_HAPTIC_STEERING_AXIS:
- *dest = 0x4000;
- break;
- default:
- return SDL_SetError("Haptic: Unsupported direction type.");
- }
- return true;
- }
- #define CLAMP(x) (((x) > 32767) ? 32767 : x)
- /*
- * Initializes the Linux effect struct from a haptic_effect.
- * Values above 32767 (for unsigned) are unspecified so we must clamp.
- */
- static bool SDL_SYS_ToFFEffect(struct ff_effect *dest, const SDL_HapticEffect *src)
- {
- const SDL_HapticConstant *constant;
- const SDL_HapticPeriodic *periodic;
- const SDL_HapticCondition *condition;
- const SDL_HapticRamp *ramp;
- const SDL_HapticLeftRight *leftright;
- // Clear up
- SDL_memset(dest, 0, sizeof(struct ff_effect));
- switch (src->type) {
- case SDL_HAPTIC_CONSTANT:
- constant = &src->constant;
- // Header
- dest->type = FF_CONSTANT;
- if (!SDL_SYS_ToDirection(&dest->direction, &constant->direction)) {
- return false;
- }
- // Replay
- dest->replay.length = (constant->length == SDL_HAPTIC_INFINITY) ? 0 : CLAMP(constant->length);
- dest->replay.delay = CLAMP(constant->delay);
- // Trigger
- dest->trigger.button = SDL_SYS_ToButton(constant->button);
- dest->trigger.interval = CLAMP(constant->interval);
- // Constant
- dest->u.constant.level = constant->level;
- // Envelope
- 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);
- break;
- case SDL_HAPTIC_SINE:
- case SDL_HAPTIC_SQUARE:
- case SDL_HAPTIC_TRIANGLE:
- case SDL_HAPTIC_SAWTOOTHUP:
- case SDL_HAPTIC_SAWTOOTHDOWN:
- periodic = &src->periodic;
- // Header
- dest->type = FF_PERIODIC;
- if (!SDL_SYS_ToDirection(&dest->direction, &periodic->direction)) {
- return false;
- }
- // Replay
- dest->replay.length = (periodic->length == SDL_HAPTIC_INFINITY) ? 0 : CLAMP(periodic->length);
- dest->replay.delay = CLAMP(periodic->delay);
- // Trigger
- dest->trigger.button = SDL_SYS_ToButton(periodic->button);
- dest->trigger.interval = CLAMP(periodic->interval);
- // 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;
- }
- dest->u.periodic.period = CLAMP(periodic->period);
- dest->u.periodic.magnitude = periodic->magnitude;
- dest->u.periodic.offset = periodic->offset;
- // Linux phase is defined in interval "[0x0000, 0x10000[", corresponds with "[0deg, 360deg[" phase shift.
- dest->u.periodic.phase = ((Uint32)periodic->phase * 0x10000U) / 36000;
- // Envelope
- 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);
- break;
- case SDL_HAPTIC_SPRING:
- case SDL_HAPTIC_DAMPER:
- case SDL_HAPTIC_INERTIA:
- case SDL_HAPTIC_FRICTION:
- condition = &src->condition;
- // Header
- if (condition->type == SDL_HAPTIC_SPRING) {
- dest->type = FF_SPRING;
- } else if (condition->type == SDL_HAPTIC_DAMPER) {
- dest->type = FF_DAMPER;
- } else if (condition->type == SDL_HAPTIC_INERTIA) {
- dest->type = FF_INERTIA;
- } else if (condition->type == SDL_HAPTIC_FRICTION) {
- dest->type = FF_FRICTION;
- }
- if (!SDL_SYS_ToDirection(&dest->direction, &condition->direction)) {
- return false;
- }
- // Replay
- dest->replay.length = (condition->length == SDL_HAPTIC_INFINITY) ? 0 : CLAMP(condition->length);
- dest->replay.delay = CLAMP(condition->delay);
- // Trigger
- dest->trigger.button = SDL_SYS_ToButton(condition->button);
- dest->trigger.interval = CLAMP(condition->interval);
- // Condition
- // X axis
- dest->u.condition[0].right_saturation = condition->right_sat[0];
- dest->u.condition[0].left_saturation = 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 = condition->deadband[0];
- dest->u.condition[0].center = condition->center[0];
- // Y axis
- dest->u.condition[1].right_saturation = condition->right_sat[1];
- dest->u.condition[1].left_saturation = 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 = condition->deadband[1];
- dest->u.condition[1].center = condition->center[1];
- /*
- * There is no envelope in the linux force feedback api for conditions.
- */
- break;
- case SDL_HAPTIC_RAMP:
- ramp = &src->ramp;
- // Header
- dest->type = FF_RAMP;
- if (!SDL_SYS_ToDirection(&dest->direction, &ramp->direction)) {
- return false;
- }
- // Replay
- dest->replay.length = (ramp->length == SDL_HAPTIC_INFINITY) ? 0 : CLAMP(ramp->length);
- dest->replay.delay = CLAMP(ramp->delay);
- // Trigger
- dest->trigger.button = SDL_SYS_ToButton(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;
- case SDL_HAPTIC_LEFTRIGHT:
- leftright = &src->leftright;
- // Header
- dest->type = FF_RUMBLE;
- dest->direction = 0x4000;
- // Replay
- dest->replay.length = (leftright->length == SDL_HAPTIC_INFINITY) ? 0 : CLAMP(leftright->length);
- // Trigger
- dest->trigger.button = 0;
- dest->trigger.interval = 0;
- // Rumble (Linux expects 0-65535, so multiply by 2)
- dest->u.rumble.strong_magnitude = CLAMP(leftright->large_magnitude) * 2;
- dest->u.rumble.weak_magnitude = CLAMP(leftright->small_magnitude) * 2;
- break;
- default:
- return SDL_SetError("Haptic: Unknown effect type.");
- }
- return true;
- }
- /*
- * Creates a new haptic effect.
- */
- bool SDL_SYS_HapticNewEffect(SDL_Haptic *haptic, struct haptic_effect *effect,
- const SDL_HapticEffect *base)
- {
- struct ff_effect *linux_effect;
- // Allocate the hardware effect
- effect->hweffect = (struct haptic_hweffect *)
- SDL_calloc(1, sizeof(struct haptic_hweffect));
- if (!effect->hweffect) {
- return false;
- }
- // Prepare the ff_effect
- linux_effect = &effect->hweffect->effect;
- if (!SDL_SYS_ToFFEffect(linux_effect, base)) {
- goto new_effect_err;
- }
- linux_effect->id = -1; // Have the kernel give it an id
- // Upload the effect
- if (ioctl(haptic->hwdata->fd, EVIOCSFF, linux_effect) < 0) {
- SDL_SetError("Haptic: Error uploading effect to the device: %s",
- strerror(errno));
- goto new_effect_err;
- }
- return true;
- new_effect_err:
- SDL_free(effect->hweffect);
- effect->hweffect = NULL;
- return false;
- }
- /*
- * Updates an effect.
- *
- * Note: Dynamically updating the direction can in some cases force
- * the effect to restart and run once.
- */
- bool SDL_SYS_HapticUpdateEffect(SDL_Haptic *haptic,
- struct haptic_effect *effect,
- const SDL_HapticEffect *data)
- {
- struct ff_effect linux_effect;
- // Create the new effect
- if (!SDL_SYS_ToFFEffect(&linux_effect, data)) {
- return false;
- }
- linux_effect.id = effect->hweffect->effect.id;
- // See if it can be uploaded.
- if (ioctl(haptic->hwdata->fd, EVIOCSFF, &linux_effect) < 0) {
- return SDL_SetError("Haptic: Error updating the effect: %s",
- strerror(errno));
- }
- // Copy the new effect into memory.
- SDL_memcpy(&effect->hweffect->effect, &linux_effect,
- sizeof(struct ff_effect));
- return true;
- }
- /*
- * Runs an effect.
- */
- bool SDL_SYS_HapticRunEffect(SDL_Haptic *haptic, struct haptic_effect *effect,
- Uint32 iterations)
- {
- struct input_event run;
- // Prepare to run the effect
- run.type = EV_FF;
- run.code = effect->hweffect->effect.id;
- // We don't actually have infinity here, so we just do INT_MAX which is pretty damn close.
- run.value = (iterations > INT_MAX) ? INT_MAX : iterations;
- if (write(haptic->hwdata->fd, (const void *)&run, sizeof(run)) < 0) {
- return SDL_SetError("Haptic: Unable to run the effect: %s", strerror(errno));
- }
- return true;
- }
- /*
- * Stops an effect.
- */
- bool 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) {
- return SDL_SetError("Haptic: Unable to stop the effect: %s",
- strerror(errno));
- }
- return true;
- }
- /*
- * Frees the effect.
- */
- void SDL_SYS_HapticDestroyEffect(SDL_Haptic *haptic, struct haptic_effect *effect)
- {
- if (ioctl(haptic->hwdata->fd, EVIOCRMFF, effect->hweffect->effect.id) < 0) {
- SDL_SetError("Haptic: Error removing the effect from the device: %s",
- strerror(errno));
- }
- SDL_free(effect->hweffect);
- effect->hweffect = NULL;
- }
- /*
- * 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) {
- SDL_SetError("Haptic: Error getting device status.");
- return -1;
- }
- return 1;
- #endif
- SDL_Unsupported();
- return -1;
- }
- /*
- * Sets the gain.
- */
- bool 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;
- if (write(haptic->hwdata->fd, &ie, sizeof(ie)) < 0) {
- return SDL_SetError("Haptic: Error setting gain: %s", strerror(errno));
- }
- return true;
- }
- /*
- * Sets the autocentering.
- */
- bool 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) {
- return SDL_SetError("Haptic: Error setting autocenter: %s", strerror(errno));
- }
- return true;
- }
- /*
- * Pausing is not supported atm by linux.
- */
- bool SDL_SYS_HapticPause(SDL_Haptic *haptic)
- {
- return SDL_Unsupported();
- }
- /*
- * Unpausing is not supported atm by linux.
- */
- bool SDL_SYS_HapticResume(SDL_Haptic *haptic)
- {
- return SDL_Unsupported();
- }
- /*
- * Stops all the currently playing effects.
- */
- bool SDL_SYS_HapticStopAll(SDL_Haptic *haptic)
- {
- int i, ret;
- // Linux does not support this natively so we have to loop.
- for (i = 0; i < haptic->neffects; i++) {
- if (haptic->effects[i].hweffect != NULL) {
- ret = SDL_SYS_HapticStopEffect(haptic, &haptic->effects[i]);
- if (ret < 0) {
- return SDL_SetError("Haptic: Error while trying to stop all playing effects.");
- }
- }
- }
- return true;
- }
- #endif // SDL_HAPTIC_LINUX
|