thib8956/spnav-csharp-wrapper
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Mono-threading to be compatible with unity

Browse Source
This commit is contained in:
Thibaud Gasser 2018-05-30 23:53:56 +02:00
parent d98210a403
commit 0c8028c0a8
4 changed files with 110 additions and 114 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
Program.cs
View File

@ -14,7 +14,7 @@ namespace SpaceNavWrapper
// var ev = spnavwrapper.SpaceNav.Instance.WaitEvent(100); // var ev = spnavwrapper.SpaceNav.Instance.WaitEvent(100);
// Console.WriteLine(ev); // Console.WriteLine(ev);
//} //}
SpaceNavDriver navDriver = new SpaceNavDriver(); SpaceNav navDriver = new SpaceNav();
navDriver.InitDevice(); navDriver.InitDevice();
navDriver.Button += OnButton; navDriver.Button += OnButton;
navDriver.Motion += OnMotion; navDriver.Motion += OnMotion;
@ -22,10 +22,10 @@ namespace SpaceNavWrapper
Console.CancelKeyPress += delegate { Console.CancelKeyPress += delegate {
navDriver.Dispose(); navDriver.Dispose();
}; };
for (; ; ) for (; ; )
{ {
} navDriver.WaitEvent();
}
} }
private static void OnMotion(object sender, MotionEventArgs e) private static void OnMotion(object sender, MotionEventArgs e)
@ -35,7 +35,7 @@ namespace SpaceNavWrapper
private static void OnButton(object sender, EventArgs e) private static void OnButton(object sender, EventArgs e)
{ {
Console.WriteLine("Button pressed"); Console.WriteLine(e);
} }
} }
} }

193
SpaceNav.cs
View File

