1 files changed, 17 insertions, 213 deletions

diff --git a/tracker-joystick/ftnoir_tracker_joystick.cpp b/tracker-joystick/ftnoir_tracker_joystick.cpp
index 742ce972..4c180eaa 100644
--- a/tracker-joystick/ftnoir_tracker_joystick.cpp
+++ b/tracker-joystick/ftnoir_tracker_joystick.cpp
@@ -8,223 +8,20 @@
 #include "opentrack/plugin-api.hpp"
 #include <QMutexLocker>
 
-FTNoIR_Tracker::FTNoIR_Tracker() :
-    g_pDI(nullptr),
-    g_pJoystick(nullptr),
-    mtx(QMutex::Recursive),
-    iter(-1)
+FTNoIR_Tracker::FTNoIR_Tracker()
 {
 }
 
-void FTNoIR_Tracker::reload()
-{
-    s.b->reload();
-    {
-        QMutexLocker foo(&mtx);
-        
-        if (g_pJoystick)
-        {
-            g_pJoystick->Unacquire();
-            g_pJoystick->Release();
-        }
-        if (g_pDI)
-            g_pDI->Release();
-        
-        g_pJoystick = nullptr;
-        g_pDI = nullptr;
-    }
-
-    start_tracker(frame);
-}
-
 FTNoIR_Tracker::~FTNoIR_Tracker()
 {
-    if (g_pJoystick)
-    {
-        g_pJoystick->Unacquire();
-        g_pJoystick->Release();
-    }
-    if (g_pDI)
-    {
-        g_pDI->Release();
-    }
-}
-
-#ifdef __GNUC__
-#	pragma GCC diagnostic ignored "-Wmissing-field-initializers"
-#endif
-
-static BOOL CALLBACK EnumObjectsCallback( const DIDEVICEOBJECTINSTANCE* pdidoi,
-                                   VOID* pContext )
-{
-    auto self = (FTNoIR_Tracker*) pContext;
-
-    if( pdidoi->dwType & DIDFT_AXIS )
-    {
-        DIPROPRANGE diprg = {0};
-        diprg.diph.dwSize = sizeof( DIPROPRANGE );
-        diprg.diph.dwHeaderSize = sizeof( DIPROPHEADER );
-        diprg.diph.dwHow = DIPH_BYID;
-        diprg.diph.dwObj = pdidoi->dwType;
-        diprg.lMax = FTNoIR_Tracker::AXIS_MAX;
-        diprg.lMin = -FTNoIR_Tracker::AXIS_MAX;
-
-        if( FAILED( self->g_pJoystick->SetProperty( DIPROP_RANGE, &diprg.diph ) ) )
-            return DIENUM_STOP;
-
-        self->iter++;
-    }
-
-    return self->iter == 8 ? DIENUM_STOP : DIENUM_CONTINUE;
-}
-
-static BOOL CALLBACK EnumJoysticksCallback( const DIDEVICEINSTANCE* pdidInstance, VOID* pContext )
-{
-    auto self = reinterpret_cast<FTNoIR_Tracker*>(pContext);
-    bool stop = QString(pdidInstance->tszInstanceName) == self->s.joyid;
-
-    if (stop)
-    {
-        if (self->guid_to_check.size())
-        {
-            QString guid = guid_to_string(pdidInstance->guidInstance);
-            if (guid != self->guid_to_check)
-            {
-                return DIENUM_CONTINUE;
-            }
-            else
-                qDebug() << "guid ok" << self->guid_to_check;
-        }
-
-        (void) self->g_pDI->CreateDevice( pdidInstance->guidInstance, &self->g_pJoystick, NULL);
-        qDebug() << "device" << static_cast<QString>(self->s.joyid);
-    }
-
-    return stop ? DIENUM_STOP : DIENUM_CONTINUE;
 }
 
