summaryrefslogtreecommitdiff
path: root/source/3rd-party/SDL2/src/sensor/SDL_sensor.c
diff options
context:
space:
mode:
authorchai <chaifix@163.com>2019-05-11 22:54:56 +0800
committerchai <chaifix@163.com>2019-05-11 22:54:56 +0800
commit9645be0af1b1d5cb0ad5892d5464e1b23c51b550 (patch)
tree129c716bed8e93312421c3adb2f8e7c4f811602d /source/3rd-party/SDL2/src/sensor/SDL_sensor.c
Diffstat (limited to 'source/3rd-party/SDL2/src/sensor/SDL_sensor.c')
-rw-r--r--source/3rd-party/SDL2/src/sensor/SDL_sensor.c546
1 files changed, 546 insertions, 0 deletions
diff --git a/source/3rd-party/SDL2/src/sensor/SDL_sensor.c b/source/3rd-party/SDL2/src/sensor/SDL_sensor.c
new file mode 100644
index 0000000..5c7a990
--- /dev/null
+++ b/source/3rd-party/SDL2/src/sensor/SDL_sensor.c
@@ -0,0 +1,546 @@
+/*
+ Simple DirectMedia Layer
+ Copyright (C) 1997-2018 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"
+
+/* This is the sensor API for Simple DirectMedia Layer */
+
+#include "SDL.h"
+#include "SDL_atomic.h"
+#include "SDL_events.h"
+#include "SDL_syssensor.h"
+#include "SDL_assert.h"
+
+#if !SDL_EVENTS_DISABLED
+#include "../events/SDL_events_c.h"
+#endif
+
+static SDL_SensorDriver *SDL_sensor_drivers[] = {
+#ifdef SDL_SENSOR_ANDROID
+ &SDL_ANDROID_SensorDriver,
+#endif
+#ifdef SDL_SENSOR_COREMOTION
+ &SDL_COREMOTION_SensorDriver,
+#endif
+#if defined(SDL_SENSOR_DUMMY) || defined(SDL_SENSOR_DISABLED)
+ &SDL_DUMMY_SensorDriver
+#endif
+};
+static SDL_Sensor *SDL_sensors = NULL;
+static SDL_bool SDL_updating_sensor = SDL_FALSE;
+static SDL_mutex *SDL_sensor_lock = NULL; /* This needs to support recursive locks */
+static SDL_atomic_t SDL_next_sensor_instance_id;
+
+static void
+SDL_LockSensors(void)
+{
+ if (SDL_sensor_lock) {
+ SDL_LockMutex(SDL_sensor_lock);
+ }
+}
+
+static void
+SDL_UnlockSensors(void)
+{
+ if (SDL_sensor_lock) {
+ SDL_UnlockMutex(SDL_sensor_lock);
+ }
+}
+
+
+int
+SDL_SensorInit(void)
+{
+ int i, status;
+
+ /* Create the sensor list lock */
+ if (!SDL_sensor_lock) {
+ SDL_sensor_lock = SDL_CreateMutex();
+ }
+
+#if !SDL_EVENTS_DISABLED
+ if (SDL_InitSubSystem(SDL_INIT_EVENTS) < 0) {
+ return -1;
+ }
+#endif /* !SDL_EVENTS_DISABLED */
+
+ status = -1;
+ for (i = 0; i < SDL_arraysize(SDL_sensor_drivers); ++i) {
+ if (SDL_sensor_drivers[i]->Init() >= 0) {
+ status = 0;
+ }
+ }
+ return status;
+}
+
+/*
+ * Count the number of sensors attached to the system
+ */
+int
+SDL_NumSensors(void)
+{
+ int i, total_sensors = 0;
+ SDL_LockSensors();
+ for (i = 0; i < SDL_arraysize(SDL_sensor_drivers); ++i) {
+ total_sensors += SDL_sensor_drivers[i]->GetCount();
+ }
+ SDL_UnlockSensors();
+ return total_sensors;
+}
+
+/*
+ * Return the next available sensor instance ID
+ * This may be called by drivers from multiple threads, unprotected by any locks
+ */
+SDL_SensorID SDL_GetNextSensorInstanceID()
+{
+ return SDL_AtomicIncRef(&SDL_next_sensor_instance_id);
+}
+
+/*
+ * Get the driver and device index for an API device index
+ * This should be called while the sensor lock is held, to prevent another thread from updating the list
+ */
+static SDL_bool
+SDL_GetDriverAndSensorIndex(int device_index, SDL_SensorDriver **driver, int *driver_index)
+{
+ int i, num_sensors, total_sensors = 0;
+
+ if (device_index >= 0) {
+ for (i = 0; i < SDL_arraysize(SDL_sensor_drivers); ++i) {
+ num_sensors = SDL_sensor_drivers[i]->GetCount();
+ if (device_index < num_sensors) {
+ *driver = SDL_sensor_drivers[i];
+ *driver_index = device_index;
+ return SDL_TRUE;
+ }
+ device_index -= num_sensors;
+ total_sensors += num_sensors;
+ }
+ }
+
+ SDL_SetError("There are %d sensors available", total_sensors);
+ return SDL_FALSE;
+}
+
+/*
+ * Get the implementation dependent name of a sensor
+ */
+const char *
+SDL_SensorGetDeviceName(int device_index)
+{
+ SDL_SensorDriver *driver;
+ const char *name = NULL;
+
+ SDL_LockSensors();
+ if (SDL_GetDriverAndSensorIndex(device_index, &driver, &device_index)) {
+ name = driver->GetDeviceName(device_index);
+ }
+ SDL_UnlockSensors();
+
+ /* FIXME: Really we should reference count this name so it doesn't go away after unlock */
+ return name;
+}
+
+SDL_SensorType
+SDL_SensorGetDeviceType(int device_index)
+{
+ SDL_SensorDriver *driver;
+ SDL_SensorType type = SDL_SENSOR_INVALID;
+
+ SDL_LockSensors();
+ if (SDL_GetDriverAndSensorIndex(device_index, &driver, &device_index)) {
+ type = driver->GetDeviceType(device_index);
+ }
+ SDL_UnlockSensors();
+
+ return type;
+}
+
+SDL_SensorType
+SDL_SensorGetDeviceNonPortableType(int device_index)
+{
+ SDL_SensorDriver *driver;
+ int type = -1;
+
+ SDL_LockSensors();
+ if (SDL_GetDriverAndSensorIndex(device_index, &driver, &device_index)) {
+ type = driver->GetDeviceNonPortableType(device_index);
+ }
+ SDL_UnlockSensors();
+
+ return type;
+}
+
+SDL_SensorID
+SDL_SensorGetDeviceInstanceID(int device_index)
+{
+ SDL_SensorDriver *driver;
+ SDL_SensorID instance_id = -1;
+
+ SDL_LockSensors();
+ if (SDL_GetDriverAndSensorIndex(device_index, &driver, &device_index)) {
+ instance_id = driver->GetDeviceInstanceID(device_index);
+ }
+ SDL_UnlockSensors();
+
+ return instance_id;
+}
+
+/*
+ * Open a sensor for use - the index passed as an argument refers to
+ * the N'th sensor on the system. This index is the value which will
+ * identify this sensor in future sensor events.
+ *
+ * This function returns a sensor identifier, or NULL if an error occurred.
+ */
+SDL_Sensor *
+SDL_SensorOpen(int device_index)
+{
+ SDL_SensorDriver *driver;
+ SDL_SensorID instance_id;
+ SDL_Sensor *sensor;
+ SDL_Sensor *sensorlist;
+ const char *sensorname = NULL;
+
+ SDL_LockSensors();
+
+ if (!SDL_GetDriverAndSensorIndex(device_index, &driver, &device_index)) {
+ SDL_UnlockSensors();
+ return NULL;
+ }
+
+ sensorlist = SDL_sensors;
+ /* If the sensor is already open, return it
+ * it is important that we have a single sensor * for each instance id
+ */
+ instance_id = driver->GetDeviceInstanceID(device_index);
+ while (sensorlist) {
+ if (instance_id == sensorlist->instance_id) {
+ sensor = sensorlist;
+ ++sensor->ref_count;
+ SDL_UnlockSensors();
+ return sensor;
+ }
+ sensorlist = sensorlist->next;
+ }
+
+ /* Create and initialize the sensor */
+ sensor = (SDL_Sensor *) SDL_calloc(sizeof(*sensor), 1);
+ if (sensor == NULL) {
+ SDL_OutOfMemory();
+ SDL_UnlockSensors();
+ return NULL;
+ }
+ sensor->driver = driver;
+ sensor->instance_id = instance_id;
+ sensor->type = driver->GetDeviceType(device_index);
+ sensor->non_portable_type = driver->GetDeviceNonPortableType(device_index);
+
+ if (driver->Open(sensor, device_index) < 0) {
+ SDL_free(sensor);
+ SDL_UnlockSensors();
+ return NULL;
+ }
+
+ sensorname = driver->GetDeviceName(device_index);
+ if (sensorname) {
+ sensor->name = SDL_strdup(sensorname);
+ } else {
+ sensor->name = NULL;
+ }
+
+ /* Add sensor to list */
+ ++sensor->ref_count;
+ /* Link the sensor in the list */
+ sensor->next = SDL_sensors;
+ SDL_sensors = sensor;
+
+ SDL_UnlockSensors();
+
+ driver->Update(sensor);
+
+ return sensor;
+}
+
+/*
+ * Find the SDL_Sensor that owns this instance id
+ */
+SDL_Sensor *
+SDL_SensorFromInstanceID(SDL_SensorID instance_id)
+{
+ SDL_Sensor *sensor;
+
+ SDL_LockSensors();
+ for (sensor = SDL_sensors; sensor; sensor = sensor->next) {
+ if (sensor->instance_id == instance_id) {
+ break;
+ }
+ }
+ SDL_UnlockSensors();
+ return sensor;
+}
+
+/*
+ * Checks to make sure the sensor is valid.
+ */
+static int
+SDL_PrivateSensorValid(SDL_Sensor * sensor)
+{
+ int valid;
+
+ if (sensor == NULL) {
+ SDL_SetError("Sensor hasn't been opened yet");
+ valid = 0;
+ } else {
+ valid = 1;
+ }
+
+ return valid;
+}
+
+/*
+ * Get the friendly name of this sensor
+ */
+const char *
+SDL_SensorGetName(SDL_Sensor * sensor)
+{
+ if (!SDL_PrivateSensorValid(sensor)) {
+ return NULL;
+ }
+
+ return sensor->name;
+}
+
+/*
+ * Get the type of this sensor
+ */
+SDL_SensorType
+SDL_SensorGetType(SDL_Sensor * sensor)
+{
+ if (!SDL_PrivateSensorValid(sensor)) {
+ return SDL_SENSOR_INVALID;
+ }
+
+ return sensor->type;
+}
+
+/*
+ * Get the platform dependent type of this sensor
+ */
+int
+SDL_SensorGetNonPortableType(SDL_Sensor * sensor)
+{
+ if (!SDL_PrivateSensorValid(sensor)) {
+ return -1;
+ }
+
+ return sensor->non_portable_type;
+}
+
+/*
+ * Get the instance id for this opened sensor
+ */
+SDL_SensorID
+SDL_SensorGetInstanceID(SDL_Sensor * sensor)
+{
+ if (!SDL_PrivateSensorValid(sensor)) {
+ return -1;
+ }
+
+ return sensor->instance_id;
+}
+
+/*
+ * Get the current state of this sensor
+ */
+int
+SDL_SensorGetData(SDL_Sensor * sensor, float *data, int num_values)
+{
+ if (!SDL_PrivateSensorValid(sensor)) {
+ return -1;
+ }
+
+ num_values = SDL_min(num_values, SDL_arraysize(sensor->data));
+ SDL_memcpy(data, sensor->data, num_values*sizeof(*data));
+ return 0;
+}
+
+/*
+ * Close a sensor previously opened with SDL_SensorOpen()
+ */
+void
+SDL_SensorClose(SDL_Sensor * sensor)
+{
+ SDL_Sensor *sensorlist;
+ SDL_Sensor *sensorlistprev;
+
+ if (!SDL_PrivateSensorValid(sensor)) {
+ return;
+ }
+
+ SDL_LockSensors();
+
+ /* First decrement ref count */
+ if (--sensor->ref_count > 0) {
+ SDL_UnlockSensors();
+ return;
+ }
+
+ if (SDL_updating_sensor) {
+ SDL_UnlockSensors();
+ return;
+ }
+
+ sensor->driver->Close(sensor);
+ sensor->hwdata = NULL;
+
+ sensorlist = SDL_sensors;
+ sensorlistprev = NULL;
+ while (sensorlist) {
+ if (sensor == sensorlist) {
+ if (sensorlistprev) {
+ /* unlink this entry */
+ sensorlistprev->next = sensorlist->next;
+ } else {
+ SDL_sensors = sensor->next;
+ }
+ break;
+ }
+ sensorlistprev = sensorlist;
+ sensorlist = sensorlist->next;
+ }
+
+ SDL_free(sensor->name);
+
+ /* Free the data associated with this sensor */
+ SDL_free(sensor);
+
+ SDL_UnlockSensors();
+}
+
+void
+SDL_SensorQuit(void)
+{
+ int i;
+
+ /* Make sure we're not getting called in the middle of updating sensors */
+ SDL_assert(!SDL_updating_sensor);
+
+ SDL_LockSensors();
+
+ /* Stop the event polling */
+ while (SDL_sensors) {
+ SDL_sensors->ref_count = 1;
+ SDL_SensorClose(SDL_sensors);
+ }
+
+ /* Quit the sensor setup */
+ for (i = 0; i < SDL_arraysize(SDL_sensor_drivers); ++i) {
+ SDL_sensor_drivers[i]->Quit();
+ }
+
+ SDL_UnlockSensors();
+
+#if !SDL_EVENTS_DISABLED
+ SDL_QuitSubSystem(SDL_INIT_EVENTS);
+#endif
+
+ if (SDL_sensor_lock) {
+ SDL_DestroyMutex(SDL_sensor_lock);
+ SDL_sensor_lock = NULL;
+ }
+}
+
+
+/* These are global for SDL_syssensor.c and SDL_events.c */
+
+int
+SDL_PrivateSensorUpdate(SDL_Sensor *sensor, float *data, int num_values)
+{
+ int posted;
+
+ /* Allow duplicate events, for things like steps and heartbeats */
+
+ /* Update internal sensor state */
+ num_values = SDL_min(num_values, SDL_arraysize(sensor->data));
+ SDL_memcpy(sensor->data, data, num_values*sizeof(*data));
+
+ /* Post the event, if desired */
+ posted = 0;
+#if !SDL_EVENTS_DISABLED
+ if (SDL_GetEventState(SDL_JOYAXISMOTION) == SDL_ENABLE) {
+ SDL_Event event;
+ event.type = SDL_SENSORUPDATE;
+ event.sensor.which = sensor->instance_id;
+ num_values = SDL_min(num_values, SDL_arraysize(event.sensor.data));
+ SDL_memset(event.sensor.data, 0, sizeof(event.sensor.data));
+ SDL_memcpy(event.sensor.data, data, num_values*sizeof(*data));
+ posted = SDL_PushEvent(&event) == 1;
+ }
+#endif /* !SDL_EVENTS_DISABLED */
+ return posted;
+}
+
+void
+SDL_SensorUpdate(void)
+{
+ int i;
+ SDL_Sensor *sensor;
+
+ SDL_LockSensors();
+
+ if (SDL_updating_sensor) {
+ /* The sensors are already being updated */
+ SDL_UnlockSensors();
+ return;
+ }
+
+ SDL_updating_sensor = SDL_TRUE;
+
+ /* Make sure the list is unlocked while dispatching events to prevent application deadlocks */
+ SDL_UnlockSensors();
+
+ for (sensor = SDL_sensors; sensor; sensor = sensor->next) {
+ sensor->driver->Update(sensor);
+ }
+
+ SDL_LockSensors();
+
+ SDL_updating_sensor = SDL_FALSE;
+
+ /* If any sensors were closed while updating, free them here */
+ for (sensor = SDL_sensors; sensor; sensor = sensor->next) {
+ if (sensor->ref_count <= 0) {
+ SDL_SensorClose(sensor);
+ }
+ }
+
+ /* this needs to happen AFTER walking the sensor list above, so that any
+ dangling hardware data from removed devices can be free'd
+ */
+ for (i = 0; i < SDL_arraysize(SDL_sensor_drivers); ++i) {
+ SDL_sensor_drivers[i]->Detect();
+ }
+
+ SDL_UnlockSensors();
+}
+
+/* vi: set ts=4 sw=4 expandtab: */