@ -1,110 +1,101 @@
using System; using System;
using System.Runtime.InteropServices; using System.Runtime.InteropServices;
using System.Threading;
namespace SpaceNavWrapper namespace SpaceNavWrapper
{ {
public class SpaceNavDriver : IDisposable public class SpaceNav : IDisposable
{ {
const string DLL_NAME = "spnavhdi"; const string DLL_NAME = "spnavhdi";
#region Constants #region Constants
private const int SPNAV_EVENT_MOTION = 1; private const int SPNAV_EVENT_MOTION = 1;
private const int SPNAV_EVENT_BUTTON = 2; private const int SPNAV_EVENT_BUTTON = 2;
private const ushort SPNAV_VENDOR_ID = 0x046d; private const ushort SPNAV_VENDOR_ID = 0x046d;
private const ushort SPNAV_PRODUCT_ID = 0x0c627; private const ushort SPNAV_PRODUCT_ID = 0x0c627;
#endregion #endregion
public event EventHandler<MotionEventArgs> Motion; public event EventHandler<MotionEventArgs> Motion;
public event EventHandler<EventArgs> Button; public event EventHandler<ButtonEventArgs> Button;
private Thread eventThread; private double _sensitivity = 1.0;
private bool deviceReady; private int _threshold = 5;
private double _sensitivity = 1.0;
private int _threshold = 5;
private bool isDisposed; private bool isDisposed;
#region Structures #region Structures
private struct SpNavEventMotion private struct SpNavEventMotion
{
public int type;
public int x, y, z;
public int rx, ry, rz;
public uint period;
public IntPtr data;
}
private struct SpNavEventButton
{
public int type;
public int press;
public int bnum;
}
[StructLayout(LayoutKind.Explicit)]
private struct SpNavEvent
{
[FieldOffset(0)] public int type;
[FieldOffset(0)] public SpNavEventMotion motion;
[FieldOffset(0)] public SpNavEventButton button;
}
#endregion
#region DLL Imports
[DllImport(DLL_NAME)]
private static extern int spnav_open(ushort vendor_id, ushort product_id);
[DllImport(DLL_NAME)]
private static extern int spnav_close();
[DllImport(DLL_NAME)]
private static extern int spnav_wait_event(ref SpNavEvent ev);
[DllImport(DLL_NAME)]
private static extern int spnav_wait_event_timeout(ref SpNavEvent ev, int timeout);
[DllImport(DLL_NAME)]
private static extern int spnav_sensitivity(double sens);
[DllImport(DLL_NAME)]
private static extern int spnav_deadzone(int threshold);
#endregion
public SpaceNavDriver()
{
eventThread = new Thread(HandleEvents)
{
IsBackground = true,
Name = "3Dconnexion-Event-Dispatcher"
};
eventThread.Start();
}
public void InitDevice()
{
spnav_open(SPNAV_VENDOR_ID, SPNAV_PRODUCT_ID);
spnav_deadzone(5);
deviceReady = true;
}
private void HandleEvents(object obj)
{ {
// Block while the device isn't ready public int type;
while (!deviceReady) {} public int x, y, z;
Console.WriteLine("Device ready !"); public int rx, ry, rz;
while (!isDisposed) public uint period;
{ public IntPtr data;
SpNavEvent sev = new SpNavEvent(); }
int ev_type = spnav_wait_event(ref sev);
Console.WriteLine("Event type : {0}", sev.type); private struct SpNavEventButton
switch (ev_type) {
{ public int type;
case SPNAV_EVENT_BUTTON: [MarshalAs(UnmanagedType.Bool)]
//return new SpaceNavButtonEvent(Convert.ToBoolean(sev.button.press), sev.button.bnum); public bool press;
Button(this, new EventArgs()); public int bnum;
break; }
case SPNAV_EVENT_MOTION:
var ev = sev.motion; [StructLayout(LayoutKind.Explicit)]
Motion(this, new MotionEventArgs(ev.x, ev.y, ev.z, ev.rx, ev.ry, ev.rz)); private struct SpNavEvent
break; {
} [FieldOffset(0)] public int type;
} [FieldOffset(0)] public SpNavEventMotion motion;
[FieldOffset(0)] public SpNavEventButton button;
}
#endregion
#region DLL Imports
[DllImport(DLL_NAME)]
private static extern int spnav_open(ushort vendor_id, ushort product_id);
[DllImport(DLL_NAME)]
private static extern int spnav_close();
[DllImport(DLL_NAME)]
private static extern int spnav_wait_event(ref SpNavEvent ev);
[DllImport(DLL_NAME)]
private static extern int spnav_wait_event_timeout(ref SpNavEvent ev, int timeout);
[DllImport(DLL_NAME)]
private static extern int spnav_sensitivity(double sens);
[DllImport(DLL_NAME)]
private static extern int spnav_deadzone(int threshold);
#endregion
public void InitDevice()
{
// TODO handle retcode and errors
spnav_open(SPNAV_VENDOR_ID, SPNAV_PRODUCT_ID);
}
public void WaitEvent(int millis = -1)
{
SpNavEvent sev = new SpNavEvent();
int ev_type;
if (millis == -1)
{
ev_type = spnav_wait_event(ref sev);
}
else
{
ev_type = spnav_wait_event_timeout(ref sev, (int)millis);
}
switch (ev_type)
{
case SPNAV_EVENT_BUTTON:
var e = sev.button;
Button(this, new ButtonEventArgs(e.press, e.bnum));
break;
case SPNAV_EVENT_MOTION:
var ev = sev.motion;
Motion(this, new MotionEventArgs(ev.x, ev.y, ev.z, ev.rx, ev.ry, ev.rz));
break;
default:
break;
}
} }
public double Sensitivity public double Sensitivity
@ -127,16 +118,16 @@ namespace SpaceNavWrapper
} }
} }
public void Dispose() public void Dispose()
{ {
if (!isDisposed) if (!isDisposed)
{ {
CloseDevice(); CloseDevice();
Button = null; Button = null;
Motion = null; Motion = null;
} }
isDisposed = true; isDisposed = true;
} }
private void CloseDevice() private void CloseDevice()
{ {

17
SpaceNavEvent.cs
View File

@ -25,13 +25,18 @@ namespace SpaceNavWrapper
} }
public class ButtonEventArgs : EventArgs public class ButtonEventArgs : EventArgs
{ {
public readonly int button; public readonly bool Pressed;
public readonly bool pressed; public readonly int Button;
public override string ToString() public ButtonEventArgs(bool pressed, int button)
{ {
return string.Format("[ButtonEventArgs: button={0}, pressed={1}]", button, pressed); Pressed = pressed;
Button = button;
} }
} public override string ToString()
{
return string.Format("[ButtonEventArgs: button={0}, pressed={1}]", Button, Pressed);
}
}
} }

2
spnav-csharp-wrapper.csproj
View File

@ -27,9 +27,9 @@
<PlatformTarget>x86</PlatformTarget> <PlatformTarget>x86</PlatformTarget>
</PropertyGroup> </PropertyGroup>
<ItemGroup> <ItemGroup>
<Compile Include="SpaceNav.cs" />
<Compile Include="SpaceNavEvent.cs" /> <Compile Include="SpaceNavEvent.cs" />
<Compile Include="Program.cs" /> <Compile Include="Program.cs" />
<Compile Include="SpaceNav.cs" />
</ItemGroup> </ItemGroup>
<Import Project="$(MSBuildBinPath)\Microsoft.CSharp.targets" /> <Import Project="$(MSBuildBinPath)\Microsoft.CSharp.targets" />
</Project> </Project>