#ifdef _WIN32 #include "win32-joystick.hpp" #include "compat/macros.h" #include #include #include #include #include #include #include #include namespace win32_joy_impl { QMutex win32_joy_ctx::enum_state::mtx; win32_joy_ctx::enum_state win32_joy_ctx::enumerator; void win32_joy_ctx::poll(fn const& f) { //refresh(false); QMutexLocker l(&enum_state::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(&enum_state::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; DIJOYSTATE2 js; if (!di_t::poll_device(joy_handle)) continue; if (FAILED(joy_handle->GetDeviceState(sizeof(js), &js))) { //qDebug() << "joy get state failed" << guid; continue; } const int values[] = { js.lX, js.lY, js.lZ, js.lRx, js.lRy, js.lRz, js.rglSlider[0], js.rglSlider[1] }; for (unsigned i = 0; i < std::size(values); i++) axes[i] = values[i]; return true; } return false; } std::vector win32_joy_ctx::get_joy_info() { std::vector ret; QMutexLocker l(&enum_state::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) { return fst.name < snd.name; }); return ret; } win32_joy_ctx::win32_joy_ctx() { refresh(); } void win32_joy_ctx::refresh() { QMutexLocker l(&enum_state::mtx); enumerator.refresh(); } QString win32_joy_ctx::guid_to_string(const GUID& guid) { char buf[40] = {}; wchar_t szGuidW[40] = {}; StringFromGUID2(guid, szGuidW, sizeof(buf)); WideCharToMultiByte(0, 0, szGuidW, -1, buf, sizeof(buf), nullptr, nullptr); buf[sizeof(buf)-1] = 0; 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 const& f) { HRESULT hr; if (!di_t::poll_device(joy_handle)) { eval_once(qDebug() << "joy poll failed" << guid << (void*)hr); //(void)joy_handle->Unacquire(); //Sleep(0); return false; } DIDEVICEOBJECTDATA keystate_buffers[num_buffers]; DWORD sz = num_buffers; if (FAILED(hr = joy_handle->GetDeviceData(sizeof(DIDEVICEOBJECTDATA), keystate_buffers, &sz, 0))) { eval_once(qDebug() << "joy GetDeviceData failed" << guid << (void*)hr); return false; } for (unsigned k = 0; k < sz; k++) { const DIDEVICEOBJECTDATA& event = keystate_buffers[k]; bool is_pov = false; int i = -1; #define POV_HAT_OFFSET(k) \ (offsetof(DIJOYSTATE2, rgdwPOV) + (k) * sizeof(DWORD)) #define BUTTON_OFFSET(k) \ (offsetof(DIJOYSTATE2, rgbButtons) + (k) * sizeof(BYTE)) switch (event.dwOfs) { case POV_HAT_OFFSET(0): i = 0; is_pov = true; break; case POV_HAT_OFFSET(1): i = 1; is_pov = true; break; case POV_HAT_OFFSET(2): i = 2; is_pov = true; break; case POV_HAT_OFFSET(3): i = 3; is_pov = true; break; default: if (event.dwOfs >= BUTTON_OFFSET(0) && event.dwOfs <= BUTTON_OFFSET(max_buttons - 1)) { i = int(event.dwOfs - BUTTON_OFFSET(0)); i /= sizeof(DIJOYSTATE2().rgbButtons[0]); i %= max_buttons; // defensive programming } break; } if (is_pov) { unsigned pos = event.dwData / value_per_pov_hat_direction; i = max_buttons + i * pov_hat_directions; for (unsigned j = 0; j < pov_hat_directions; j++) { const unsigned idx = i + j; const bool new_value = pos == j; if (last_state[idx] != new_value) { #ifdef WIN32_JOY_DEBUG qDebug() << "DBG: pov" << idx << (pos == j); #endif last_state[idx] = new_value; f(guid, idx, new_value); } } } else if ((unsigned)i < max_buttons) { const bool new_value = !!(event.dwData & 0x80); if (last_state[i] != new_value) { #ifdef WIN32_JOY_DEBUG qDebug() << "DBG: btn" << i << new_value; #endif last_state[i] = new_value; f(guid, i, new_value); } } } return true; } win32_joy_ctx::enum_state::enum_state() = default; win32_joy_ctx::enum_state::~enum_state() { QMutexLocker l(&mtx); joys = std::unordered_map>(); } void win32_joy_ctx::enum_state::refresh() { all.clear(); #ifdef __SANITIZE_ADDRESS__ return; #endif if (!di) { qDebug() << "dinput: can't create dinput"; return; } HRESULT hr; if(FAILED(hr = di->EnumDevices(DI8DEVCLASS_GAMECTRL, EnumJoysticksCallback, this, DIEDFL_ATTACHEDONLY))) { eval_once(qDebug() << "dinput: failed enum joysticks" << (void*)hr); return; } for (auto it = joys.begin(); it != joys.end(); ) { if (std::find_if(all.cbegin(), all.cend(), [&](const QString& guid2) { return it->second->guid == guid2; }) == all.end()) it = joys.erase(it); else ++it; } } const win32_joy_ctx::joys_t& win32_joy_ctx::enum_state::get_joys() const { return joys; } BOOL CALLBACK win32_joy_ctx::enum_state::EnumJoysticksCallback(const DIDEVICEINSTANCE *pdidInstance, void *pContext) { enum_state& state = *reinterpret_cast(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; IDirectInputDevice8A* h; if (FAILED(hr = state.di->CreateDevice(pdidInstance->guidInstance, &h, nullptr))) { qDebug() << "dinput: failed joystick CreateDevice" << guid << (void*)hr; goto end; } if (FAILED(hr = h->SetDataFormat(&c_dfDIJoystick2))) { qDebug() << "dinput: failed joystick SetDataFormat" << (void*)hr; h->Release(); goto end; } // not a library-load-time member - need main() to run for some time first static const QWidget fake_window; if (FAILED(h->SetCooperativeLevel(reinterpret_cast(fake_window.winId()), DISCL_NONEXCLUSIVE | DISCL_BACKGROUND))) { qDebug() << "coop"; h->Release(); goto end; } { DIPROPDWORD dipdw = {}; dipdw.diph.dwHeaderSize = sizeof(dipdw.diph); dipdw.diph.dwSize = sizeof(dipdw); dipdw.diph.dwHow = DIPH_DEVICE; dipdw.diph.dwObj = 0; dipdw.dwData = num_buffers; if (h->SetProperty(DIPROP_BUFFERSIZE, &dipdw.diph) != DI_OK) { qDebug() << "dinput: joystick DIPROP_BUFFERSIZE"; h->Release(); goto end; } } if (FAILED(hr = h->EnumObjects(EnumObjectsCallback, h, DIDFT_ALL))) { qDebug() << "dinput: joystick EnumObjects"; h->Release(); goto end; } state.joys[guid] = std::make_shared(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 = {}; 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(ctx)->SetProperty(DIPROP_RANGE, &diprg.diph))) { qDebug() << "dinput: failed joystick DIPROP_RANGE" << (void*)hr; return DIENUM_STOP; } } return DIENUM_CONTINUE; } win32_joy_ctx::joy::joy(IDirectInputDevice8A* handle, const QString& guid, const QString &name) : joy_handle(handle), guid(guid), name(name) { //qDebug() << "make joy" << guid << name << joy_handle; } win32_joy_ctx::joy::~joy() { //qDebug() << "nix joy" << guid; release(); } } // ns win32_joy_impl #endif