537 lines
15 KiB
C++
537 lines
15 KiB
C++
/*************************************************************************/
|
|
/* joystick.cpp */
|
|
/*************************************************************************/
|
|
/* This file is part of: */
|
|
/* GODOT ENGINE */
|
|
/* http://www.godotengine.org */
|
|
/*************************************************************************/
|
|
/* Copyright (c) 2007-2016 Juan Linietsky, Ariel Manzur. */
|
|
/* */
|
|
/* Permission is hereby granted, free of charge, to any person obtaining */
|
|
/* a copy of this software and associated documentation files (the */
|
|
/* "Software"), to deal in the Software without restriction, including */
|
|
/* without limitation the rights to use, copy, modify, merge, publish, */
|
|
/* distribute, sublicense, and/or sell copies of the Software, and to */
|
|
/* permit persons to whom the Software is furnished to do so, subject to */
|
|
/* the following conditions: */
|
|
/* */
|
|
/* The above copyright notice and this permission notice shall be */
|
|
/* included in all copies or substantial portions of the Software. */
|
|
/* */
|
|
/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
|
|
/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
|
|
/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
|
|
/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
|
|
/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
|
|
/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
|
|
/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
|
|
/*************************************************************************/
|
|
//author: Andreas Haas <hondres, liugam3@gmail.com>
|
|
#include "joystick.h"
|
|
#include <iostream>
|
|
#include <wbemidl.h>
|
|
#include <oleauto.h>
|
|
|
|
#ifndef __GNUC__
|
|
#define __builtin_bswap32 _byteswap_ulong
|
|
#endif
|
|
|
|
DWORD WINAPI _xinput_get_state(DWORD dwUserIndex, XINPUT_STATE* pState) { return ERROR_DEVICE_NOT_CONNECTED; }
|
|
|
|
joystick_windows::joystick_windows() {
|
|
|
|
}
|
|
|
|
joystick_windows::joystick_windows(InputDefault* _input, HWND* hwnd) {
|
|
|
|
input = _input;
|
|
hWnd = hwnd;
|
|
joystick_count = 0;
|
|
dinput = NULL;
|
|
xinput_dll = NULL;
|
|
xinput_get_state = NULL;
|
|
|
|
load_xinput();
|
|
|
|
for (int i = 0; i < JOYSTICKS_MAX; i++)
|
|
attached_joysticks[i] = false;
|
|
|
|
|
|
HRESULT result;
|
|
result = DirectInput8Create(GetModuleHandle(NULL), DIRECTINPUT_VERSION, IID_IDirectInput8, (void**)&dinput, NULL);
|
|
if (FAILED(result)) {
|
|
printf("failed init DINPUT: %ld\n", result);
|
|
}
|
|
probe_joysticks();
|
|
}
|
|
|
|
joystick_windows::~joystick_windows() {
|
|
|
|
close_joystick();
|
|
dinput->Release();
|
|
unload_xinput();
|
|
}
|
|
|
|
|
|
bool joystick_windows::have_device(const GUID &p_guid) {
|
|
|
|
for (int i = 0; i < JOYSTICKS_MAX; i++) {
|
|
|
|
if (d_joysticks[i].guid == p_guid) {
|
|
|
|
d_joysticks[i].confirmed = true;
|
|
return true;
|
|
}
|
|
}
|
|
return false;
|
|
}
|
|
|
|
int joystick_windows::check_free_joy_slot() const {
|
|
|
|
for (int i = 0; i < JOYSTICKS_MAX; i++) {
|
|
|
|
if (!attached_joysticks[i])
|
|
return i;
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
|
|
// adapted from SDL2, works a lot better than the MSDN version
|
|
bool joystick_windows::is_xinput_device(const GUID *p_guid) {
|
|
|
|
static GUID IID_ValveStreamingGamepad = { MAKELONG(0x28DE, 0x11FF), 0x0000, 0x0000, { 0x00, 0x00, 0x50, 0x49, 0x44, 0x56, 0x49, 0x44 } };
|
|
static GUID IID_X360WiredGamepad = { MAKELONG(0x045E, 0x02A1), 0x0000, 0x0000, { 0x00, 0x00, 0x50, 0x49, 0x44, 0x56, 0x49, 0x44 } };
|
|
static GUID IID_X360WirelessGamepad = { MAKELONG(0x045E, 0x028E), 0x0000, 0x0000, { 0x00, 0x00, 0x50, 0x49, 0x44, 0x56, 0x49, 0x44 } };
|
|
|
|
if (p_guid == &IID_ValveStreamingGamepad || p_guid == &IID_X360WiredGamepad || p_guid == &IID_X360WirelessGamepad)
|
|
return true;
|
|
|
|
PRAWINPUTDEVICELIST dev_list = NULL;
|
|
unsigned int dev_list_count = 0;
|
|
|
|
if (GetRawInputDeviceList(NULL, &dev_list_count, sizeof(RAWINPUTDEVICELIST)) == -1) {
|
|
return false;
|
|
}
|
|
dev_list = (PRAWINPUTDEVICELIST) malloc(sizeof(RAWINPUTDEVICELIST) * dev_list_count);
|
|
if (!dev_list) return false;
|
|
|
|
if (GetRawInputDeviceList(dev_list, &dev_list_count, sizeof(RAWINPUTDEVICELIST)) == -1) {
|
|
free(dev_list);
|
|
return false;
|
|
}
|
|
for (int i = 0; i < dev_list_count; i++) {
|
|
|
|
RID_DEVICE_INFO rdi;
|
|
char dev_name[128];
|
|
UINT rdiSize = sizeof(rdi);
|
|
UINT nameSize = sizeof(dev_name);
|
|
|
|
rdi.cbSize = rdiSize;
|
|
if ( (dev_list[i].dwType == RIM_TYPEHID) &&
|
|
(GetRawInputDeviceInfoA(dev_list[i].hDevice, RIDI_DEVICEINFO, &rdi, &rdiSize) != (UINT)-1) &&
|
|
(MAKELONG(rdi.hid.dwVendorId, rdi.hid.dwProductId) == (LONG)p_guid->Data1) &&
|
|
(GetRawInputDeviceInfoA(dev_list[i].hDevice, RIDI_DEVICENAME, &dev_name, &nameSize) != (UINT)-1) &&
|
|
(strstr(dev_name, "IG_") != NULL)) {
|
|
|
|
free(dev_list);
|
|
return true;
|
|
}
|
|
}
|
|
free(dev_list);
|
|
return false;
|
|
}
|
|
|
|
bool joystick_windows::setup_dinput_joystick(const DIDEVICEINSTANCE* instance) {
|
|
|
|
HRESULT hr;
|
|
int num = check_free_joy_slot();
|
|
|
|
if (have_device(instance->guidInstance) || num == -1)
|
|
return false;
|
|
|
|
d_joysticks[joystick_count] = dinput_gamepad();
|
|
dinput_gamepad* joy = &d_joysticks[joystick_count];
|
|
|
|
const DWORD devtype = (instance->dwDevType & 0xFF);
|
|
|
|
if ((devtype != DI8DEVTYPE_JOYSTICK) && (devtype != DI8DEVTYPE_GAMEPAD) && (devtype != DI8DEVTYPE_1STPERSON)) {
|
|
//printf("ignore device %s, type %x\n", instance->tszProductName, devtype);
|
|
return false;
|
|
}
|
|
|
|
hr = dinput->CreateDevice(instance->guidInstance, &joy->di_joy, NULL);
|
|
|
|
if (FAILED(hr)) {
|
|
|
|
//std::wcout << "failed to create device: " << instance->tszProductName << std::endl;
|
|
return false;
|
|
}
|
|
|
|
const GUID &guid = instance->guidProduct;
|
|
char uid[128];
|
|
sprintf(uid, "%08lx%04hx%04hx%02hhx%02hhx%02hhx%02hhx%02hhx%02hhx%02hhx%02hhx",
|
|
__builtin_bswap32(guid.Data1), guid.Data2, guid.Data3,
|
|
guid.Data4[0], guid.Data4[1], guid.Data4[2], guid.Data4[3],
|
|
guid.Data4[4], guid.Data4[5], guid.Data4[6], guid.Data4[7]);
|
|
|
|
id_to_change = joystick_count;
|
|
|
|
joy->di_joy->SetDataFormat(&c_dfDIJoystick2);
|
|
joy->di_joy->SetCooperativeLevel(*hWnd, DISCL_FOREGROUND);
|
|
joy->di_joy->EnumObjects(objectsCallback, this, NULL);
|
|
joy->joy_axis.sort();
|
|
|
|
joy->guid = instance->guidInstance;
|
|
input->joy_connection_changed(num, true, instance->tszProductName, uid);
|
|
joy->attached = true;
|
|
joy->id = num;
|
|
attached_joysticks[num] = true;
|
|
joy->confirmed = true;
|
|
joystick_count++;
|
|
return true;
|
|
}
|
|
|
|
void joystick_windows::setup_joystick_object(const DIDEVICEOBJECTINSTANCE *ob, int p_joy_id) {
|
|
|
|
if (ob->dwType & DIDFT_AXIS) {
|
|
|
|
HRESULT res;
|
|
DIPROPRANGE prop_range;
|
|
DIPROPDWORD dilong;
|
|
DWORD ofs;
|
|
if (ob->guidType == GUID_XAxis)
|
|
ofs = DIJOFS_X;
|
|
else if (ob->guidType == GUID_YAxis)
|
|
ofs = DIJOFS_Y;
|
|
else if (ob->guidType == GUID_ZAxis)
|
|
ofs = DIJOFS_Z;
|
|
else if (ob->guidType == GUID_RxAxis)
|
|
ofs = DIJOFS_RX;
|
|
else if (ob->guidType == GUID_RyAxis)
|
|
ofs = DIJOFS_RY;
|
|
else if (ob->guidType == GUID_RzAxis)
|
|
ofs = DIJOFS_RZ;
|
|
else if (ob->guidType == GUID_Slider)
|
|
ofs = DIJOFS_SLIDER(0);
|
|
else
|
|
return;
|
|
prop_range.diph.dwSize = sizeof(DIPROPRANGE);
|
|
prop_range.diph.dwHeaderSize = sizeof(DIPROPHEADER);
|
|
prop_range.diph.dwObj = ob->dwType;
|
|
prop_range.diph.dwHow = DIPH_BYID;
|
|
prop_range.lMin = -MAX_JOY_AXIS;
|
|
prop_range.lMax = +MAX_JOY_AXIS;
|
|
|
|
dinput_gamepad &joy = d_joysticks[p_joy_id];
|
|
|
|
|
|
res = IDirectInputDevice8_SetProperty(joy.di_joy, DIPROP_RANGE, &prop_range.diph);
|
|
if (FAILED(res))
|
|
return;
|
|
|
|
dilong.diph.dwSize = sizeof(dilong);
|
|
dilong.diph.dwHeaderSize = sizeof(dilong.diph);
|
|
dilong.diph.dwObj = ob->dwType;
|
|
dilong.diph.dwHow = DIPH_BYID;
|
|
dilong.dwData = 0;
|
|
|
|
res = IDirectInputDevice8_SetProperty(joy.di_joy, DIPROP_DEADZONE, &dilong.diph);
|
|
if (FAILED(res))
|
|
return;
|
|
|
|
joy.joy_axis.push_back(ofs);
|
|
}
|
|
}
|
|
|
|
BOOL CALLBACK joystick_windows::enumCallback(const DIDEVICEINSTANCE* instance, void* pContext) {
|
|
|
|
|
|
joystick_windows* self = (joystick_windows*)pContext;
|
|
if (self->is_xinput_device(&instance->guidProduct)) {;
|
|
return DIENUM_CONTINUE;
|
|
}
|
|
self->setup_dinput_joystick(instance);
|
|
return DIENUM_CONTINUE;
|
|
}
|
|
|
|
BOOL CALLBACK joystick_windows::objectsCallback(const DIDEVICEOBJECTINSTANCE *instance, void *context) {
|
|
|
|
joystick_windows* self = (joystick_windows*)context;
|
|
self->setup_joystick_object(instance, self->id_to_change);
|
|
|
|
return DIENUM_CONTINUE;
|
|
}
|
|
|
|
void joystick_windows::close_joystick(int id) {
|
|
|
|
if (id == -1) {
|
|
|
|
for (int i = 0; i < JOYSTICKS_MAX; i++) {
|
|
|
|
close_joystick(i);
|
|
}
|
|
return;
|
|
}
|
|
|
|
if (!d_joysticks[id].attached) return;
|
|
|
|
d_joysticks[id].di_joy->Unacquire();
|
|
d_joysticks[id].di_joy->Release();
|
|
d_joysticks[id].attached = false;
|
|
attached_joysticks[d_joysticks[id].id] = false;
|
|
d_joysticks[id].guid.Data1 = d_joysticks[id].guid.Data2 = d_joysticks[id].guid.Data3 = 0;
|
|
input->joy_connection_changed(id, false, "");
|
|
joystick_count--;
|
|
}
|
|
|
|
void joystick_windows::probe_joysticks() {
|
|
|
|
DWORD dwResult;
|
|
for (DWORD i = 0; i < XUSER_MAX_COUNT; i++) {
|
|
|
|
ZeroMemory(&x_joysticks[i].state, sizeof(XINPUT_STATE));
|
|
|
|
dwResult = xinput_get_state(i, &x_joysticks[i].state);
|
|
if ( dwResult == ERROR_SUCCESS) {
|
|
|
|
int id = check_free_joy_slot();
|
|
if (id != -1 && !x_joysticks[i].attached) {
|
|
|
|
x_joysticks[i].attached = true;
|
|
x_joysticks[i].id = id;
|
|
attached_joysticks[id] = true;
|
|
input->joy_connection_changed(id, true, "XInput Gamepad","__XINPUT_DEVICE__");
|
|
}
|
|
}
|
|
else if (x_joysticks[i].attached) {
|
|
|
|
x_joysticks[i].attached = false;
|
|
attached_joysticks[x_joysticks[i].id] = false;
|
|
input->joy_connection_changed(x_joysticks[i].id, false, "");
|
|
}
|
|
}
|
|
|
|
for (int i = 0; i < joystick_count; i++) {
|
|
|
|
d_joysticks[i].confirmed = false;
|
|
}
|
|
|
|
dinput->EnumDevices(DI8DEVCLASS_GAMECTRL, enumCallback, this, DIEDFL_ATTACHEDONLY);
|
|
|
|
for (int i = 0; i < joystick_count; i++) {
|
|
|
|
if (!d_joysticks[i].confirmed) {
|
|
|
|
close_joystick(i);
|
|
}
|
|
}
|
|
}
|
|
|
|
unsigned int joystick_windows::process_joysticks(unsigned int p_last_id) {
|
|
|
|
HRESULT hr;
|
|
|
|
for (int i = 0; i < XUSER_MAX_COUNT; i++) {
|
|
|
|
xinput_gamepad &joy = x_joysticks[i];
|
|
if (!joy.attached) {
|
|
continue;
|
|
}
|
|
ZeroMemory(&joy.state, sizeof(XINPUT_STATE));
|
|
|
|
xinput_get_state(i, &joy.state);
|
|
if (joy.state.dwPacketNumber != joy.last_packet) {
|
|
|
|
int button_mask = XINPUT_GAMEPAD_DPAD_UP;
|
|
for (int i = 0; i <= 16; i++) {
|
|
|
|
p_last_id = input->joy_button(p_last_id, joy.id, i, joy.state.Gamepad.wButtons & button_mask);
|
|
button_mask = button_mask * 2;
|
|
}
|
|
|
|
p_last_id = input->joy_axis(p_last_id, joy.id, JOY_AXIS_0, axis_correct(joy.state.Gamepad.sThumbLX, true));
|
|
p_last_id = input->joy_axis(p_last_id, joy.id, JOY_AXIS_1, axis_correct(joy.state.Gamepad.sThumbLY, true, false, true));
|
|
p_last_id = input->joy_axis(p_last_id, joy.id, JOY_AXIS_2, axis_correct(joy.state.Gamepad.sThumbRX, true));
|
|
p_last_id = input->joy_axis(p_last_id, joy.id, JOY_AXIS_3, axis_correct(joy.state.Gamepad.sThumbRY, true, false, true));
|
|
p_last_id = input->joy_axis(p_last_id, joy.id, JOY_AXIS_4, axis_correct(joy.state.Gamepad.bLeftTrigger, true, true));
|
|
p_last_id = input->joy_axis(p_last_id, joy.id, JOY_AXIS_5, axis_correct(joy.state.Gamepad.bRightTrigger, true, true));
|
|
joy.last_packet = joy.state.dwPacketNumber;
|
|
}
|
|
}
|
|
|
|
for (int i = 0; i < JOYSTICKS_MAX; i++) {
|
|
|
|
dinput_gamepad* joy = &d_joysticks[i];
|
|
|
|
if (!joy->attached)
|
|
continue;
|
|
|
|
DIJOYSTATE2 js;
|
|
hr = joy->di_joy->Poll();
|
|
if (hr == DIERR_INPUTLOST || hr == DIERR_NOTACQUIRED) {
|
|
IDirectInputDevice8_Acquire(joy->di_joy);
|
|
joy->di_joy->Poll();
|
|
}
|
|
if (FAILED(hr = joy->di_joy->GetDeviceState(sizeof(DIJOYSTATE2), &js))) {
|
|
|
|
//printf("failed to read joy #%d\n", i);
|
|
continue;
|
|
}
|
|
|
|
p_last_id = post_hat(p_last_id, joy->id, js.rgdwPOV[0]);
|
|
|
|
for (int j = 0; j < 128; j++) {
|
|
|
|
if (js.rgbButtons[j] & 0x80) {
|
|
|
|
if (!joy->last_buttons[j]) {
|
|
|
|
p_last_id = input->joy_button(p_last_id, joy->id, j, true);
|
|
joy->last_buttons[j] = true;
|
|
}
|
|
}
|
|
else {
|
|
|
|
if (joy->last_buttons[j]) {
|
|
|
|
p_last_id = input->joy_button(p_last_id, joy->id, j, false);
|
|
joy->last_buttons[j] = false;
|
|
}
|
|
}
|
|
}
|
|
|
|
// on mingw, these constants are not constants
|
|
int count = 6;
|
|
int axes[] = { DIJOFS_X, DIJOFS_Y, DIJOFS_Z, DIJOFS_RX, DIJOFS_RY, DIJOFS_RZ };
|
|
int values[] = { js.lX, js.lY, js.lZ, js.lRx, js.lRy, js.lRz };
|
|
|
|
for (int j = 0; j < joy->joy_axis.size(); j++) {
|
|
|
|
for (int k=0; k<count; k++) {
|
|
if (joy->joy_axis[j] == axes[k]) {
|
|
p_last_id = input->joy_axis(p_last_id, joy->id, j, axis_correct(values[k]));
|
|
break;
|
|
};
|
|
};
|
|
};
|
|
}
|
|
return p_last_id;
|
|
}
|
|
|
|
unsigned int joystick_windows::post_hat(unsigned int p_last_id, int p_device, DWORD p_dpad) {
|
|
|
|
int dpad_val = 0;
|
|
|
|
if (p_dpad == -1) {
|
|
dpad_val = InputDefault::HAT_MASK_CENTER;
|
|
}
|
|
if (p_dpad == 0) {
|
|
|
|
dpad_val = InputDefault::HAT_MASK_UP;
|
|
|
|
}
|
|
else if (p_dpad == 4500) {
|
|
|
|
dpad_val = (InputDefault::HAT_MASK_UP | InputDefault::HAT_MASK_RIGHT);
|
|
|
|
}
|
|
else if (p_dpad == 9000) {
|
|
|
|
dpad_val = InputDefault::HAT_MASK_RIGHT;
|
|
|
|
}
|
|
else if (p_dpad == 13500) {
|
|
|
|
dpad_val = (InputDefault::HAT_MASK_RIGHT | InputDefault::HAT_MASK_DOWN);
|
|
|
|
}
|
|
else if (p_dpad == 18000) {
|
|
|
|
dpad_val = InputDefault::HAT_MASK_DOWN;
|
|
|
|
}
|
|
else if (p_dpad == 22500) {
|
|
|
|
dpad_val = (InputDefault::HAT_MASK_DOWN | InputDefault::HAT_MASK_LEFT);
|
|
|
|
}
|
|
else if (p_dpad == 27000) {
|
|
|
|
dpad_val = InputDefault::HAT_MASK_LEFT;
|
|
|
|
}
|
|
else if (p_dpad == 31500) {
|
|
|
|
dpad_val = (InputDefault::HAT_MASK_LEFT | InputDefault::HAT_MASK_UP);
|
|
}
|
|
return input->joy_hat(p_last_id, p_device, dpad_val);
|
|
};
|
|
|
|
InputDefault::JoyAxis joystick_windows::axis_correct(int p_val, bool p_xinput, bool p_trigger, bool p_negate) const {
|
|
|
|
InputDefault::JoyAxis jx;
|
|
if (Math::abs(p_val) < MIN_JOY_AXIS) {
|
|
jx.min = -1;
|
|
jx.value = 0.0f;
|
|
return jx;
|
|
}
|
|
if (p_xinput) {
|
|
|
|
if (p_trigger) {
|
|
jx.min = 0;
|
|
jx.value = (float)p_val / MAX_TRIGGER;
|
|
return jx;
|
|
}
|
|
jx.min = -1;
|
|
if (p_val < 0) {
|
|
jx.value = (float)p_val / MAX_JOY_AXIS;
|
|
}
|
|
else {
|
|
jx.value = (float)p_val / (MAX_JOY_AXIS - 1);
|
|
}
|
|
if (p_negate) {
|
|
jx.value = -jx.value;
|
|
}
|
|
return jx;
|
|
}
|
|
jx.min = -1;
|
|
jx.value = (float)p_val / MAX_JOY_AXIS;
|
|
return jx;
|
|
}
|
|
|
|
void joystick_windows::load_xinput() {
|
|
|
|
xinput_get_state = &_xinput_get_state;
|
|
xinput_dll = LoadLibrary( "XInput1_4.dll" );
|
|
if (!xinput_dll) {
|
|
xinput_dll = LoadLibrary("XInput1_3.dll");
|
|
if (!xinput_dll) {
|
|
xinput_dll = LoadLibrary("XInput9_1_0.dll");
|
|
}
|
|
}
|
|
|
|
if (!xinput_dll) {
|
|
if (OS::get_singleton()->is_stdout_verbose()) {
|
|
print_line("Could not find XInput, using DirectInput only");
|
|
}
|
|
return;
|
|
}
|
|
|
|
XInputGetState_t func = (XInputGetState_t)GetProcAddress((HMODULE)xinput_dll, "XInputGetState");
|
|
if (!func) {
|
|
unload_xinput();
|
|
return;
|
|
}
|
|
xinput_get_state = func;
|
|
return;
|
|
}
|
|
|
|
void joystick_windows::unload_xinput() {
|
|
|
|
if (xinput_dll) {
|
|
|
|
FreeLibrary((HMODULE)xinput_dll);
|
|
}
|
|
}
|