#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 "Using 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 DEBUG //================================================================================ //================================================================================ // Joystick (Gamepad) class Joystick_ { private: uint8_t joystickId; uint8_t reportId; public: Joystick_(uint8_t initJoystickId, uint8_t initReportId); void sendState(); int8_t xAxis; int8_t yAxis; int8_t xAxis2; int8_t yAxis2; uint16_t buttons; //void begin(bool initAutoSendState = true); //void end(); //void setXAxis(int8_t value); //void setYAxis(int8_t value); //void setButton(uint8_t button, uint8_t value); //void pressButton(uint8_t button); //void releaseButton(uint8_t button); }; #define JOYSTICK_STATE_SIZE 6 #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) */ \ 0x25, 0xff, /* 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) }; Joystick_::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; xAxis = 127; yAxis = 127; xAxis2 = 127; yAxis2 = 127; buttons = 0; sendState(); } void Joystick_::sendState() { int8_t data[JOYSTICK_STATE_SIZE]; uint16_t buttonTmp = buttons; // Split 16 bit button-state into 2 bytes data[0] = buttonTmp & 0xFF; buttonTmp >>= 8; data[1] = buttonTmp & 0xFF; data[2] = xAxis; data[3] = yAxis; data[4] = xAxis2; data[5] = yAxis2; //data[2] = 127;//xAxis; //data[3] = 127;//yAxis; // HID().SendReport(Report number, array of values in same order as HID descriptor, length) HID().SendReport(reportId, data, JOYSTICK_STATE_SIZE); } Joystick_ Joystick[4] = //Joystick_ Joystick[3] = //Joystick_ Joystick[2] = { Joystick_(0, JOYSTICK_REPORT_ID), Joystick_(1, JOYSTICK2_REPORT_ID), Joystick_(2, JOYSTICK3_REPORT_ID), Joystick_(3, JOYSTICK4_REPORT_ID) }; //================================================================================ //================================================================================ #define DATA1 2 #define CMD1 3 #define ATT1 4 #define CLK1 5 /*#define DATA2 6 #define CMD2 7 #define ATT2 8 #define CLK2 9 */ 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 = 25;//25;//20; //10; //4; //10; //with 15 unstable. meni epävakaaks 20:lläkin... //testaa kunnon kaapelilla uudestaan 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, type, padding, multitap, data1, data2, data3, data4, data5, data6; uint8_t data[100]; delayMicroseconds(20); digitalWrite(ATT1, LOW); //digitalWrite(ATT2, LOW); delayMicroseconds(50); head = shift(0x01); type = shift(0x42); padding = shift(0x01); //read multitap in next read data1 = shift(0x00); //read data2 = shift(0x00); data3 = shift(0x00); data4 = shift(0x00); data5 = shift(0x00); data6 = shift(0x00); digitalWrite(ATT1, HIGH); //digitalWrite(ATT2, HIGH); Joystick[0].buttons = ~( (data1) | (data2 << 8) ); //delayMicroseconds(160); //delay(16); #ifdef DEBUG /*Serial.print("head: 0x"); Serial.print(head, HEX); Serial.print(" type: 0x"); Serial.print(type, HEX); Serial.print(" padding: 0x"); Serial.print(padding, HEX); Serial.print(" data1: 0x"); Serial.print(data1, HEX); Serial.print(" "), Serial.print(data1, BIN); Serial.print(" data2: 0x"); Serial.print(data2, HEX); Serial.print(" "), Serial.print(data2, BIN); Serial.print(" rest: "); Serial.print(data3, DEC); Serial.print(" "); Serial.print(data4, DEC); Serial.print(" "); Serial.print(data5, DEC); Serial.print(" "); Serial.print(data6, DEC); Serial.println();*/ #endif // check and read multitap delayMicroseconds(20); digitalWrite(ATT1, LOW); delayMicroseconds(50); head = shift(0x01); multitap = shift(0x42); padding = shift(0x00); //next time normal read //padding = shift(0x01); //padding = shift(0x01); if (multitap == 0x80) { for (uint8_t i = 0; i < 4; i++) { //for (uint8_t i = 0; i < 2; i++) { type = shift(0x00); //controller ID padding = shift(0x00); //controller ID //type = shift(0x00); //controller ID //padding = shift(0x00); //controller ID data1 = shift(0x00); //buttons data2 = shift(0x00); //buttons data3 = shift(0x00); //right analog data4 = shift(0x00); //right analog data5 = shift(0x00); //left analog data6 = shift(0x00); //left analog if (type != 0x41) { Joystick[i].xAxis = data3; Joystick[i].yAxis = data4; Joystick[i].xAxis2 = data5; Joystick[i].yAxis2 = data6; } else { Joystick[i].xAxis = 127;//0; Joystick[i].yAxis = 127;//0; Joystick[i].xAxis2 = 127;//0; Joystick[i].yAxis2 = 127;//0; } /* if (!bitRead(data1,4)) Joystick[i].yAxis2 = 0; if (!bitRead(data1,5)) Joystick[i].xAxis2 = 255; if (!bitRead(data1,6)) Joystick[i].yAxis2 = 255; if (!bitRead(data1,7)) Joystick[i].xAxis2 = 0; data1 = data1 | B11110000; }*/ Joystick[i].buttons = ~( (data1) | (data2 << 8) ); } } /*for (uint8_t i = 0; i < 8*4; i++) { data[i] = shift(0x00); }*/ digitalWrite(ATT1, HIGH); #ifdef DEBUG /*Serial.print(" head/type/padding: 0x"); Serial.print(head, HEX); Serial.print(" 0x"); Serial.print(type, HEX); Serial.print(" 0x"); Serial.print(padding, HEX); Serial.print(" - "); for (uint8_t i = 0; i < 8*4; i++) { Serial.print(data[i], HEX); Serial.print(" "); }*/ Serial.print(" data: 0x"); Serial.print(data1, HEX); Serial.print(" 0x"); Serial.print(data2, HEX); Serial.print(" 0x"); Serial.print(data3, HEX); Serial.print(" 0x"); Serial.print(data4, HEX); Serial.print(" 0x"); Serial.print(data5, HEX); Serial.print(" 0x"); Serial.print(data6, HEX); //Serial.print(" 0x"); Serial.print(data7, HEX); //Serial.print(" 0x"); Serial.print(data8, HEX); /*Serial.print("--head: 0x"); Serial.print(head, HEX); Serial.print(" type: 0x"); Serial.print(type, HEX); Serial.print(" padding: 0x"); Serial.print(padding, HEX); Serial.print(" data1: 0x"); Serial.print(data1, HEX); Serial.print(" "), Serial.print(data1, BIN); Serial.print(" data2: 0x"); Serial.print(data2, HEX); Serial.print(" "), Serial.print(data2, BIN); Serial.print(" rest: "); Serial.print(data3, DEC); Serial.print(" "); Serial.print(data4, DEC); Serial.print(" "); Serial.print(data5, DEC); Serial.print(" "); Serial.print(data6, DEC);*/ Serial.println(); Serial.flush(); //Serial.print(" type2: "); Serial.print(type, HEX); //Serial.println(); #endif //delayMicroseconds(50); Joystick[0].sendState(); Joystick[1].sendState(); Joystick[2].sendState(); Joystick[3].sendState(); delay(50);}