Add PSX JogCon USB adapter.
This commit is contained in:
sorgelig
parent
e86d17dc30
commit
5ba9e53288
|
|
@ -0,0 +1,174 @@
|
|||
/* Gamepad.cpp
|
||||
*
|
||||
* Based on the advanced HID library for Arduino:
|
||||
* https://github.com/NicoHood/HID
|
||||
* Copyright (c) 2014-2015 NicoHood
|
||||
*
|
||||
* Copyright (c) 2020 Mikael Norrgård <http://daemonbite.com>
|
||||
*
|
||||
* GNU GENERAL PUBLIC LICENSE
|
||||
* Version 3, 29 June 2007
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
||||
*
|
||||
*/
|
||||
|
||||
#include "Gamepad.h"
|
||||
|
||||
static const uint8_t _hidReportDescriptor[] PROGMEM = {
|
||||
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
||||
0x09, 0x04, // USAGE (Joystick) (Maybe change to gamepad? I don't think so but...)
|
||||
0xa1, 0x01, // COLLECTION (Application)
|
||||
0xa1, 0x00, // COLLECTION (Physical)
|
||||
|
||||
0x05, 0x09, // USAGE_PAGE (Button)
|
||||
0x19, 0x01, // USAGE_MINIMUM (Button 1)
|
||||
0x29, 0x0C, // USAGE_MAXIMUM (Button 12)
|
||||
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
||||
0x25, 0x01, // LOGICAL_MAXIMUM (1)
|
||||
0x95, 0x10, // REPORT_COUNT (16)
|
||||
0x75, 0x01, // REPORT_SIZE (1)
|
||||
0x81, 0x02, // INPUT (Data,Var,Abs)
|
||||
|
||||
0x05, 0x01, // USAGE_PAGE (Generic Desktop)
|
||||
0x09, 0x01, // USAGE (pointer)
|
||||
0xa1, 0x00, // COLLECTION (Physical)
|
||||
0x09, 0x30, // USAGE (X)
|
||||
0x09, 0x31, // USAGE (Y)
|
||||
0x15, 0x80, // LOGICAL_MINIMUM (-128)
|
||||
0x25, 0x7F, // LOGICAL_MAXIMUM (127)
|
||||
0x95, 0x02, // REPORT_COUNT (2)
|
||||
0x75, 0x08, // REPORT_SIZE (8)
|
||||
0x81, 0x02, // INPUT (Data,Var,Abs)
|
||||
0xc0, // END_COLLECTION
|
||||
0xa1, 0x00, // COLLECTION (Physical)
|
||||
0x09, 0x37, // USAGE (Dial)
|
||||
0x15, 0x00, // LOGICAL_MINIMUM (0)
|
||||
0x26, 0xFF, 0x00, // LOGICAL_MAXIMUM (255)
|
||||
0x95, 0x01, // REPORT_COUNT (1)
|
||||
0x75, 0x08, // REPORT_SIZE (8)
|
||||
0x81, 0x02, // INPUT (Data,Var,Abs)
|
||||
0xc0, // END_COLLECTION
|
||||
|
||||
0x15, 0x00, // Logical Minimum (0)
|
||||
0x25, 0x07, // Logical Maximum (7)
|
||||
0x35, 0x00, // Physical Minimum (0)
|
||||
0x46, 0x3B, 0x01, // Physical Maximum (315)
|
||||
0x75, 0x08, // Report Size (8)
|
||||
0x95, 0x01, // Report Count (1)
|
||||
0x65, 0x14, // Unit (20)
|
||||
0x05, 0x01, // Usage Page (Generic Desktop)
|
||||
0x09, 0x39, // Usage (Hat switch)
|
||||
0x81, 0x42, // Input (variable,absolute,null_state)
|
||||
|
||||
0xc0, // END_COLLECTION
|
||||
0xc0, // END_COLLECTION
|
||||
};
|
||||
|
||||
Gamepad_::Gamepad_(void) : PluggableUSBModule(1, 1, epType), protocol(HID_REPORT_PROTOCOL), idle(1)
|
||||
{
|
||||
epType[0] = EP_TYPE_INTERRUPT_IN;
|
||||
PluggableUSB().plug(this);
|
||||
}
|
||||
|
||||
int Gamepad_::getInterface(uint8_t* interfaceCount)
|
||||
{
|
||||
*interfaceCount += 1; // uses 1
|
||||
HIDDescriptor hidInterface = {
|
||||
D_INTERFACE(pluggedInterface, 1, USB_DEVICE_CLASS_HUMAN_INTERFACE, HID_SUBCLASS_NONE, HID_PROTOCOL_NONE),
|
||||
D_HIDREPORT(sizeof(_hidReportDescriptor)),
|
||||
D_ENDPOINT(USB_ENDPOINT_IN(pluggedEndpoint), USB_ENDPOINT_TYPE_INTERRUPT, USB_EP_SIZE, 0x01)
|
||||
};
|
||||
return USB_SendControl(0, &hidInterface, sizeof(hidInterface));
|
||||
}
|
||||
|
||||
int Gamepad_::getDescriptor(USBSetup& setup)
|
||||
{
|
||||
// Check if this is a HID Class Descriptor request
|
||||
if (setup.bmRequestType != REQUEST_DEVICETOHOST_STANDARD_INTERFACE) { return 0; }
|
||||
if (setup.wValueH != HID_REPORT_DESCRIPTOR_TYPE) { return 0; }
|
||||
|
||||
// In a HID Class Descriptor wIndex cointains the interface number
|
||||
if (setup.wIndex != pluggedInterface) { return 0; }
|
||||
|
||||
// Reset the protocol on reenumeration. Normally the host should not assume the state of the protocol
|
||||
// due to the USB specs, but Windows and Linux just assumes its in report mode.
|
||||
protocol = HID_REPORT_PROTOCOL;
|
||||
|
||||
return USB_SendControl(TRANSFER_PGM, _hidReportDescriptor, sizeof(_hidReportDescriptor));
|
||||
}
|
||||
|
||||
bool Gamepad_::setup(USBSetup& setup)
|
||||
{
|
||||
if (pluggedInterface != setup.wIndex) {
|
||||
return false;
|
||||
}
|
||||
|
||||
uint8_t request = setup.bRequest;
|
||||
uint8_t requestType = setup.bmRequestType;
|
||||
|
||||
if (requestType == REQUEST_DEVICETOHOST_CLASS_INTERFACE)
|
||||
{
|
||||
if (request == HID_GET_REPORT) {
|
||||
// TODO: HID_GetReport();
|
||||
return true;
|
||||
}
|
||||
if (request == HID_GET_PROTOCOL) {
|
||||
// TODO: Send8(protocol);
|
||||
return true;
|
||||
}
|
||||
}
|
||||
|
||||
if (requestType == REQUEST_HOSTTODEVICE_CLASS_INTERFACE)
|
||||
{
|
||||
if (request == HID_SET_PROTOCOL) {
|
||||
protocol = setup.wValueL;
|
||||
return true;
|
||||
}
|
||||
if (request == HID_SET_IDLE) {
|
||||
idle = setup.wValueL;
|
||||
return true;
|
||||
}
|
||||
if (request == HID_SET_REPORT)
|
||||
{
|
||||
}
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
void Gamepad_::reset()
|
||||
{
|
||||
_GamepadReport.X = 0;
|
||||
_GamepadReport.Y = 0;
|
||||
_GamepadReport.dial = 0;
|
||||
_GamepadReport.hat = 15;
|
||||
_GamepadReport.buttons = 0;
|
||||
this->send();
|
||||
}
|
||||
|
||||
void Gamepad_::send()
|
||||
{
|
||||
USB_Send(pluggedEndpoint | TRANSFER_RELEASE, &_GamepadReport, sizeof(GamepadReport));
|
||||
}
|
||||
|
||||
uint8_t Gamepad_::getShortName(char *name)
|
||||
{
|
||||
if(!next)
|
||||
{
|
||||
strcpy(name, gp_serial);
|
||||
return strlen(name);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -0,0 +1,88 @@
|
|||
/* Gamepad.h
|
||||
*
|
||||
* Based on the advanced HID library for Arduino:
|
||||
* https://github.com/NicoHood/HID
|
||||
* Copyright (c) 2014-2015 NicoHood
|
||||
*
|
||||
* Copyright (c) 2020 Mikael Norrgård <http://daemonbite.com>
|
||||
*
|
||||
* GNU GENERAL PUBLIC LICENSE
|
||||
* Version 3, 29 June 2007
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
||||
*
|
||||
*/
|
||||
|
||||
#pragma once
|
||||
|
||||
#include <Arduino.h>
|
||||
#include "HID.h"
|
||||
|
||||
extern const char* gp_serial;
|
||||
|
||||
// The numbers after colon are bit fields, meaning how many bits the field uses.
|
||||
// Remove those if there are problems
|
||||
typedef struct {
|
||||
union
|
||||
{
|
||||
struct {
|
||||
bool b0: 1;
|
||||
bool b1: 1;
|
||||
bool b2: 1;
|
||||
bool b3: 1;
|
||||
bool b4: 1;
|
||||
bool b5: 1;
|
||||
bool b6: 1;
|
||||
bool b7: 1;
|
||||
bool b8: 1;
|
||||
bool b9: 1;
|
||||
bool b10: 1;
|
||||
bool b11: 1;
|
||||
bool b12: 1;
|
||||
bool b13: 1;
|
||||
bool b14: 1;
|
||||
bool b15: 1;
|
||||
};
|
||||
uint16_t buttons;
|
||||
};
|
||||
|
||||
int8_t X;
|
||||
int8_t Y;
|
||||
int8_t dial;
|
||||
uint8_t hat;
|
||||
|
||||
} GamepadReport;
|
||||
|
||||
|
||||
class Gamepad_ : public PluggableUSBModule
|
||||
{
|
||||
private:
|
||||
uint8_t reportId;
|
||||
|
||||
protected:
|
||||
int getInterface(uint8_t* interfaceCount);
|
||||
int getDescriptor(USBSetup& setup);
|
||||
bool setup(USBSetup& setup);
|
||||
uint8_t getShortName(char *name);
|
||||
|
||||
uint8_t epType[1];
|
||||
uint8_t protocol;
|
||||
uint8_t idle;
|
||||
|
||||
public:
|
||||
GamepadReport _GamepadReport;
|
||||
Gamepad_(void);
|
||||
void reset(void);
|
||||
void send();
|
||||
};
|
||||
|
|
@ -0,0 +1,308 @@
|
|||
/*
|
||||
* PSX JogCon based Arcade USB controller
|
||||
* (C) Alexey Melnikov
|
||||
*
|
||||
* Based on project by Mikael Norrgård <mick@daemonbite.com>
|
||||
*
|
||||
* GNU GENERAL PUBLIC LICENSE
|
||||
* Version 3, 29 June 2007
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
||||
*
|
||||
*/
|
||||
|
||||
// LOOKING AT THE PLUG
|
||||
// |-----------------------------|
|
||||
// PIN 1-> | o o o | o o o | o o o |
|
||||
// \_________|_________|_________/
|
||||
//
|
||||
//
|
||||
// Arduino Plug PCB connector
|
||||
// -----------------------------------
|
||||
// RXI(D0) 1 2 DATA
|
||||
// GND 4 3 GND
|
||||
// 3.3V 5 4 3.3V (main)
|
||||
// D4 6 5 ATT
|
||||
// TXO(D1) 2 6 COMMAND
|
||||
// D3 7 7 CLOCK
|
||||
// 5V 3 8 5V (motor)
|
||||
//
|
||||
|
||||
////////////////////////////////////////////////////////
|
||||
|
||||
#define CMD 1
|
||||
#define DAT 0
|
||||
#define CLK 3
|
||||
#define ATT 4
|
||||
|
||||
#define DELAY 4
|
||||
#define SP_MAX 160
|
||||
|
||||
////////////////////////////////////////////////////////
|
||||
|
||||
// ID for special support in MiSTer
|
||||
// ATT: 20 chars max (including NULL at the end) according to Arduino source code.
|
||||
// Additionally serial number is used to differentiate arduino projects to have different button maps!
|
||||
const char *gp_serial = "MiSTer-A1 JogCon";
|
||||
|
||||
#include <EEPROM.h>
|
||||
#include "Gamepad.h"
|
||||
|
||||
Gamepad_ Gamepad;
|
||||
|
||||
byte ff = 0;
|
||||
byte mode = 0;
|
||||
byte force = 15;
|
||||
int16_t sp_step = 4;
|
||||
byte data[8];
|
||||
|
||||
const byte cmd_read[] = {0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
|
||||
const byte cmd_cfg_enter[] = {0x43, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00};
|
||||
const byte cmd_cfg_exit[] = {0x43, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
|
||||
const byte cmd_set_mode_a[] = {0x44, 0x00, 0x01, 0x02, 0x00, 0x00, 0x00};
|
||||
const byte cmd_set_mode_d[] = {0x44, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00};
|
||||
const byte cmd_get_mode[] = {0x45, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00};
|
||||
const byte cmd_unlock_ff[] = {0x4D, 0x00, 0x00, 0x01, 0xFF, 0xFF, 0xFF};
|
||||
|
||||
byte psx_io(byte out)
|
||||
{
|
||||
byte in = 0;
|
||||
|
||||
for (byte i = 0; i < 8; i++)
|
||||
{
|
||||
digitalWrite(CLK, LOW);
|
||||
digitalWrite(CMD, (out & (1 << i)) ? HIGH : LOW);
|
||||
|
||||
delayMicroseconds(DELAY);
|
||||
in = in | (digitalRead(DAT) << i);
|
||||
digitalWrite(CLK, HIGH);
|
||||
|
||||
delayMicroseconds(DELAY);
|
||||
}
|
||||
|
||||
delayMicroseconds(DELAY*2);
|
||||
return in;
|
||||
}
|
||||
|
||||
void send_cmd(const byte *cmd)
|
||||
{
|
||||
digitalWrite(ATT, LOW);
|
||||
|
||||
psx_io(0x01);
|
||||
for(int i=0; i<7; i++) data[i] = psx_io((i==2 && cmd[0] == 0x42 && ff) ? (force | 0x30) : cmd[i]);
|
||||
data[7] = psx_io(0xFF);
|
||||
|
||||
data[2] = ~data[2];
|
||||
data[3] = ~data[3];
|
||||
|
||||
digitalWrite(ATT, HIGH);
|
||||
delayMicroseconds(DELAY*10);
|
||||
}
|
||||
|
||||
void init_jogcon()
|
||||
{
|
||||
send_cmd(cmd_cfg_enter);
|
||||
send_cmd(cmd_set_mode_a);
|
||||
send_cmd(cmd_unlock_ff);
|
||||
send_cmd(cmd_read);
|
||||
send_cmd(cmd_read);
|
||||
}
|
||||
|
||||
#define UP 0x1
|
||||
#define RIGHT 0x2
|
||||
#define DOWN 0x4
|
||||
#define LEFT 0x8
|
||||
|
||||
uint8_t dpad2hat(uint8_t dpad)
|
||||
{
|
||||
switch(dpad & (UP|DOWN|LEFT|RIGHT))
|
||||
{
|
||||
case UP: return 0;
|
||||
case UP|RIGHT: return 1;
|
||||
case RIGHT: return 2;
|
||||
case DOWN|RIGHT: return 3;
|
||||
case DOWN: return 4;
|
||||
case DOWN|LEFT: return 5;
|
||||
case LEFT: return 6;
|
||||
case UP|LEFT: return 7;
|
||||
}
|
||||
return 15;
|
||||
}
|
||||
|
||||
uint8_t sp_div;
|
||||
int16_t sp_max;
|
||||
int16_t sp_half;
|
||||
|
||||
void setup()
|
||||
{
|
||||
Gamepad.reset();
|
||||
|
||||
pinMode(CLK, OUTPUT); digitalWrite(CLK, HIGH);
|
||||
pinMode(CMD, OUTPUT); digitalWrite(CMD, HIGH);
|
||||
pinMode(ATT, OUTPUT); digitalWrite(ATT, HIGH);
|
||||
pinMode(DAT, INPUT_PULLUP);
|
||||
|
||||
mode = EEPROM.read(0) & 0x3;
|
||||
if(mode == 3) mode = 0;
|
||||
|
||||
force = EEPROM.read(1) & 0xF;
|
||||
if(!force) force = 15;
|
||||
|
||||
sp_step = EEPROM.read(2);
|
||||
if(sp_step > 8) sp_step = 8;
|
||||
if(sp_step < 1) sp_step = 4;
|
||||
|
||||
sp_div = EEPROM.read(3) ? 1 : 2;
|
||||
sp_max = SP_MAX/sp_div;
|
||||
sp_half = sp_max/2;
|
||||
|
||||
init_jogcon();
|
||||
}
|
||||
|
||||
void loop()
|
||||
{
|
||||
static uint16_t counter = 0, newcnt = 0, cleancnt = 0;
|
||||
static uint16_t newbtn = 0, oldbtn = 0;
|
||||
static int32_t pdlpos = sp_half;
|
||||
static uint16_t prevcnt = 0;
|
||||
|
||||
send_cmd(cmd_read);
|
||||
if(data[0] == 0x41 || !data[1])
|
||||
{
|
||||
if(data[0] == 0xF3 && !data[1])
|
||||
{
|
||||
// Mode switch by pressing "mode" button while holding:
|
||||
// L2 - paddle mode (with FF stoppers)
|
||||
// R2 - steering mode (FF always enabled)
|
||||
// L2+R2 - spinner mode (no FF)
|
||||
if(data[3]&3)
|
||||
{
|
||||
mode = data[3] & 3;
|
||||
if(mode == 3) mode = 0;
|
||||
EEPROM.write(0, mode);
|
||||
}
|
||||
|
||||
// Force Feedback adjust
|
||||
// by pressing "mode" button while holding /\,O,X,[]
|
||||
if(data[3] & 0xF0)
|
||||
{
|
||||
if(data[3] & 0x10) force = 1;
|
||||
if(data[3] & 0x20) force = 3;
|
||||
if(data[3] & 0x40) force = 7;
|
||||
if(data[3] & 0x80) force = 15;
|
||||
EEPROM.write(1, force);
|
||||
}
|
||||
|
||||
// Spinner pulses per step adjust
|
||||
// by pressing "mode" button while holding up,right,down,left
|
||||
if(data[2] & 0xF0)
|
||||
{
|
||||
if(data[2] & 0x10) sp_step = 1;
|
||||
if(data[2] & 0x20) sp_step = 2;
|
||||
if(data[2] & 0x40) sp_step = 4;
|
||||
if(data[2] & 0x80) sp_step = 8;
|
||||
EEPROM.write(2, sp_step);
|
||||
}
|
||||
}
|
||||
|
||||
// Paddle range switch by pressing "mode" button while holding:
|
||||
// L1 - 270 degree
|
||||
// R1 - 135 degree
|
||||
if(data[3]&0xC)
|
||||
{
|
||||
sp_div = (data[3] & 4) ? 2 : 1;
|
||||
sp_max = SP_MAX/sp_div;
|
||||
sp_half = sp_max/2;
|
||||
EEPROM.write(3, !(sp_div>>1));
|
||||
}
|
||||
|
||||
// some time for visual confirmation
|
||||
delay(200);
|
||||
|
||||
// reset zero position
|
||||
init_jogcon();
|
||||
|
||||
prevcnt = 0;
|
||||
cleancnt = 0;
|
||||
counter = (data[5] << 8) | data[4];
|
||||
pdlpos = sp_half;
|
||||
}
|
||||
|
||||
newcnt = (data[5] << 8) | data[4];
|
||||
newbtn = (data[3] << 8) | data[2];
|
||||
newbtn = (newbtn & ~3) | ((newbtn&1)<<2);
|
||||
|
||||
if(data[0] == 0xF3)
|
||||
{
|
||||
if(data[6]&3)
|
||||
{
|
||||
cleancnt += newcnt - counter;
|
||||
if(!mode)
|
||||
{
|
||||
ff = 0;
|
||||
pdlpos += (int16_t)(newcnt - counter);
|
||||
if(pdlpos<0) pdlpos = 0;
|
||||
if(pdlpos>sp_max) pdlpos = sp_max;
|
||||
}
|
||||
}
|
||||
|
||||
if(mode)
|
||||
{
|
||||
if(((int16_t)newcnt) < -sp_half)
|
||||
{
|
||||
pdlpos = 0;
|
||||
if(mode == 1) ff = 1;
|
||||
}
|
||||
else if(((int16_t)newcnt) > sp_half)
|
||||
{
|
||||
pdlpos = sp_max;
|
||||
if(mode == 1) ff = 1;
|
||||
}
|
||||
else
|
||||
{
|
||||
if(mode == 1) ff = 0;
|
||||
pdlpos = (uint16_t)(newcnt + sp_half);
|
||||
}
|
||||
}
|
||||
|
||||
if(mode == 2) ff = 1;
|
||||
|
||||
if(!(Gamepad._GamepadReport.buttons&3))
|
||||
{
|
||||
int16_t diff = cleancnt - prevcnt;
|
||||
if(diff >= sp_step)
|
||||
{
|
||||
newbtn |= 2;
|
||||
prevcnt += sp_step;
|
||||
}
|
||||
else if(diff <= -sp_step)
|
||||
{
|
||||
newbtn |= 1;
|
||||
prevcnt -= sp_step;
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t dial = ((pdlpos*255)/sp_max);
|
||||
if(oldbtn != newbtn || Gamepad._GamepadReport.dial != dial)
|
||||
{
|
||||
oldbtn = newbtn;
|
||||
Gamepad._GamepadReport.buttons = (newbtn & 0xF) | ((newbtn>>4) & ~0xF);
|
||||
Gamepad._GamepadReport.dial = dial;
|
||||
Gamepad._GamepadReport.hat = dpad2hat(newbtn>>4);
|
||||
Gamepad.send();
|
||||
}
|
||||
}
|
||||
|
||||
counter = newcnt;
|
||||
}
|
||||
Loading…
Reference in New Issue