| /* |
| Simple DirectMedia Layer |
| Copyright (C) 1997-2021 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_config.h" |
| |
| #ifdef SDL_SENSOR_COREMOTION |
| |
| /* This is the system specific header for the SDL sensor API */ |
| #include <CoreMotion/CoreMotion.h> |
| |
| #include "SDL_error.h" |
| #include "SDL_sensor.h" |
| #include "SDL_coremotionsensor.h" |
| #include "../SDL_syssensor.h" |
| #include "../SDL_sensor_c.h" |
| |
| typedef struct |
| { |
| SDL_SensorType type; |
| SDL_SensorID instance_id; |
| } SDL_CoreMotionSensor; |
| |
| static CMMotionManager *SDL_motion_manager; |
| static SDL_CoreMotionSensor *SDL_sensors; |
| static int SDL_sensors_count; |
| |
| static int |
| SDL_COREMOTION_SensorInit(void) |
| { |
| int i, sensors_count = 0; |
| |
| if (!SDL_motion_manager) { |
| SDL_motion_manager = [[CMMotionManager alloc] init]; |
| } |
| |
| if (SDL_motion_manager.accelerometerAvailable) { |
| ++sensors_count; |
| } |
| if (SDL_motion_manager.gyroAvailable) { |
| ++sensors_count; |
| } |
| |
| if (sensors_count > 0) { |
| SDL_sensors = (SDL_CoreMotionSensor *)SDL_calloc(sensors_count, sizeof(*SDL_sensors)); |
| if (!SDL_sensors) { |
| return SDL_OutOfMemory(); |
| } |
| |
| i = 0; |
| if (SDL_motion_manager.accelerometerAvailable) { |
| SDL_sensors[i].type = SDL_SENSOR_ACCEL; |
| SDL_sensors[i].instance_id = SDL_GetNextSensorInstanceID(); |
| ++i; |
| } |
| if (SDL_motion_manager.gyroAvailable) { |
| SDL_sensors[i].type = SDL_SENSOR_GYRO; |
| SDL_sensors[i].instance_id = SDL_GetNextSensorInstanceID(); |
| ++i; |
| } |
| SDL_sensors_count = sensors_count; |
| } |
| return 0; |
| } |
| |
| static int |
| SDL_COREMOTION_SensorGetCount(void) |
| { |
| return SDL_sensors_count; |
| } |
| |
| static void |
| SDL_COREMOTION_SensorDetect(void) |
| { |
| } |
| |
| static const char * |
| SDL_COREMOTION_SensorGetDeviceName(int device_index) |
| { |
| switch (SDL_sensors[device_index].type) { |
| case SDL_SENSOR_ACCEL: |
| return "Accelerometer"; |
| case SDL_SENSOR_GYRO: |
| return "Gyro"; |
| default: |
| return "Unknown"; |
| } |
| } |
| |
| static SDL_SensorType |
| SDL_COREMOTION_SensorGetDeviceType(int device_index) |
| { |
| return SDL_sensors[device_index].type; |
| } |
| |
| static int |
| SDL_COREMOTION_SensorGetDeviceNonPortableType(int device_index) |
| { |
| return SDL_sensors[device_index].type; |
| } |
| |
| static SDL_SensorID |
| SDL_COREMOTION_SensorGetDeviceInstanceID(int device_index) |
| { |
| return SDL_sensors[device_index].instance_id; |
| } |
| |
| static int |
| SDL_COREMOTION_SensorOpen(SDL_Sensor *sensor, int device_index) |
| { |
| struct sensor_hwdata *hwdata; |
| |
| hwdata = (struct sensor_hwdata *)SDL_calloc(1, sizeof(*hwdata)); |
| if (hwdata == NULL) { |
| return SDL_OutOfMemory(); |
| } |
| sensor->hwdata = hwdata; |
| |
| switch (sensor->type) |
| { |
| case SDL_SENSOR_ACCEL: |
| [SDL_motion_manager startAccelerometerUpdates]; |
| break; |
| case SDL_SENSOR_GYRO: |
| [SDL_motion_manager startGyroUpdates]; |
| break; |
| default: |
| break; |
| } |
| return 0; |
| } |
| |
| static void |
| SDL_COREMOTION_SensorUpdate(SDL_Sensor *sensor) |
| { |
| switch (sensor->type) |
| { |
| case SDL_SENSOR_ACCEL: |
| { |
| CMAccelerometerData *accelerometerData = SDL_motion_manager.accelerometerData; |
| if (accelerometerData) { |
| CMAcceleration acceleration = accelerometerData.acceleration; |
| float data[3]; |
| data[0] = -acceleration.x * SDL_STANDARD_GRAVITY; |
| data[1] = -acceleration.y * SDL_STANDARD_GRAVITY; |
| data[2] = -acceleration.z * SDL_STANDARD_GRAVITY; |
| if (SDL_memcmp(data, sensor->hwdata->data, sizeof(data)) != 0) { |
| SDL_PrivateSensorUpdate(sensor, data, SDL_arraysize(data)); |
| SDL_memcpy(sensor->hwdata->data, data, sizeof(data)); |
| } |
| } |
| } |
| break; |
| case SDL_SENSOR_GYRO: |
| { |
| CMGyroData *gyroData = SDL_motion_manager.gyroData; |
| if (gyroData) { |
| CMRotationRate rotationRate = gyroData.rotationRate; |
| float data[3]; |
| data[0] = rotationRate.x; |
| data[1] = rotationRate.y; |
| data[2] = rotationRate.z; |
| if (SDL_memcmp(data, sensor->hwdata->data, sizeof(data)) != 0) { |
| SDL_PrivateSensorUpdate(sensor, data, SDL_arraysize(data)); |
| SDL_memcpy(sensor->hwdata->data, data, sizeof(data)); |
| } |
| } |
| } |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void |
| SDL_COREMOTION_SensorClose(SDL_Sensor *sensor) |
| { |
| if (sensor->hwdata) { |
| switch (sensor->type) |
| { |
| case SDL_SENSOR_ACCEL: |
| [SDL_motion_manager stopAccelerometerUpdates]; |
| break; |
| case SDL_SENSOR_GYRO: |
| [SDL_motion_manager stopGyroUpdates]; |
| break; |
| default: |
| break; |
| } |
| SDL_free(sensor->hwdata); |
| sensor->hwdata = NULL; |
| } |
| } |
| |
| static void |
| SDL_COREMOTION_SensorQuit(void) |
| { |
| } |
| |
| SDL_SensorDriver SDL_COREMOTION_SensorDriver = |
| { |
| SDL_COREMOTION_SensorInit, |
| SDL_COREMOTION_SensorGetCount, |
| SDL_COREMOTION_SensorDetect, |
| SDL_COREMOTION_SensorGetDeviceName, |
| SDL_COREMOTION_SensorGetDeviceType, |
| SDL_COREMOTION_SensorGetDeviceNonPortableType, |
| SDL_COREMOTION_SensorGetDeviceInstanceID, |
| SDL_COREMOTION_SensorOpen, |
| SDL_COREMOTION_SensorUpdate, |
| SDL_COREMOTION_SensorClose, |
| SDL_COREMOTION_SensorQuit, |
| }; |
| |
| #endif /* SDL_SENSOR_COREMOTION */ |
| |
| /* vi: set ts=4 sw=4 expandtab: */ |