|
|
@@ -0,0 +1,218 @@
|
|
|
+/*
|
|
|
+ Simple DirectMedia Layer
|
|
|
+ Copyright (C) 1997-2022 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_SENSOR_N3DS
|
|
|
+
|
|
|
+#include <3ds.h>
|
|
|
+
|
|
|
+#include "../SDL_syssensor.h"
|
|
|
+
|
|
|
+/* 1 accelerometer and 1 gyroscope */
|
|
|
+#define N3DS_SENSOR_COUNT 2
|
|
|
+
|
|
|
+typedef struct
|
|
|
+{
|
|
|
+ SDL_SensorType type;
|
|
|
+ SDL_SensorID instance_id;
|
|
|
+} SDL_N3DSSensor;
|
|
|
+
|
|
|
+static SDL_N3DSSensor N3DS_sensors[N3DS_SENSOR_COUNT];
|
|
|
+
|
|
|
+SDL_FORCE_INLINE int InitN3DSServices(void);
|
|
|
+SDL_FORCE_INLINE void UpdateN3DSAccelerometer(SDL_Sensor *sensor);
|
|
|
+SDL_FORCE_INLINE void UpdateN3DSGyroscope(SDL_Sensor *sensor);
|
|
|
+
|
|
|
+SDL_FORCE_INLINE SDL_bool
|
|
|
+IsDeviceIndexValid(int device_index)
|
|
|
+{
|
|
|
+ return device_index >= 0 && device_index < N3DS_SENSOR_COUNT;
|
|
|
+}
|
|
|
+
|
|
|
+static int
|
|
|
+N3DS_SensorInit(void)
|
|
|
+{
|
|
|
+ if (InitN3DSServices() < 0) {
|
|
|
+ return SDL_SetError("Failed to initialise N3DS services");
|
|
|
+ }
|
|
|
+
|
|
|
+ N3DS_sensors[0].type = SDL_SENSOR_ACCEL;
|
|
|
+ N3DS_sensors[0].instance_id = SDL_GetNextSensorInstanceID();
|
|
|
+ N3DS_sensors[1].type = SDL_SENSOR_GYRO;
|
|
|
+ N3DS_sensors[1].instance_id = SDL_GetNextSensorInstanceID();
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+SDL_FORCE_INLINE int
|
|
|
+InitN3DSServices(void)
|
|
|
+{
|
|
|
+ if (R_FAILED(hidInit())) {
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (R_FAILED(HIDUSER_EnableAccelerometer())) {
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (R_FAILED(HIDUSER_EnableGyroscope())) {
|
|
|
+ return -1;
|
|
|
+ }
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int
|
|
|
+N3DS_SensorGetCount(void)
|
|
|
+{
|
|
|
+ return N3DS_SENSOR_COUNT;
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+N3DS_SensorDetect(void)
|
|
|
+{
|
|
|
+}
|
|
|
+
|
|
|
+static const char *
|
|
|
+N3DS_SensorGetDeviceName(int device_index)
|
|
|
+{
|
|
|
+ if (IsDeviceIndexValid(device_index)) {
|
|
|
+ switch (N3DS_sensors[device_index].type) {
|
|
|
+ case SDL_SENSOR_ACCEL:
|
|
|
+ return "Accelerometer";
|
|
|
+ case SDL_SENSOR_GYRO:
|
|
|
+ return "Gyroscope";
|
|
|
+ default:
|
|
|
+ return "Unknown";
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return NULL;
|
|
|
+}
|
|
|
+
|
|
|
+static SDL_SensorType
|
|
|
+N3DS_SensorGetDeviceType(int device_index)
|
|
|
+{
|
|
|
+ if (IsDeviceIndexValid(device_index)) {
|
|
|
+ return N3DS_sensors[device_index].type;
|
|
|
+ }
|
|
|
+ return SDL_SENSOR_INVALID;
|
|
|
+}
|
|
|
+
|
|
|
+static int
|
|
|
+N3DS_SensorGetDeviceNonPortableType(int device_index)
|
|
|
+{
|
|
|
+ return (int) N3DS_SensorGetDeviceType(device_index);
|
|
|
+}
|
|
|
+
|
|
|
+static SDL_SensorID
|
|
|
+N3DS_SensorGetDeviceInstanceID(int device_index)
|
|
|
+{
|
|
|
+ if (IsDeviceIndexValid(device_index)) {
|
|
|
+ return N3DS_sensors[device_index].instance_id;
|
|
|
+ }
|
|
|
+ return -1;
|
|
|
+}
|
|
|
+
|
|
|
+static int
|
|
|
+N3DS_SensorOpen(SDL_Sensor *sensor, int device_index)
|
|
|
+{
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+N3DS_SensorUpdate(SDL_Sensor *sensor)
|
|
|
+{
|
|
|
+ switch (sensor->type) {
|
|
|
+ case SDL_SENSOR_ACCEL:
|
|
|
+ UpdateN3DSAccelerometer(sensor);
|
|
|
+ break;
|
|
|
+ case SDL_SENSOR_GYRO:
|
|
|
+ UpdateN3DSGyroscope(sensor);
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+SDL_FORCE_INLINE void
|
|
|
+UpdateN3DSAccelerometer(SDL_Sensor *sensor)
|
|
|
+{
|
|
|
+ static accelVector previous_state = { 0, 0, 0 };
|
|
|
+ accelVector current_state;
|
|
|
+ float data[3];
|
|
|
+
|
|
|
+ hidAccelRead(¤t_state);
|
|
|
+ if (SDL_memcmp(&previous_state, ¤t_state, sizeof(accelVector)) != 0) {
|
|
|
+ SDL_memcpy(&previous_state, ¤t_state, sizeof(accelVector));
|
|
|
+ data[0] = (float) current_state.x * SDL_STANDARD_GRAVITY;
|
|
|
+ data[1] = (float) current_state.y * SDL_STANDARD_GRAVITY;
|
|
|
+ data[2] = (float) current_state.z * SDL_STANDARD_GRAVITY;
|
|
|
+ SDL_PrivateSensorUpdate(sensor, data, sizeof data);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+SDL_FORCE_INLINE void
|
|
|
+UpdateN3DSGyroscope(SDL_Sensor *sensor)
|
|
|
+{
|
|
|
+ static angularRate previous_state = { 0, 0, 0 };
|
|
|
+ angularRate current_state;
|
|
|
+ float data[3];
|
|
|
+
|
|
|
+ hidGyroRead(¤t_state);
|
|
|
+ if (SDL_memcmp(&previous_state, ¤t_state, sizeof(angularRate)) != 0) {
|
|
|
+ SDL_memcpy(&previous_state, ¤t_state, sizeof(angularRate));
|
|
|
+ data[0] = (float) current_state.x;
|
|
|
+ data[1] = (float) current_state.y;
|
|
|
+ data[2] = (float) current_state.z;
|
|
|
+ SDL_PrivateSensorUpdate(sensor, data, sizeof data);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+N3DS_SensorClose(SDL_Sensor *sensor)
|
|
|
+{
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+N3DS_SensorQuit(void)
|
|
|
+{
|
|
|
+ HIDUSER_DisableGyroscope();
|
|
|
+ HIDUSER_DisableAccelerometer();
|
|
|
+ hidExit();
|
|
|
+}
|
|
|
+
|
|
|
+SDL_SensorDriver SDL_N3DS_SensorDriver = {
|
|
|
+ N3DS_SensorInit,
|
|
|
+ N3DS_SensorGetCount,
|
|
|
+ N3DS_SensorDetect,
|
|
|
+ N3DS_SensorGetDeviceName,
|
|
|
+ N3DS_SensorGetDeviceType,
|
|
|
+ N3DS_SensorGetDeviceNonPortableType,
|
|
|
+ N3DS_SensorGetDeviceInstanceID,
|
|
|
+ N3DS_SensorOpen,
|
|
|
+ N3DS_SensorUpdate,
|
|
|
+ N3DS_SensorClose,
|
|
|
+ N3DS_SensorQuit,
|
|
|
+};
|
|
|
+
|
|
|
+#endif /* SDL_SENSOR_N3DS */
|
|
|
+
|
|
|
+/* vi: set ts=4 sw=4 expandtab: */
|
Pierre Wendling