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(); }