diff options
Diffstat (limited to 'opentrack-logic/win32-joystick.cpp')
-rw-r--r-- | opentrack-logic/win32-joystick.cpp | 362 |
1 files changed, 0 insertions, 362 deletions
diff --git a/opentrack-logic/win32-joystick.cpp b/opentrack-logic/win32-joystick.cpp deleted file mode 100644 index fa1a8060..00000000 --- a/opentrack-logic/win32-joystick.cpp +++ /dev/null @@ -1,362 +0,0 @@ -#ifdef _WIN32 - -#undef NDEBUG -#include "win32-joystick.hpp" -#include "opentrack-compat/sleep.hpp" -#include <cassert> -#include <cstring> -#include <algorithm> -#include <cmath> -#include <objbase.h> - -QMutex win32_joy_ctx::enum_state::mtx; -win32_joy_ctx::enum_state win32_joy_ctx::enumerator; - -void win32_joy_ctx::poll(fn f) -{ - //refresh(false); - - QMutexLocker l(&enumerator.mtx); - - auto& joys = enumerator.get_joys(); - - for (auto& j : joys) - { - j.second->poll(f); - } -} - -bool win32_joy_ctx::poll_axis(const QString &guid, int* axes) -{ - QMutexLocker l(&enumerator.mtx); - - for (int k = 0; k < 10; k++) - { - if (k > 0) - enumerator.refresh(); - - const joys_t& joys = enumerator.get_joys(); - auto iter = joys.find(guid); - - if (iter == joys.end()) - return false; - - auto& j = iter->second; - - auto& joy_handle = j->joy_handle; - bool ok = false; - HRESULT hr; - - if (!FAILED(hr = joy_handle->Poll())) - { - ok = true; - } - - if (!ok && FAILED(hr = joy_handle->Acquire())) - { - //qDebug() << "joy acquire failed" << hr; - } - - if (!ok) - { - portable::sleep(25); - (void) joy_handle->Unacquire(); - continue; - } - - DIJOYSTATE2 js; - std::memset(&js, 0, sizeof(js)); - - if (FAILED(hr = joy_handle->GetDeviceState(sizeof(js), &js))) - { - qDebug() << "joy get state failed" << guid << hr; - continue; - } - - const int values[] = - { - js.lX, - js.lY, - js.lZ, - js.lRx, - js.lRy, - js.lRz, - js.rglSlider[0], - js.rglSlider[1] - }; - - for (int i = 0; i < 8; i++) - axes[i] = values[i]; - - return true; - } - - return false; -} - -std::vector<win32_joy_ctx::joy_info> win32_joy_ctx::get_joy_info() -{ - std::vector<joy_info> ret; - QMutexLocker l(&enumerator.mtx); - auto& joys = enumerator.get_joys(); - ret.reserve(joys.size()); - - for (auto& j : joys) - ret.push_back(joy_info { j.second->name, j.first }); - - std::sort(ret.begin(), ret.end(), [&](const joy_info& fst, const joy_info& snd) -> bool { return fst.name < snd.name; }); - - return ret; -} - -win32_joy_ctx::win32_joy_ctx() -{ - refresh(); -} - -void win32_joy_ctx::refresh() -{ - QMutexLocker l(&enumerator.mtx); - enumerator.refresh(); -} - -QString win32_joy_ctx::guid_to_string(const GUID guid) -{ - char buf[40] = {0}; - wchar_t szGuidW[40] = {0}; - - StringFromGUID2(guid, szGuidW, 40); - WideCharToMultiByte(0, 0, szGuidW, -1, buf, 40, NULL, NULL); - - return QString(buf); -} - -using fn = win32_joy_ctx::fn; - -void win32_joy_ctx::joy::release() -{ - if (joy_handle) - { - (void) joy_handle->Unacquire(); - joy_handle->Release(); - joy_handle = nullptr; - } -} - -bool win32_joy_ctx::joy::poll(fn f) -{ - HRESULT hr; - bool ok = false; - - (void) joy_handle->Acquire(); - - if (!FAILED(hr = joy_handle->Poll())) - ok = true; - - if (!ok) - { - qDebug() << "joy acquire failed" << guid << hr; - (void) joy_handle->Unacquire(); - return false; - } - - DIJOYSTATE2 js; - std::memset(&js, 0, sizeof(js)); - - if (FAILED(hr = joy_handle->GetDeviceState(sizeof(js), &js))) - { - qDebug() << "joy get state failed" << guid << hr; - return false; - } - - for (unsigned i = 0; i < 4; i++) - { - using std::round; - - unsigned char pos; - unsigned pos_ = js.rgdwPOV[i]; - if ((pos_ & 0xffff) == 0xffff) - pos = 0; - else if (pos_ == ~0u) - pos = 0; - else - { - using uc = unsigned char; - pos = uc(((pos_ / 9000u) % 4u) + 1u); - } - - const bool state[] = - { - pos == 1, - pos == 2, - pos == 3, - pos == 4 - }; - - unsigned idx = 128u + i * 4u; - - for (unsigned j = 0; j < 4; j++, idx++) - { - if (state[j] != pressed[idx]) - { - f(guid, int(idx), state[j]); - pressed[idx] = state[j]; - } - } - } - - for (int i = 0; i < 128; i++) - { - const bool state = !!(js.rgbButtons[i] & 0x80); - if (state != pressed[i]) - { - f(guid, i, state); - } - pressed[i] = state; - } - - return true; -} - -win32_joy_ctx::enum_state::enum_state() -{ -} - -win32_joy_ctx::enum_state::~enum_state() -{ - QMutexLocker l(&mtx); - - joys = std::unordered_map<QString, std::shared_ptr<joy>>(); -} - -void win32_joy_ctx::enum_state::refresh() -{ - all.clear(); - - di_t di = dinput_handle::make_di(); - if (!di) - { - qDebug() << "can't create dinput"; - return; - } - - HRESULT hr; - - if(FAILED(hr = di->EnumDevices(DI8DEVCLASS_GAMECTRL, - EnumJoysticksCallback, - this, - DIEDFL_ATTACHEDONLY))) - { - qDebug() << "failed enum joysticks" << hr; - return; - } - - for (auto it = joys.begin(); it != joys.end(); ) - { - if (std::find_if(all.cbegin(), all.cend(), [&](const QString& guid2) -> bool { return it->second->guid == guid2; }) == all.end()) - { - it = joys.erase(it); - } - else - { - ++it; - } - } -} - -BOOL CALLBACK win32_joy_ctx::enum_state::EnumJoysticksCallback(const DIDEVICEINSTANCE *pdidInstance, void *pContext) -{ - di_t di = dinput_handle::make_di(); - if (!di) - { - qDebug() << "can't create dinput"; - return DIENUM_STOP; - } - - enum_state& state = *reinterpret_cast<enum_state*>(pContext); - const QString guid = guid_to_string(pdidInstance->guidInstance); - const QString name = QString(pdidInstance->tszInstanceName); - - const bool exists = state.joys.find(guid) != state.joys.end(); - - state.all.push_back(guid); - - if (exists) - goto end; - - { - HRESULT hr; - LPDIRECTINPUTDEVICE8 h; - if (FAILED(hr = di->CreateDevice(pdidInstance->guidInstance, &h, nullptr))) - { - qDebug() << "createdevice" << guid << hr; - goto end; - } - if (FAILED(h->SetDataFormat(&c_dfDIJoystick2))) - { - qDebug() << "format"; - h->Release(); - goto end; - } - - // not a static member - need main() to run for some time first - static const QWidget fake_window; - - if (FAILED(h->SetCooperativeLevel(reinterpret_cast<HWND>(fake_window.winId()), DISCL_NONEXCLUSIVE | DISCL_BACKGROUND))) - { - qDebug() << "coop"; - h->Release(); - goto end; - } - if (FAILED(hr = h->EnumObjects(EnumObjectsCallback, h, DIDFT_ALL))) - { - qDebug() << "enum-objects"; - h->Release(); - goto end; - } - - state.joys[guid] = std::make_shared<joy>(h, guid, name); - } -end: - return DIENUM_CONTINUE; -} - -BOOL CALLBACK win32_joy_ctx::enum_state::EnumObjectsCallback(const DIDEVICEOBJECTINSTANCE *pdidoi, void *ctx) -{ - if (pdidoi->dwType & DIDFT_AXIS) - { - DIPROPRANGE diprg; - std::memset(&diprg, 0, sizeof(diprg)); - diprg.diph.dwSize = sizeof( DIPROPRANGE ); - diprg.diph.dwHeaderSize = sizeof( DIPROPHEADER ); - diprg.diph.dwHow = DIPH_BYID; - diprg.diph.dwObj = pdidoi->dwType; - diprg.lMax = joy_axis_size; - diprg.lMin = -joy_axis_size; - - HRESULT hr; - - if (FAILED(hr = reinterpret_cast<LPDIRECTINPUTDEVICE8>(ctx)->SetProperty(DIPROP_RANGE, &diprg.diph))) - { - qDebug() << "DIPROP_RANGE" << hr; - return DIENUM_STOP; - } - } - - return DIENUM_CONTINUE; -} - -win32_joy_ctx::joy::joy(LPDIRECTINPUTDEVICE8 handle, const QString &guid, const QString &name) - : joy_handle(handle), guid(guid), name(name) -{ - qDebug() << "make joy" << guid << name << joy_handle; - std::memset(pressed, 0, sizeof(pressed)); -} - -win32_joy_ctx::joy::~joy() -{ - qDebug() << "nix joy" << guid; - release(); -} - -#endif |