mirror of
https://github.com/mcgurk/Arduino-USB-HID-RetroJoystickAdapter
synced 2024-11-11 03:35:11 -05:00
166 lines
3.7 KiB
C++
166 lines
3.7 KiB
C++
#include "Joystick.h"
|
|
|
|
|
|
#define DATA 2
|
|
#define CMD 3
|
|
#define ATT 4
|
|
#define CLK 5
|
|
|
|
|
|
//#define DEBUG
|
|
|
|
byte shift(byte dataOut, uint8_t readmode = 0) { // Does the actual shifting, both in and out
|
|
boolean temp = 0;
|
|
byte dataIn = 0;
|
|
byte delay = 10;
|
|
for (uint8_t i = 0; i <= 7; i++) {
|
|
if ( dataOut & (1 << i) ) {
|
|
digitalWrite(CMD, HIGH); // Writes out the _dataOut bits
|
|
} else {
|
|
digitalWrite(CMD, LOW);
|
|
}
|
|
digitalWrite(CLK, LOW);
|
|
delayMicroseconds(delay);
|
|
temp = digitalRead(DATA); // Reads the data pin
|
|
if (temp) dataIn = dataIn | (B00000001 << i);
|
|
digitalWrite(CLK, HIGH);
|
|
delayMicroseconds(delay);
|
|
}
|
|
return dataIn;
|
|
}
|
|
|
|
uint8_t type;
|
|
uint8_t ready;
|
|
uint8_t btngrp1;
|
|
uint8_t btngrp2;
|
|
uint8_t analog1;
|
|
uint8_t analog2;
|
|
uint8_t analog3;
|
|
uint8_t analog4;
|
|
|
|
void debug() {
|
|
Serial.print("d1: ");
|
|
Serial.print(type,HEX);
|
|
Serial.print(", ");
|
|
Serial.print("d2: ");
|
|
Serial.print(ready,HEX);
|
|
Serial.print(", ");
|
|
Serial.print("d3: ");
|
|
Serial.print(btngrp1,HEX);
|
|
Serial.print(", ");
|
|
Serial.print("d4: ");
|
|
Serial.print(btngrp2,HEX);
|
|
Serial.print(", ");
|
|
Serial.print("d5: ");
|
|
Serial.print(analog1,HEX);
|
|
Serial.print(", ");
|
|
Serial.print("d6: ");
|
|
Serial.print(analog2,HEX);
|
|
Serial.print(", ");
|
|
Serial.print("d7: ");
|
|
Serial.print(analog3,HEX);
|
|
Serial.print(", ");
|
|
Serial.print("d8: ");
|
|
Serial.println(analog4,HEX);
|
|
}
|
|
|
|
void readJoysticks() {
|
|
|
|
digitalWrite(ATT, LOW);
|
|
shift(0x01);
|
|
type = shift(0x42); //type (0x41 / 0x73)
|
|
ready = shift(0xFF); //ready (0x5a)
|
|
btngrp1 = shift(0xFF);
|
|
btngrp2 = shift(0xFF);
|
|
analog1 = shift(0xFF);
|
|
analog2 = shift(0xFF);
|
|
analog3 = shift(0xFF);
|
|
analog4 = shift(0xFF);
|
|
digitalWrite(ATT, HIGH);
|
|
|
|
delayMicroseconds(1000);
|
|
#ifdef DEBUG
|
|
debug();
|
|
delay(100);
|
|
#endif
|
|
}
|
|
|
|
//btngrp1
|
|
#define LEFT 0x80
|
|
#define DOWN 0x40
|
|
#define RIGHT 0x20
|
|
#define UP 0x10
|
|
#define START 0x08
|
|
#define JOYR 0x04
|
|
#define JOYL 0x02
|
|
#define SELECT 0x01
|
|
|
|
//btngrp2
|
|
#define SQUARE 0x80
|
|
#define X 0x40
|
|
#define O 0x20
|
|
#define TRIANGLE 0x10
|
|
#define R1 0x08
|
|
#define L1 0x04
|
|
#define R2 0x02
|
|
#define L2 0x01
|
|
|
|
void interpretJoystickState() {
|
|
//Joystick.setYAxis(0);
|
|
//Joystick.setXAxis(0);
|
|
|
|
Joystick.setXAxis( ((signed int)analog3)-127 );
|
|
Joystick.setYAxis( ((signed int)analog4)-127 );
|
|
Joystick.setXAxisRotation( (analog1*1.4) );
|
|
Joystick.setYAxisRotation( (255-analog2)*1.4 );
|
|
Joystick.setButton(0, !(btngrp1&START) ); //BUTTON1 (Start)
|
|
Joystick.setButton(1, !(btngrp1&SELECT) ); //BUTTON2 (Select)
|
|
Joystick.setButton(2, !(btngrp2&X) ); //BUTTON3 (A)
|
|
Joystick.setButton(3, !(btngrp2&O) ); //BUTTON4 (B)
|
|
Joystick.setButton(4, !(btngrp2&SQUARE) ); //BUTTON5 (X)
|
|
Joystick.setButton(5, !(btngrp2&TRIANGLE) ); //BUTTON6 (Y)
|
|
Joystick.setButton(6, !(btngrp2&L2) ); //BUTTON7 (LB)
|
|
Joystick.setButton(7, !(btngrp2&R2) ); //BUTTON8 (RB)
|
|
Joystick.setButton(8, !(btngrp2&L1) ); //BUTTON9 (LT)
|
|
Joystick.setButton(9, !(btngrp2&R1) ); //BUTTON10 (RT)
|
|
Joystick.setButton(10, !(btngrp1&JOYL) ); //BUTTON11 (Left Thumb)
|
|
Joystick.setButton(11, !(btngrp1&JOYR) ); //BUTTON12 (Right Thumb)
|
|
|
|
Joystick.setHatSwitch(0,-1);
|
|
if ( !(btngrp1&UP) ) Joystick.setHatSwitch(0,0); //UP
|
|
if ( !(btngrp1&DOWN) ) Joystick.setHatSwitch(0,180); //DOWN
|
|
if ( !(btngrp1&LEFT) ) Joystick.setHatSwitch(0,270); //LEFT
|
|
if ( !(btngrp1&RIGHT) ) Joystick.setHatSwitch(0,90); //RIGHT
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void setup() {
|
|
|
|
pinMode(DATA, INPUT_PULLUP);
|
|
pinMode(CMD, OUTPUT);
|
|
pinMode(ATT, OUTPUT);
|
|
pinMode(CLK, OUTPUT);
|
|
|
|
Joystick.begin(false);
|
|
|
|
#ifdef DEBUG
|
|
Serial.begin(9600);
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void loop() {
|
|
|
|
readJoysticks();
|
|
interpretJoystickState();
|
|
Joystick.sendState();
|
|
|
|
}
|