-void FTNoIR_Tracker::start_tracker(QFrame* frame)
+void FTNoIR_Tracker::start_tracker(QFrame*)
 {
-    QMutexLocker foo(&mtx);
-    this->frame = frame;
-    iter = 0;
-    auto hr = CoInitialize( nullptr );
-
-    if( FAILED( hr = DirectInput8Create( GetModuleHandle( NULL ), DIRECTINPUT_VERSION,
-                                         IID_IDirectInput8, ( VOID** )&g_pDI, NULL ) ) )
-    {
-        qDebug() << "create";
-        goto fail;
-    }
-
-    guid_to_check = s.guid;
-
-    if( FAILED( hr = g_pDI->EnumDevices( DI8DEVCLASS_GAMECTRL,
-                                         EnumJoysticksCallback,
-                                         this,
-                                         DIEDFL_ATTACHEDONLY)))
-    {
-        qDebug() << "enum1";
-        goto fail;
-    }
-
-    if (!g_pJoystick && guid_to_check.size())
-    {
-        guid_to_check = "";
-
-        if( FAILED( hr = g_pDI->EnumDevices( DI8DEVCLASS_GAMECTRL,
-                                             EnumJoysticksCallback,
-                                             this,
-                                             DIEDFL_ATTACHEDONLY)))
-        {
-            qDebug() << "enum2";
-            goto fail;
-        }
-    }
-
-    if (!g_pJoystick)
-    {
-        qDebug() << "ENODEV";
-        goto fail;
-    }
-
-    if (FAILED(g_pJoystick->SetDataFormat(&c_dfDIJoystick)))
-    {
-        qDebug() << "format";
-        goto fail;
-    }
-
-    if (FAILED(g_pJoystick->SetCooperativeLevel((HWND) frame->window()->winId(), DISCL_NONEXCLUSIVE | DISCL_BACKGROUND)))
-    {
-        qDebug() << "coop";
-        goto fail;
-    }
-
-    iter = 0;
-
-    if( FAILED( hr = g_pJoystick->EnumObjects( EnumObjectsCallback,
-                                               ( VOID* )this, DIDFT_ALL )))
-    {
-        qDebug() << "enum axes";
-        goto fail;
-    }
-
-    return;
-
-fail:
-    if (g_pJoystick)
-        g_pJoystick->Release();
-    if (g_pDI)
-        g_pDI->Release();
-    g_pJoystick = nullptr;
-    g_pDI = nullptr;
-
-    qDebug() << "joy init failure";
 }
 
 void FTNoIR_Tracker::data(double *data)
 {
-    QMutexLocker foo(&mtx);
-    DIJOYSTATE js = {0};
-
-    if( !g_pDI || !g_pJoystick)
-        return;
-
-    bool ok = false;
-
-    for (int i = 0; i < 100; i++)
-    {
-        if (!FAILED(g_pJoystick->Poll()))
-        {
-                ok = true;
-                break;
-        }
-        if (g_pJoystick->Acquire() != DI_OK)
-                continue;
-        else
-                ok = true;
-        break;
-    }
-
-    if (!ok)
-            return;
-
-    HRESULT hr = 0;
-
-    if( FAILED( hr = g_pJoystick->GetDeviceState( sizeof( js ), &js ) ) )
-        return;
-
-    const LONG values[] = {
-        js.lX,
-        js.lY,
-        js.lZ,
-        js.lRx,
-        js.lRy,
-        js.lRz,
-        js.rglSlider[0],
-        js.rglSlider[1]
-    };
-
     int map[6] = {
         s.joy_1 - 1,
         s.joy_2 - 1,
@@ -242,14 +39,21 @@ void FTNoIR_Tracker::data(double *data)
         180,
         180
     };
-
-    for (int i = 0; i < 6; i++)
-    {
-        int k = map[i] - 1;
-        if (k < 0 || k >= 8)
-            data[i] = 0;
-        else
-            data[i] = values[k] * limits[i] / AXIS_MAX;
+    
+    const QString guid = s.guid;
+    int axes[8];
+    const bool ret = joy_ctx.poll_axis(guid, axes);
+    
+    if (ret)
+    {
+        for (int i = 0; i < 6; i++)
+        {
+            int k = map[i] - 1;
+            if (k < 0 || k >= 8)
+                data[i] = 0;
+            else
+                data[i] = axes[k] * limits[i] / AXIS_MAX;
+        }
     }
 }