Create RetroJoystickAdapter_Playstation_XB360.ino

This commit is contained in:
Jarno Lehtinen 2021-01-18 22:03:55 +02:00 committed by GitHub
parent 3d4b29b409
commit efcc940607
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 265 additions and 0 deletions

View File

@ -0,0 +1,265 @@
#define XINPUT
#ifdef XINPUT
#include <XInput.h>
#endif
#ifndef XINPUT
#define DEBUG
#endif
//#define DEBUG //doesn't work with XInput
// 5V (red)
// GND (black)
#define DATA1 2 // (brown)
#define CMD1 3 // (orange)
#define ATT1 4 // (yellow)
#define CLK1 5 // (blue)
#define JOYSTICK_STATE_SIZE 6
//data[0]
//bit0 = select
//bit1 = L3
//bit2 = R3
//bit3 = start
//bit4 = up
//bit5 = right
//bit6 = down
//bit7 = left
//data[1}
//bit0 = L2
//bit1 = R2
//bit2 = L1
//bit3 = R1
//bit4 = T
//bit5 = O
//bit6 = X
//bit7 = S
#define PS_select (data[0] & ( 1 << 0 ))
#define PS_L3 (data[0] & ( 1 << 1 ))
#define PS_R3 (data[0] & ( 1 << 2 ))
#define PS_start (data[0] & ( 1 << 3 ))
#define PS_up (data[0] & ( 1 << 4 ))
#define PS_right (data[0] & ( 1 << 5 ))
#define PS_down (data[0] & ( 1 << 6 ))
#define PS_left (data[0] & ( 1 << 7 ))
#define PS_L2 (data[1] & ( 1 << 0 ))
#define PS_R2 (data[1] & ( 1 << 1 ))
#define PS_L1 (data[1] & ( 1 << 2 ))
#define PS_R1 (data[1] & ( 1 << 3 ))
#define PS_T (data[1] & ( 1 << 4 ))
#define PS_O (data[1] & ( 1 << 5 ))
#define PS_X (data[1] & ( 1 << 6 ))
#define PS_S (data[1] & ( 1 << 7 ))
#define PS_LX ((data[4]-128)*256)
#define PS_LY ((-data[5]+127)*256)
#define PS_RX ((data[2]-128)*256)
#define PS_RY ((-data[3]+127)*256)
uint8_t head;
uint8_t type;
uint8_t padding;
uint8_t data[JOYSTICK_STATE_SIZE];
uint8_t olddata[JOYSTICK_STATE_SIZE];
uint8_t flag;
/*
void setup() {
XInput.begin();
}
void loop() {
XInput.press(BUTTON_A);
delay(1000);
XInput.release(BUTTON_A);
delay(1000);
}*/
/*
class Joystick_ {
private:
uint8_t joystickId;
uint8_t reportId;
uint8_t olddata[JOYSTICK_STATE_SIZE];
uint8_t flag;
public:
uint8_t type;
uint8_t data[JOYSTICK_STATE_SIZE];
Joystick_(uint8_t initJoystickId, uint8_t initReportId) {
// Setup HID report structure
static bool usbSetup = false;
if (!usbSetup) {
static HIDSubDescriptor node(hidReportDescriptor, sizeof(hidReportDescriptor));
HID().AppendDescriptor(&node);
usbSetup = true;
}
// Initalize State
joystickId = initJoystickId;
reportId = initReportId;
data[0] = 0;
data[1] = 0;
data[2] = 127;
data[3] = 127;
data[4] = 127;
data[5] = 127;
memcpy(olddata, data, JOYSTICK_STATE_SIZE);
sendState(1);
}
void updateState() {
if (type != 0x73 && type != 0x53) {
data[2] = 127;
data[3] = 127;
data[4] = 127;
data[5] = 127;
}
if (type == 0x41 || type == 0x73 || type == 0x53) {
if (memcmp(olddata, data, JOYSTICK_STATE_SIZE)) {
memcpy(olddata, data, JOYSTICK_STATE_SIZE);
flag = 1;
}
}
//sendState();
}
void sendState(uint8_t force = 0) {
if (flag || force) {
// HID().SendReport(Report number, array of values in same order as HID descriptor, length)
HID().SendReport(reportId, data, JOYSTICK_STATE_SIZE);
flag = 0;
}
}
};
Joystick_ Joystick[4] =
{
Joystick_(0, JOYSTICK_REPORT_ID),
Joystick_(1, JOYSTICK2_REPORT_ID),
Joystick_(2, JOYSTICK3_REPORT_ID),
Joystick_(3, JOYSTICK4_REPORT_ID)
};*/
uint8_t shift(uint8_t _dataOut) // Does the actual shifting, both in and out simultaneously
{
uint8_t _temp = 0;
uint8_t _dataIn = 0;
uint8_t _delay = 6; //2 unstable; //clock 250kHz
delayMicroseconds(100); //max acknowledge waiting time 100us
for (uint8_t _i = 0; _i <= 7; _i++) {
if ( _dataOut & (1 << _i) ) // write bit
digitalWrite(CMD1, HIGH);
else
digitalWrite(CMD1, LOW);
digitalWrite(CLK1, LOW); // read bit
delayMicroseconds(_delay);
_temp = digitalRead(DATA1);
if (_temp) {
_dataIn = _dataIn | (B00000001 << _i);
}
digitalWrite(CLK1, HIGH);
delayMicroseconds(_delay);
}
return _dataIn;
}
void setup() {
pinMode(DATA1, INPUT_PULLUP);
pinMode(CMD1, OUTPUT);
pinMode(ATT1, OUTPUT);
pinMode(CLK1, OUTPUT);
#ifdef DEBUG
Serial.begin(115200);
while(!Serial);
#endif
#ifdef XINPUT
XInput.begin();
#endif
olddata[0] = 0xff;
olddata[1] = 0xff;
}
void loop() {
// http://problemkaputt.de/psx-spx.htm#controllerandmemorycardsignals
// first: read gamepad normally
digitalWrite(ATT1, LOW);
//digitalWrite(ATT2, LOW);
head = shift(0x01);
type = shift(0x42);
padding = shift(0x01); //read multitap in next command
data[0] = ~shift(0x00); //buttons
data[1] = ~shift(0x00); //buttons
data[2] = shift(0x00); //right analog
data[3] = shift(0x00); //right analog
data[4] = shift(0x00); //left analog
data[5] = shift(0x00); //left analog
digitalWrite(ATT1, HIGH);
#ifdef DEBUG
Serial.print(" type: 0x"); Serial.print(type, HEX);
Serial.print(" data: b"); Serial.print(data[0], BIN);
Serial.print(" b"); Serial.print(data[1], BIN);
Serial.print(" 0x"); Serial.print(data[2], HEX);
Serial.print(" 0x"); Serial.print(data[3], HEX);
Serial.print(" 0x"); Serial.print(data[4], HEX);
Serial.print(" 0x"); Serial.print(data[5], HEX);
Serial.println();
Serial.flush();
delay(500);
#endif
#ifdef XINPUT
if (data[0] != olddata[0]) {
if (PS_select) XInput.press(BUTTON_BACK); else XInput.release(BUTTON_BACK); //7
if (PS_start) XInput.press(BUTTON_START); else XInput.release(BUTTON_START); //8
if (PS_L3) XInput.press(BUTTON_L3); else XInput.release(BUTTON_L3); //9
if (PS_R3) XInput.press(BUTTON_R3); else XInput.release(BUTTON_R3); //10
XInput.setDpad(PS_up, PS_down, PS_left, PS_right);
olddata[0] = data[0];
}
if (data[1] != olddata[1]) {
if (PS_X) XInput.press(BUTTON_A); else XInput.release(BUTTON_A); //1
if (PS_O) XInput.press(BUTTON_B); else XInput.release(BUTTON_B); //2
if (PS_S) XInput.press(BUTTON_X); else XInput.release(BUTTON_X); //3
if (PS_T) XInput.press(BUTTON_Y); else XInput.release(BUTTON_Y); //4
if (PS_L1) XInput.press(BUTTON_LB); else XInput.release(BUTTON_LB); //5
if (PS_R1) XInput.press(BUTTON_RB); else XInput.release(BUTTON_RB); //6
if (PS_L2) XInput.setTrigger(TRIGGER_LEFT, 255); else XInput.setTrigger(TRIGGER_LEFT, 0);
if (PS_R2) XInput.setTrigger(TRIGGER_RIGHT, 255); else XInput.setTrigger(TRIGGER_RIGHT, 0);
olddata[1] = data[1];
}
XInput.setJoystick(JOY_LEFT, PS_LX, PS_LY); //left-right: -32768..32767, down-up: 32767..-32768
XInput.setJoystick(JOY_RIGHT, PS_RX, PS_RY); //left-right: -32768..32767, down-up: 32767..-32768
#endif
delayMicroseconds(1000);
}