/*
|
Simple DirectMedia Layer
|
Copyright (C) 1997-2020 Sam Lantinga <slouken@libsdl.org>
|
|
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_JOYSTICK_HIDAPI
|
|
/* Handle rumble on a separate thread so it doesn't block the application */
|
|
#include "SDL_assert.h"
|
#include "SDL_thread.h"
|
#include "SDL_hidapijoystick_c.h"
|
#include "SDL_hidapi_rumble.h"
|
#include "../../thread/SDL_systhread.h"
|
|
|
typedef struct SDL_HIDAPI_RumbleRequest
|
{
|
SDL_HIDAPI_Device *device;
|
Uint8 data[2*USB_PACKET_LENGTH]; /* need enough space for the biggest report: dualshock4 is 78 bytes */
|
int size;
|
struct SDL_HIDAPI_RumbleRequest *prev;
|
|
} SDL_HIDAPI_RumbleRequest;
|
|
typedef struct SDL_HIDAPI_RumbleContext
|
{
|
SDL_atomic_t initialized;
|
SDL_atomic_t running;
|
SDL_Thread *thread;
|
SDL_mutex *lock;
|
SDL_sem *request_sem;
|
SDL_HIDAPI_RumbleRequest *requests_head;
|
SDL_HIDAPI_RumbleRequest *requests_tail;
|
} SDL_HIDAPI_RumbleContext;
|
|
static SDL_HIDAPI_RumbleContext rumble_context;
|
|
static int SDL_HIDAPI_RumbleThread(void *data)
|
{
|
SDL_HIDAPI_RumbleContext *ctx = (SDL_HIDAPI_RumbleContext *)data;
|
|
SDL_SetThreadPriority(SDL_THREAD_PRIORITY_HIGH);
|
|
while (SDL_AtomicGet(&ctx->running)) {
|
SDL_HIDAPI_RumbleRequest *request = NULL;
|
|
SDL_SemWait(ctx->request_sem);
|
|
SDL_LockMutex(ctx->lock);
|
request = ctx->requests_tail;
|
if (request) {
|
if (request == ctx->requests_head) {
|
ctx->requests_head = NULL;
|
}
|
ctx->requests_tail = request->prev;
|
}
|
SDL_UnlockMutex(ctx->lock);
|
|
if (request) {
|
SDL_LockMutex(request->device->dev_lock);
|
if (request->device->dev) {
|
hid_write( request->device->dev, request->data, request->size );
|
}
|
SDL_UnlockMutex(request->device->dev_lock);
|
(void)SDL_AtomicDecRef(&request->device->rumble_pending);
|
SDL_free(request);
|
}
|
}
|
return 0;
|
}
|
|
static void
|
SDL_HIDAPI_StopRumbleThread(SDL_HIDAPI_RumbleContext *ctx)
|
{
|
SDL_AtomicSet(&ctx->running, SDL_FALSE);
|
|
if (ctx->thread) {
|
int result;
|
|
SDL_SemPost(ctx->request_sem);
|
SDL_WaitThread(ctx->thread, &result);
|
ctx->thread = NULL;
|
}
|
|
/* This should always be called with an empty queue */
|
SDL_assert(!ctx->requests_head);
|
SDL_assert(!ctx->requests_tail);
|
|
if (ctx->request_sem) {
|
SDL_DestroySemaphore(ctx->request_sem);
|
ctx->request_sem = NULL;
|
}
|
|
if (ctx->lock) {
|
SDL_DestroyMutex(ctx->lock);
|
ctx->lock = NULL;
|
}
|
|
SDL_AtomicSet(&ctx->initialized, SDL_FALSE);
|
}
|
|
static int
|
SDL_HIDAPI_StartRumbleThread(SDL_HIDAPI_RumbleContext *ctx)
|
{
|
ctx->lock = SDL_CreateMutex();
|
if (!ctx->lock) {
|
SDL_HIDAPI_StopRumbleThread(ctx);
|
return -1;
|
}
|
|
ctx->request_sem = SDL_CreateSemaphore(0);
|
if (!ctx->request_sem) {
|
SDL_HIDAPI_StopRumbleThread(ctx);
|
return -1;
|
}
|
|
SDL_AtomicSet(&ctx->running, SDL_TRUE);
|
ctx->thread = SDL_CreateThreadInternal(SDL_HIDAPI_RumbleThread, "HIDAPI Rumble", 0, ctx);
|
if (!ctx->thread) {
|
SDL_HIDAPI_StopRumbleThread(ctx);
|
return -1;
|
}
|
return 0;
|
}
|
|
int SDL_HIDAPI_LockRumble(void)
|
{
|
SDL_HIDAPI_RumbleContext *ctx = &rumble_context;
|
|
if (SDL_AtomicCAS(&ctx->initialized, SDL_FALSE, SDL_TRUE)) {
|
if (SDL_HIDAPI_StartRumbleThread(ctx) < 0) {
|
return -1;
|
}
|
}
|
|
return SDL_LockMutex(ctx->lock);
|
}
|
|
SDL_bool SDL_HIDAPI_GetPendingRumbleLocked(SDL_HIDAPI_Device *device, Uint8 **data, int **size, int *maximum_size)
|
{
|
SDL_HIDAPI_RumbleContext *ctx = &rumble_context;
|
SDL_HIDAPI_RumbleRequest *request;
|
|
for (request = ctx->requests_tail; request; request = request->prev) {
|
if (request->device == device) {
|
*data = request->data;
|
*size = &request->size;
|
*maximum_size = sizeof(request->data);
|
return SDL_TRUE;
|
}
|
}
|
return SDL_FALSE;
|
}
|
|
int SDL_HIDAPI_SendRumbleAndUnlock(SDL_HIDAPI_Device *device, const Uint8 *data, int size)
|
{
|
SDL_HIDAPI_RumbleContext *ctx = &rumble_context;
|
SDL_HIDAPI_RumbleRequest *request;
|
|
if (size > sizeof(request->data)) {
|
SDL_HIDAPI_UnlockRumble();
|
return SDL_SetError("Couldn't send rumble, size %d is greater than %d", size, (int)sizeof(request->data));
|
}
|
|
request = (SDL_HIDAPI_RumbleRequest *)SDL_calloc(1, sizeof(*request));
|
if (!request) {
|
SDL_HIDAPI_UnlockRumble();
|
return SDL_OutOfMemory();
|
}
|
request->device = device;
|
SDL_memcpy(request->data, data, size);
|
request->size = size;
|
|
SDL_AtomicIncRef(&device->rumble_pending);
|
|
if (ctx->requests_head) {
|
ctx->requests_head->prev = request;
|
} else {
|
ctx->requests_tail = request;
|
}
|
ctx->requests_head = request;
|
|
/* Make sure we unlock before posting the semaphore so the rumble thread can run immediately */
|
SDL_HIDAPI_UnlockRumble();
|
|
SDL_SemPost(ctx->request_sem);
|
|
return size;
|
}
|
|
void SDL_HIDAPI_UnlockRumble(void)
|
{
|
SDL_HIDAPI_RumbleContext *ctx = &rumble_context;
|
|
SDL_UnlockMutex(ctx->lock);
|
}
|
|
int SDL_HIDAPI_SendRumble(SDL_HIDAPI_Device *device, const Uint8 *data, int size)
|
{
|
Uint8 *pending_data;
|
int *pending_size;
|
int maximum_size;
|
|
if (SDL_HIDAPI_LockRumble() < 0) {
|
return -1;
|
}
|
|
/* check if there is a pending request for the device and update it */
|
if (SDL_HIDAPI_GetPendingRumbleLocked(device, &pending_data, &pending_size, &maximum_size)) {
|
if (size > maximum_size) {
|
SDL_HIDAPI_UnlockRumble();
|
return SDL_SetError("Couldn't send rumble, size %d is greater than %d", size, maximum_size);
|
}
|
|
SDL_memcpy(pending_data, data, size);
|
*pending_size = size;
|
SDL_HIDAPI_UnlockRumble();
|
return size;
|
}
|
|
return SDL_HIDAPI_SendRumbleAndUnlock(device, data, size);
|
}
|
|
void SDL_HIDAPI_QuitRumble(void)
|
{
|
SDL_HIDAPI_RumbleContext *ctx = &rumble_context;
|
|
if (SDL_AtomicGet(&ctx->running)) {
|
SDL_HIDAPI_StopRumbleThread(ctx);
|
}
|
}
|
|
#endif /* SDL_JOYSTICK_HIDAPI */
|
|
/* vi: set ts=4 sw=4 expandtab: */
|
