ShuriZma
/
pcsx2
mirror of https://github.com/PCSX2/pcsx2.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Pad: Native DualShock 3 support in Windows by official Sony driver (sixaxis)

This commit is contained in:
rewasdadmin 2022-09-29 22:03:28 +03:00 committed by refractionpcsx2
parent 5637ff4228
commit 7c3aa65166
2 changed files with 114 additions and 332 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

442
pcsx2/PAD/Windows/DualShock3.cpp
View File

@ -18,181 +18,39 @@
#include "InputManager.h" #include "InputManager.h"
#include "PADConfig.h" #include "PADConfig.h"
#include "usb.h"
#include "HidDevice.h" #include "HidDevice.h"
#define VID 0x054c #define VID 0x054c
#define PID 0x0268 #define PID 0x0268
// Unresponsive period required before calling DS3Check(). //Sixaxis driver commands.
#define DEVICE_CHECK_DELAY 2000 //All commands must be sent via WriteFile with 49-byte buffer containing output report.
// Unresponsive period required before calling DS3Enum(). Note that enum is always called on first check. //Byte 0 indicates reportId and must always be 0.
#define DEVICE_ENUM_DELAY 10000 //Byte 1 indicates some command, supported values are specified below.
// Delay between when DS3Check() and DS3Enum() actually do stuff. //This command allows to set user LEDs.
#define DOUBLE_CHECK_DELAY 1000 //Bytes 5,6.7.8 contain mode for corresponding LED: 0 value means LED is OFF, 1 means LEDs in ON and 2 means LEDs is flashing.
#define DOUBLE_ENUM_DELAY 20000 //Bytes 9-16 specify 64-bit LED flash period in 100 ns units if some LED is flashing, otherwise not used.
#define SIXAXIS_COMMAND_SET_LEDS 1
// Send at least one message every 3 seconds - basically just makes sure the right light(s) are on. //This command allows to set left and right motors.
// Not really necessary. //Byte 5 is right motor duration (0-255) and byte 6, if not zero, activates right motor. Zero value disables right motor.
#define UPDATE_INTERVAL 3000 //Byte 7 is left motor duration (0-255) and byte 8 is left motor amplitude (0-255).
#define SIXAXIS_COMMAND_SET_MOTORS 2
unsigned int lastDS3Check = 0; //This command allows to block/unblock setting device LEDs by applications.
unsigned int lastDS3Enum = 0; //Byte 5 is used as parameter - any non-zero value blocks LEDs, zero value will unblock LEDs.
#define SIXAXIS_COMMAND_BLOCK_LEDS 3
typedef void(__cdecl* _usb_init)(void); //This command refreshes driver settings. No parameters used.
typedef int(__cdecl* _usb_close)(usb_dev_handle* dev); //When sixaxis driver loads it reads 'CurrentDriverSetting' binary value from 'HKLM\System\CurrentControlSet\Services\sixaxis\Parameters' registry key.
typedef int(__cdecl* _usb_get_string_simple)(usb_dev_handle* dev, int index, char* buf, size_t buflen); //If the key is not present then default values are used. Sending this command forces sixaxis driver to re-read the registry and update driver settings.
typedef usb_dev_handle*(__cdecl* _usb_open)(struct usb_device* dev); #define SIXAXIS_COMMAND_REFRESH_DRIVER_SETTING 9
typedef int(__cdecl* _usb_find_busses)(void); //This command clears current bluetooth pairing. No parameters used.
typedef int(__cdecl* _usb_find_devices)(void); #define SIXAXIS_COMMAND_CLEAR_PAIRING 10
typedef struct usb_bus*(__cdecl* _usb_get_busses)(void);
typedef usb_dev_handle*(__cdecl* _usb_open)(struct usb_device* dev);
typedef int(__cdecl* _usb_control_msg)(usb_dev_handle* dev, int requesttype, int request, int value, int index, char* bytes, int size, int timeout);
_usb_init pusb_init;
_usb_close pusb_close;
_usb_get_string_simple pusb_get_string_simple;
_usb_open pusb_open;
_usb_find_busses pusb_find_busses;
_usb_find_devices pusb_find_devices;
_usb_get_busses pusb_get_busses;
_usb_control_msg pusb_control_msg;
HMODULE hModLibusb = 0;
void UninitLibUsb()
{
if (hModLibusb)
{
FreeLibrary(hModLibusb);
hModLibusb = 0;
}
}
void TryInitDS3(usb_device* dev)
{
while (dev)
{
if (dev->descriptor.idVendor == VID && dev->descriptor.idProduct == PID)
{
usb_dev_handle* handle = pusb_open(dev);
if (handle)
{
char junk[20];
// This looks like HidD_GetFeature with a feature report id of 0xF2 to me and a length of 17.
// That doesn't work, however, and 17 is shorter than the report length.
pusb_control_msg(handle, 0xa1, 1, 0x03f2, dev->config->interface->altsetting->bInterfaceNumber, junk, 17, 1000);
pusb_close(handle);
}
}
if (dev->num_children)
{
for (int i = 0; i < dev->num_children; i++)
{
TryInitDS3(dev->children[i]);
}
}
dev = dev->next;
}
}
void DS3Enum(unsigned int time)
{
if (time - lastDS3Enum < DOUBLE_ENUM_DELAY)
{
return;
}
lastDS3Enum = time;
pusb_find_busses();
pusb_find_devices();
}
void DS3Check(unsigned int time)
{
if (time - lastDS3Check < DOUBLE_CHECK_DELAY)
{
return;
}
if (!lastDS3Check)
{
DS3Enum(time);
}
lastDS3Check = time;
usb_bus* bus = pusb_get_busses();
while (bus)
{
TryInitDS3(bus->devices);
bus = bus->next;
}
}
int InitLibUsb()
{
if (hModLibusb)
{
return 1;
}
hModLibusb = LoadLibraryA("C:\\windows\\system32\\libusb0.dll");
if (hModLibusb)
{
if ((pusb_init = (_usb_init)GetProcAddress(hModLibusb, "usb_init")) &&
(pusb_close = (_usb_close)GetProcAddress(hModLibusb, "usb_close")) &&
(pusb_get_string_simple = (_usb_get_string_simple)GetProcAddress(hModLibusb, "usb_get_string_simple")) &&
(pusb_open = (_usb_open)GetProcAddress(hModLibusb, "usb_open")) &&
(pusb_find_busses = (_usb_find_busses)GetProcAddress(hModLibusb, "usb_find_busses")) &&
(pusb_find_devices = (_usb_find_devices)GetProcAddress(hModLibusb, "usb_find_devices")) &&
(pusb_get_busses = (_usb_get_busses)GetProcAddress(hModLibusb, "usb_get_busses")) &&
(pusb_control_msg = (_usb_control_msg)GetProcAddress(hModLibusb, "usb_control_msg")))
{
pusb_init();
return 1;
}
UninitLibUsb();
}
return 0;
}
int DualShock3Possible() int DualShock3Possible()
{ {
return InitLibUsb(); return 1;
} }
#include <pshpack1.h>
struct MotorState
{
unsigned char duration;
unsigned char force;
};
struct LightState
{
// 0xFF makes it stay on.
unsigned char duration;
// Have to make one or the other non-zero to turn on light.
unsigned char dunno[2];
// Have to make non-zero to turn on light.
unsigned char on;
};
// Data sent to DS3 to set state.
struct DS3Command
{
unsigned char id;
// Small is first, then big.
MotorState motors[2];
// 2 is pad 1 light, 4 is pad 2, 8 is pad 3, 16 is pad 4. No clue about the others.
unsigned char lightFlags;
// Lights are in reverse order. pad 1 is last.
LightState lights[4];
unsigned char dunno[18];
};
#include <poppack.h>
int CharToAxis(unsigned char c) int CharToAxis(unsigned char c)
{ {
return ((c - 128) * FULLY_DOWN) >> 7; return ((c - 128) * FULLY_DOWN) >> 7;
@ -214,78 +72,11 @@ class DualShock3Device : public Device
public: public:
int index; int index;
HANDLE hFile; HANDLE hFile;
DS3Command sendState;
unsigned char getState[49]; unsigned char getState[49];
OVERLAPPED readop;
OVERLAPPED writeop;
int writeCount;
int lastWrite;
unsigned int dataLastReceived;
int writeQueued;
int writing;
int StartRead()
{
int res = ReadFile(hFile, &getState, sizeof(getState), 0, &readop);
return (res || GetLastError() == ERROR_IO_PENDING);
}
void QueueWrite()
{
// max of 2 queued writes allowed, one for either motor.
if (writeQueued < 2)
{
writeQueued++;
StartWrite();
}
}
int StartWrite()
{
if (!writing && writeQueued)
{
lastWrite = GetTickCount();
writing++;
writeQueued--;
sendState.motors[0].duration = 0x50;
sendState.motors[1].duration = 0x50;
int bigForce = vibration[0] * 256 / FULLY_DOWN;
if (bigForce > 255)
bigForce = 255;
sendState.motors[1].force = (unsigned char)bigForce;
sendState.motors[0].force = (unsigned char)(vibration[1] >= FULLY_DOWN / 2);
// Can't seem to have them both non-zero at once.
if (sendState.motors[writeCount & 1].force)
{
sendState.motors[(writeCount & 1) ^ 1].force = 0;
sendState.motors[(writeCount & 1) ^ 1].duration = 0;
}
writeCount++;
int res = WriteFile(hFile, &sendState, sizeof(sendState), 0, &writeop);
return (res || GetLastError() == ERROR_IO_PENDING);
}
return 1;
}
DualShock3Device(int index, wchar_t* name, wchar_t* path) DualShock3Device(int index, wchar_t* name, wchar_t* path)
: Device(DS3, OTHER, name, path, L"DualShock 3") : Device(DS3, OTHER, name, path, L"DualShock 3")
{ {
writeCount = 0;
writing = 0;
writeQueued = 0;
memset(&readop, 0, sizeof(readop));
memset(&writeop, 0, sizeof(writeop));
memset(&sendState, 0, sizeof(sendState));
sendState.id = 1;
int temp = (index & 4);
sendState.lightFlags = (1 << (temp + 1));
sendState.lights[3 - temp].duration = 0xFF;
sendState.lights[3 - temp].dunno[0] = 1;
sendState.lights[3 - temp].on = 1;
memset(ps2Vibration, 0, sizeof(ps2Vibration)); memset(ps2Vibration, 0, sizeof(ps2Vibration));
vibration[0] = vibration[1] = 0; vibration[0] = vibration[1] = 0;
this->index = index; this->index = index;
@ -350,13 +141,8 @@ public:
{ {
if (active) if (active)
Deactivate(); Deactivate();
// Give grace period before get mad. hFile = CreateFileW(instanceID, GENERIC_READ | GENERIC_WRITE, FILE_SHARE_READ | FILE_SHARE_WRITE, NULL, OPEN_EXISTING, 0, NULL);
lastWrite = dataLastReceived = GetTickCount(); if (hFile == INVALID_HANDLE_VALUE)
readop.hEvent = CreateEvent(0, 0, 0, 0);
writeop.hEvent = CreateEvent(0, 0, 0, 0);
hFile = CreateFileW(instanceID, GENERIC_READ | GENERIC_WRITE, FILE_SHARE_READ | FILE_SHARE_WRITE, 0, OPEN_EXISTING, FILE_FLAG_OVERLAPPED, 0);
if (!readop.hEvent || !writeop.hEvent || hFile == INVALID_HANDLE_VALUE ||
!StartRead())
{ {
Deactivate(); Deactivate();
return 0; return 0;
@ -370,78 +156,46 @@ public:
{ {
if (!active) if (!active)
return 0; return 0;
HANDLE h[2] = {
readop.hEvent,
writeop.hEvent};
unsigned int time = GetTickCount();
if (time - lastWrite > UPDATE_INTERVAL)
{
QueueWrite();
}
while (1)
{
DWORD res = WaitForMultipleObjects(2, h, 0, 0);
if (res == WAIT_OBJECT_0)
{
dataLastReceived = time;
if (!StartRead())
{
Deactivate();
return 0;
}
physicalControlState[0] = CharToButton(getState[25]); unsigned char Buffer[50];
physicalControlState[1] = CharToButton(getState[24]);
physicalControlState[2] = CharToButton(getState[23]); Buffer[0] = 0; //reportId
physicalControlState[3] = CharToButton(getState[22]);
physicalControlState[4] = CharToButton(getState[21]); if (!HidD_GetFeature(hFile,
physicalControlState[5] = CharToButton(getState[20]); Buffer,
physicalControlState[6] = CharToButton(getState[19]); sizeof(Buffer)))
physicalControlState[7] = CharToButton(getState[18]); {
physicalControlState[10] = CharToButton(getState[17]); Deactivate();
physicalControlState[11] = CharToButton(getState[16]); return 0;
physicalControlState[12] = CharToButton(getState[15]);
physicalControlState[13] = CharToButton(getState[14]);
physicalControlState[8] = ((getState[2] & 4) / 4) * FULLY_DOWN;
physicalControlState[9] = ((getState[2] & 2) / 2) * FULLY_DOWN;
physicalControlState[15] = ((getState[2] & 1) / 1) * FULLY_DOWN;
physicalControlState[14] = ((getState[2] & 8) / 8) * FULLY_DOWN;
physicalControlState[16] = CharToAxis(getState[6]);
physicalControlState[17] = CharToAxis(getState[7]);
physicalControlState[18] = CharToAxis(getState[8]);
physicalControlState[19] = CharToAxis(getState[9]);
physicalControlState[20] = CharToAxis(getState[42] + 128);
physicalControlState[21] = CharToAxis(getState[44] + 128);
physicalControlState[22] = CharToAxis(getState[46] + 128);
continue;
}
else if (res == WAIT_OBJECT_0 + 1)
{
writing = 0;
if (!writeQueued && (vibration[0] | vibration[1]))
{
QueueWrite();
}
if (!StartWrite())
{
Deactivate();
return 0;
}
}
else
{
if (time - dataLastReceived >= DEVICE_CHECK_DELAY)
{
if (time - dataLastReceived >= DEVICE_ENUM_DELAY)
{
DS3Enum(time);
}
DS3Check(time);
QueueWrite();
}
}
break;
} }
unsigned char* getState = &Buffer[1];
physicalControlState[0] = CharToButton(getState[25]); //Square
physicalControlState[1] = CharToButton(getState[24]); //Cross
physicalControlState[2] = CharToButton(getState[23]); //Circle
physicalControlState[3] = CharToButton(getState[22]); //Triangle
physicalControlState[4] = CharToButton(getState[21]); //R1
physicalControlState[5] = CharToButton(getState[20]); //L1
physicalControlState[6] = CharToButton(getState[19]); //R2
physicalControlState[7] = CharToButton(getState[18]); //L2
physicalControlState[10] = CharToButton(getState[17]); //Dpad Left
physicalControlState[11] = CharToButton(getState[16]); //Dpad Down
physicalControlState[12] = CharToButton(getState[15]); //Dpad Right
physicalControlState[13] = CharToButton(getState[14]); //Dpad Up
physicalControlState[8] = ((getState[2] & 4) / 4) * FULLY_DOWN; //R3
physicalControlState[9] = ((getState[2] & 2) / 2) * FULLY_DOWN; //L3
physicalControlState[15] = ((getState[2] & 1) / 1) * FULLY_DOWN; //SELECT
physicalControlState[14] = ((getState[2] & 8) / 8) * FULLY_DOWN; //START
physicalControlState[16] = CharToAxis(getState[6]); //Left Stick X
physicalControlState[17] = CharToAxis(getState[7]); //Left Stick Y
physicalControlState[18] = CharToAxis(getState[8]); //Right Stick X
physicalControlState[19] = CharToAxis(getState[9]); //Right Stick Y
//Compared to libusb all sensor values on sixaxis driver are little-endian and X axis is inversed
physicalControlState[20] = CharToAxis(128 - getState[41]); //Accel X (Left/Right Tilt)
physicalControlState[21] = CharToAxis(getState[43] + 128); //Accel Y (Forward/Back Tilt)
physicalControlState[22] = CharToAxis(getState[45] + 128); //Accel Z
return 1; return 1;
} }
@ -463,9 +217,30 @@ public:
} }
} }
} }
// Make sure at least 2 writes are queued, to update both motors.
QueueWrite(); unsigned char outputReport[49];
QueueWrite();
//Clear all data and set reportId to 0
memset(outputReport, 0, sizeof(outputReport));
//This is command for sixaxis driver to set motors
outputReport[1] = SIXAXIS_COMMAND_SET_MOTORS;
outputReport[5] = 0x50; //right_duration
outputReport[6] = (unsigned char)(vibration[1] >= FULLY_DOWN / 2); //right_motor_on
outputReport[7] = 0x50; //left_duration
int bigForce = vibration[0] * 256 / FULLY_DOWN;
if (bigForce > 255)
bigForce = 255;
outputReport[8] = (unsigned char)bigForce; //left_motor_force
DWORD lpNumberOfBytesWritten = 0;
WriteFile(hFile, outputReport, sizeof(outputReport), &lpNumberOfBytesWritten, NULL);
} }
void SetEffect(ForceFeedbackBinding* binding, unsigned char force) void SetEffect(ForceFeedbackBinding* binding, unsigned char force)
@ -485,16 +260,7 @@ public:
CloseHandle(hFile); CloseHandle(hFile);
hFile = INVALID_HANDLE_VALUE; hFile = INVALID_HANDLE_VALUE;
} }
if (readop.hEvent)
{
CloseHandle(readop.hEvent);
}
if (writeop.hEvent)
{
CloseHandle(writeop.hEvent);
}
writing = 0;
writeQueued = 0;
memset(ps2Vibration, 0, sizeof(ps2Vibration)); memset(ps2Vibration, 0, sizeof(ps2Vibration));
vibration[0] = vibration[1] = 0; vibration[0] = vibration[1] = 0;
@ -509,9 +275,6 @@ public:
void EnumDualShock3s() void EnumDualShock3s()
{ {
if (!InitLibUsb())
return;
HidDeviceInfo* foundDevs = 0; HidDeviceInfo* foundDevs = 0;
int numDevs = FindHids(&foundDevs, VID, PID); int numDevs = FindHids(&foundDevs, VID, PID);
@ -520,14 +283,33 @@ void EnumDualShock3s()
int index = 0; int index = 0;
for (int i = 0; i < numDevs; i++) for (int i = 0; i < numDevs; i++)
{ {
if (foundDevs[i].caps.FeatureReportByteLength == 49 && if (foundDevs[i].caps.FeatureReportByteLength == 50 &&
foundDevs[i].caps.InputReportByteLength == 49 &&
foundDevs[i].caps.OutputReportByteLength == 49) foundDevs[i].caps.OutputReportByteLength == 49)
{ {
wchar_t temp[100]; HANDLE hDevice = CreateFileW(foundDevs[i].path,
wsprintfW(temp, L"DualShock 3 #%i", index + 1); GENERIC_READ | GENERIC_WRITE,
dm->AddDevice(new DualShock3Device(index, temp, foundDevs[i].path)); FILE_SHARE_READ | FILE_SHARE_WRITE,
index++; NULL,
OPEN_EXISTING,
0, NULL);
if (hDevice != INVALID_HANDLE_VALUE)
{
unsigned char Buffer[50];
Buffer[0] = 0; //reportId
if (HidD_GetFeature(hDevice,
Buffer,
sizeof(Buffer)))
{
wchar_t temp[100];
wsprintfW(temp, L"DualShock 3 #%i", index + 1);
dm->AddDevice(new DualShock3Device(index, temp, foundDevs[i].path));
index++;
}
CloseHandle(hDevice);
}
} }
free(foundDevs[i].path); free(foundDevs[i].path);
} }

4
pcsx2/PAD/Windows/PAD.rc
View File

@ -451,7 +451,7 @@ BEGIN
GROUPBOX "Game Device APIs",IDC_STATIC,16,59,191,62 GROUPBOX "Game Device APIs",IDC_STATIC,16,59,191,62
CONTROL "DirectInput (Legacy)",IDC_G_DI,"Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,71,100,10 CONTROL "DirectInput (Legacy)",IDC_G_DI,"Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,71,100,10
CONTROL "XInput (Modern)",IDC_G_XI,"Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,82,100,10 CONTROL "XInput (Modern)",IDC_G_XI,"Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,82,100,10
CONTROL "DualShock 3 native mode (Requires libusb)",IDC_G_DS3, CONTROL "DualShock 3 native mode (Requires sixaxis)",IDC_G_DS3,
"Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,94,155,10 "Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,94,155,10
CONTROL "Monitor when in background",IDC_BACKGROUND,"Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,105,107,10 CONTROL "Monitor when in background",IDC_BACKGROUND,"Button",BS_AUTOCHECKBOX | WS_TABSTOP,22,105,107,10
GROUPBOX "Mouse API",IDC_STATIC,216,16,192,61 GROUPBOX "Mouse API",IDC_STATIC,216,16,192,61
@ -574,4 +574,4 @@ IDR_INI1 RCDATA "Default.ini"
///////////////////////////////////////////////////////////////////////////// /////////////////////////////////////////////////////////////////////////////
#endif // not APSTUDIO_INVOKED #endif // not APSTUDIO_INVOKED