GamePortAdapter
Dependencies: mbed-rtos mbed USBDevice USBJoystick
main.cpp
- Committer:
- obsoleet37
- Date:
- 2017-12-13
- Revision:
- 3:20f3136e49fa
- Parent:
- 2:c7f76dac3723
- Child:
- 4:17b8ede8063a
File content as of revision 3:20f3136e49fa:
#include "mbed.h"
//#include "USBSerial.h"
#include "USBMouseKeyboard.h"
#include "USBJoystick.h"
#include "rtos.h"
#include "string.h"
Serial pc(USBTX, USBRX);
//macOS: screen /dev/tty.usbmodem{num} {baud rate}
//Windows: Realterm lol
USBMouseKeyboard key_mouse;
//USBJoystick joystick;
Timer y1_t;
Timer x1_t;
Timer y2_t;
Timer x2_t;
InterruptIn y1(p16);
InterruptIn x1(p15);
InterruptIn y2(p18);
InterruptIn x2(p17);
volatile int y1_pulse;
volatile int x1_pulse;
volatile int y2_pulse;
volatile int x2_pulse;
volatile int buttons;
DigitalOut trig(p19);
BusIn buttons_raw(p21, p22, p23, p24);
//output, min, max, value
int bindings[8][4] = {{10, 0, 100, (int)'a'},
{10, 0, 100, (int)'w'},
{10, 255, 0, 0},
{10, 255, 0, 0},
{10, 128, 255, (int)'1'},
{10, 128, 255, (int)'2'},
{10, 128, 255, (int)'3'},
{10, 128, 255, (int)'4'}};
void start_y1() {
y1_t.reset();
y1_t.start();
}
void stop_y1() {
y1_t.stop();
y1_pulse = y1_t.read_us();
}
void start_x1() {
x1_t.reset();
x1_t.start();
}
void stop_x1() {
x1_t.stop();
x1_pulse = x1_t.read_us();
}
void start_y2() {
y2_t.reset();
y2_t.start();
}
void stop_y2() {
y2_t.stop();
y2_pulse = y2_t.read_us();
}
void start_x2() {
x2_t.reset();
x2_t.start();
}
void stop_x2() {
x2_t.stop();
x2_pulse = x2_t.read_us();
}
void analog_thread() {
buttons_raw.mode(PullUp);
trig = 1;
y1_pulse = 0;
x1_pulse = 0;
y2_pulse = 0;
x2_pulse = 0;
y1.rise(&start_y1);
y1.fall(&stop_y1);
x1.rise(&start_x1);
x1.fall(&stop_x1);
y2.rise(&start_y2);
y2.fall(&stop_y2);
x2.rise(&start_x2);
x2.fall(&stop_x2);
while(1) {
trig = 0;
trig = 1;
buttons = ~buttons_raw&0xF;
Thread::wait(1);
}
}
void debug_thread() {
pc.printf("Beginning Joystick Test...\r\n");
pc.printf("---------------------------------\r\n");
while(1) {
pc.printf("Joystick 1 - %d, %d, %X \r\n", x1_pulse, y1_pulse, buttons&0x3);
pc.printf("Joystick 2 - %d, %d, %X \r\n", x2_pulse, y2_pulse, (buttons>>2)&0x3);
pc.printf("\r\n");
Thread::wait(500);
}
}
void output_thread() {
int joy[6];
int mouse[4];
int value, trigval;
while(true) {
memset(joy, 0, sizeof(joy));
memset(mouse, 0, sizeof(mouse));
for (int i=0; i<8; i++) {
//pc.printf("Checking %d: ", i);
switch (i) {
case 0: value = x1_pulse; trigval = x1_pulse; break;
case 1: value = y1_pulse; trigval = y1_pulse; break;
case 2: value = x2_pulse; trigval = x2_pulse; break;
case 3: value = y2_pulse; trigval = y2_pulse; break;
case 4: trigval = (buttons & 0x1)*255; value = bindings[i][3]; break;
case 5: trigval = ((buttons>>1) & 0x1)*255; value = bindings[i][3]; break;
case 6: trigval = ((buttons>>2) & 0x1)*255; value = bindings[i][3]; break;
case 7: trigval = ((buttons>>3) & 0x1)*255; value = bindings[i][3]; break;
}
if (trigval >= bindings[i][1] && trigval <= bindings[i][2]) {
//pc.printf("Triggered : %d, %d, %d\r\n", i, trigval, value);
switch (bindings[i][0]) {
case 0: joy[2] = value; break;//Joy X
case 1: joy[3] = value; break; //Joy Y
case 2: joy[0] = value; break; //Joy throttle
case 3: joy[1] = value; break; //Joy rudder
case 4: joy[4] |= bindings[i][3]; break; //Joy buttons
case 5: joy[5] |= bindings[i][3]; break; //Joy hat
case 6: mouse[0] = value/10; break; //Mouse X
case 7: mouse[1] = value/10; break; //Mouse Y
case 8: mouse[2] |= bindings[i][3]; break; //Mouse buttons
case 9: mouse[3] = value/10; break; //Mouse scroll
case 10: key_mouse.keyCode(bindings[i][3]); break; //Keypress
}
}
}
//key_mouse.update(mouse[0], mouse[1], mouse[2], mouse[3]);
//joystick.update(joy[0], joy[1], joy[2], joy[3], joy[4], joy[5]);
Thread::wait(20);
}
}
int main() {
Thread analogThread;
Thread outputThread;
analogThread.start(analog_thread);
Thread::wait(100);
outputThread.start(output_thread);
//Thread debugThread;
//debugThread.start(debug_thread);
while(1) Thread::yield();
}
