Handheld Gyro
This commit is contained in:
13
src/Ryujinx.Input.SDL3/Ryujinx.Input.SDL3.csproj
Normal file
13
src/Ryujinx.Input.SDL3/Ryujinx.Input.SDL3.csproj
Normal file
@@ -0,0 +1,13 @@
|
||||
<Project Sdk="Microsoft.NET.Sdk">
|
||||
|
||||
<PropertyGroup>
|
||||
<TargetFramework>net9.0</TargetFramework>
|
||||
<AllowUnsafeBlocks>true</AllowUnsafeBlocks>
|
||||
</PropertyGroup>
|
||||
|
||||
<ItemGroup>
|
||||
<ProjectReference Include="..\Ryujinx.Input\Ryujinx.Input.csproj" />
|
||||
<PackageReference Include="Alimer.Bindings.SDL" />
|
||||
</ItemGroup>
|
||||
|
||||
</Project>
|
||||
85
src/Ryujinx.Input.SDL3/SDL3MotionDriver.cs
Normal file
85
src/Ryujinx.Input.SDL3/SDL3MotionDriver.cs
Normal file
@@ -0,0 +1,85 @@
|
||||
using SDL3;
|
||||
using System;
|
||||
using System.Collections.Generic;
|
||||
using System.Linq;
|
||||
using System.Numerics;
|
||||
using static SDL3.SDL3;
|
||||
|
||||
namespace Ryujinx.Input.SDL3
|
||||
{
|
||||
public unsafe class SDL3MotionDriver : IHandheld, IDisposable
|
||||
{
|
||||
private readonly Dictionary<SDL_SensorType, SDL_Sensor> sensors;
|
||||
private bool _disposed;
|
||||
|
||||
public SDL3MotionDriver()
|
||||
{
|
||||
int result = SDL_Init(SDL_InitFlags.Sensor);
|
||||
if (result < 0)
|
||||
{
|
||||
throw new InvalidOperationException($"SDL sensor initialization failed: {SDL_GetError()}");
|
||||
}
|
||||
sensors = SDL_GetSensors().ToArray().ToDictionary(SDL_GetSensorTypeForID, SDL_OpenSensor);
|
||||
}
|
||||
|
||||
~SDL3MotionDriver()
|
||||
{
|
||||
Dispose(false);
|
||||
}
|
||||
|
||||
public void Dispose()
|
||||
{
|
||||
Dispose(true);
|
||||
GC.SuppressFinalize(this);
|
||||
}
|
||||
|
||||
protected virtual void Dispose(bool disposing)
|
||||
{
|
||||
if (_disposed)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
if (disposing && sensors != null)
|
||||
{
|
||||
foreach (var sensor in sensors.Values)
|
||||
{
|
||||
if (sensor != IntPtr.Zero)
|
||||
{
|
||||
SDL_CloseSensor(sensor);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
_disposed = true;
|
||||
}
|
||||
|
||||
public Vector3 GetMotionData(MotionInputId inputType)
|
||||
{
|
||||
ObjectDisposedException.ThrowIf(_disposed, this);
|
||||
|
||||
return inputType switch
|
||||
{
|
||||
MotionInputId.Gyroscope => GetSensorVector(SDL_SensorType.Gyro) * 180 / MathF.PI,
|
||||
MotionInputId.Accelerometer => GetSensorVector(SDL_SensorType.Accel) / SDL_STANDARD_GRAVITY,
|
||||
_ => Vector3.Zero
|
||||
};
|
||||
}
|
||||
|
||||
private Vector3 GetSensorVector(SDL_SensorType sensorType)
|
||||
{
|
||||
if (!sensors.TryGetValue(sensorType, out SDL_Sensor sensor))
|
||||
{
|
||||
return Vector3.Zero;
|
||||
}
|
||||
|
||||
var data = stackalloc float[3];
|
||||
if (SDL_GetSensorData(sensor, data, 3) < 0)
|
||||
{
|
||||
return Vector3.Zero;
|
||||
}
|
||||
|
||||
return new Vector3(data[0], data[1], data[2]);
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user