You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
286 lines
8.2 KiB
286 lines
8.2 KiB
|
|
// 5V (red) |
|
// GND (black) |
|
#define DATA1 2 // (brown) |
|
#define CMD1 3 // (orange) |
|
#define ATT1 4 // (yellow) |
|
#define CLK1 5 // (blue) |
|
|
|
/*#define DATA2 6 |
|
#define CMD2 7 |
|
#define ATT2 8 |
|
#define CLK2 9 */ |
|
|
|
|
|
#include "HID.h" |
|
|
|
#if ARDUINO < 10606 |
|
#error The Joystick2 library requires Arduino IDE 1.6.6 or greater. Please update your IDE. |
|
#endif |
|
|
|
#if !defined(USBCON) |
|
#error The Joystick2 library can only be used with a USB MCU (e.g. Arduino Leonardo, Arduino Micro, etc.). |
|
#endif |
|
|
|
#if !defined(_USING_HID) |
|
#error "legacy HID core (non pluggable)" |
|
#endif |
|
|
|
#define JOYSTICK_REPORT_ID 0x03 |
|
#define JOYSTICK2_REPORT_ID 0x04 |
|
#define JOYSTICK3_REPORT_ID 0x05 |
|
#define JOYSTICK4_REPORT_ID 0x06 |
|
|
|
#define JOYSTICK_STATE_SIZE 6 |
|
|
|
//#define DEBUG |
|
|
|
//================================================================================ |
|
//================================================================================ |
|
// Joystick (Gamepad) |
|
|
|
|
|
#define HIDDESC_MACRO(REPORT_ID) \ |
|
/* Joystick # */ \ |
|
0x05, 0x01, /* USAGE_PAGE (Generic Desktop) */ \ |
|
0x09, 0x04, /* USAGE (Joystick) */ \ |
|
0xa1, 0x01, /* COLLECTION (Application) */ \ |
|
0x85, REPORT_ID, /* REPORT_ID */ \ |
|
/* 16 Buttons */ \ |
|
0x05, 0x09, /* USAGE_PAGE (Button) */ \ |
|
0x19, 0x01, /* USAGE_MINIMUM (Button 1) */ \ |
|
0x29, 0x10, /* USAGE_MAXIMUM (Button 16) */ \ |
|
0x15, 0x00, /* LOGICAL_MINIMUM (0) */ \ |
|
0x25, 0x01, /* LOGICAL_MAXIMUM (1) */ \ |
|
0x75, 0x01, /* REPORT_SIZE (1) */ \ |
|
0x95, 0x10, /* REPORT_COUNT (16) */ \ |
|
0x55, 0x00, /* UNIT_EXPONENT (0) */ \ |
|
0x65, 0x00, /* UNIT (None) */ \ |
|
0x81, 0x02, /* INPUT (Data,Var,Abs) */ \ |
|
/* X and Y Axis */ \ |
|
0x05, 0x01, /* USAGE_PAGE (Generic Desktop) */ \ |
|
0x09, 0x01, /* USAGE (Pointer) */ \ |
|
0xA1, 0x00, /* COLLECTION (Physical) */ \ |
|
0x09, 0x32, /* USAGE (Z) */ \ |
|
0x09, 0x35, /* USAGE (Rz) */ \ |
|
0x09, 0x30, /* USAGE (x) */ \ |
|
0x09, 0x31, /* USAGE (y) */ \ |
|
0x15, 0x00, /* LOGICAL_MINIMUM (0) */ \ |
|
0x26, 0xff, 0x00, /* LOGICAL_MAXIMUM (255) */ \ |
|
0x75, 0x08, /* REPORT_SIZE (8) */ \ |
|
0x95, 0x04, /* REPORT_COUNT (4) */ \ |
|
0x81, 0x02, /* INPUT (Data,Var,Abs) */ \ |
|
0xc0, /* END_COLLECTION */ \ |
|
0xc0 /* END_COLLECTION */ |
|
|
|
|
|
|
|
|
|
static const uint8_t hidReportDescriptor[] PROGMEM = { |
|
HIDDESC_MACRO(JOYSTICK_REPORT_ID), |
|
HIDDESC_MACRO(JOYSTICK2_REPORT_ID), |
|
HIDDESC_MACRO(JOYSTICK3_REPORT_ID), |
|
HIDDESC_MACRO(JOYSTICK4_REPORT_ID) |
|
}; |
|
|
|
|
|
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); |
|
|
|
/*pinMode(DATA2, INPUT_PULLUP); |
|
pinMode(CMD2, OUTPUT); |
|
pinMode(ATT2, OUTPUT); |
|
pinMode(CLK2, OUTPUT);*/ |
|
|
|
#ifdef DEBUG |
|
Serial.begin(115200); |
|
#endif |
|
|
|
} |
|
|
|
void loop() { |
|
// http://problemkaputt.de/psx-spx.htm#controllerandmemorycardsignals |
|
uint8_t head, padding, multitap; |
|
#ifdef DEBUG |
|
uint8_t data[100]; |
|
#endif |
|
|
|
// first: read gamepad normally |
|
digitalWrite(ATT1, LOW); |
|
//digitalWrite(ATT2, LOW); |
|
head = shift(0x01); |
|
Joystick[0].type = shift(0x42); |
|
padding = shift(0x01); //read multitap in next command |
|
Joystick[0].data[0] = ~shift(0x00); //buttons |
|
Joystick[0].data[1] = ~shift(0x00); //buttons |
|
Joystick[0].data[2] = shift(0x00); //right analog |
|
Joystick[0].data[3] = shift(0x00); //right analog |
|
Joystick[0].data[4] = shift(0x00); //left analog |
|
Joystick[0].data[5] = shift(0x00); //left analog |
|
digitalWrite(ATT1, HIGH); |
|
//digitalWrite(ATT2, HIGH); |
|
|
|
//delay(100); |
|
|
|
// second: check and read multitap |
|
digitalWrite(ATT1, LOW); |
|
head = shift(0x01); |
|
multitap = shift(0x42); |
|
padding = shift(0x00); //next time normal read |
|
if (multitap == 0x80) { |
|
for (uint8_t i = 0; i < 4; i++) { |
|
Joystick[i].type = shift(0x00); |
|
padding = shift(0x00); |
|
Joystick[i].data[0] = ~shift(0x00); //buttons |
|
Joystick[i].data[1] = ~shift(0x00); //buttons |
|
Joystick[i].data[2] = shift(0x00); //right analog |
|
Joystick[i].data[3] = shift(0x00); //right analog |
|
Joystick[i].data[4] = shift(0x00); //left analog |
|
Joystick[i].data[5] = shift(0x00); //left analog |
|
} |
|
} |
|
digitalWrite(ATT1, HIGH); |
|
|
|
#ifdef DEBUG |
|
for (uint8_t i = 0; i < 4; i++) { |
|
Serial.print(" multitap: "); Serial.println(multitap, HEX); |
|
Serial.print(" type: 0x"); Serial.print(Joystick[i].type, HEX); |
|
Serial.print(" data: 0x"); Serial.print(Joystick[i].data[0], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[i].data[1], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[i].data[2], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[i].data[3], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[i].data[4], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[i].data[5], HEX); |
|
Serial.println(); |
|
} |
|
/*Serial.print(" type: 0x"); Serial.print(Joystick[0].type, HEX); |
|
Serial.print(" data: 0x"); Serial.print(Joystick[0].data[0], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[0].data[1], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[0].data[2], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[0].data[3], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[0].data[4], HEX); |
|
Serial.print(" 0x"); Serial.print(Joystick[0].data[5], HEX); |
|
Serial.println();*/ |
|
Serial.flush(); |
|
#endif |
|
|
|
Joystick[0].updateState(); |
|
Joystick[1].updateState(); |
|
Joystick[2].updateState(); |
|
Joystick[3].updateState(); |
|
Joystick[0].sendState(); |
|
Joystick[1].sendState(); |
|
Joystick[2].sendState(); |
|
Joystick[3].sendState(); |
|
delayMicroseconds(1000); |
|
|
|
|
|
}
|
|
|