/*
- * TeensyTAS, TAS input player for MegaDrive
- * Copyright (c) 2014 notaz
+ * TeensyTP, Team Player/4-Player Adaptor implementation for Teensy3
+ * host part
+ * Copyright (c) 2015 notaz
*
* Permission is hereby granted, free of charge, to any person obtaining
* a copy of this software and associated documentation files (the
} ifaces[2];
};
-/* return 1 if founf, 0 if not, < 0 on error */
+/* return 1 if found, 0 if not, < 0 on error */
static int find_device(struct teensy_dev *dev,
uint16_t vendor, uint16_t product)
{
signal(sig, SIG_DFL);
}
-/* ?0SA 00DU, ?1CB RLDU */
-#define STATE_BYTES 2
-
-static uint8_t fixed_input_state[STATE_BYTES] = { 0x33, 0x3f };
-
+/* MXYZ SACB RLDU */
enum mdbtn {
- MDBTN_UP = 1,
- MDBTN_DOWN,
- MDBTN_LEFT,
- MDBTN_RIGHT,
- MDBTN_A,
- MDBTN_B,
- MDBTN_C,
- MDBTN_START,
+ MDBTN_UP = (1 << 0),
+ MDBTN_DOWN = (1 << 1),
+ MDBTN_LEFT = (1 << 2),
+ MDBTN_RIGHT = (1 << 3),
+ MDBTN_A = (1 << 6),
+ MDBTN_B = (1 << 4),
+ MDBTN_C = (1 << 5),
+ MDBTN_START = (1 << 7),
+ MDBTN_X = (1 << 10),
+ MDBTN_Y = (1 << 9),
+ MDBTN_Z = (1 << 8),
+ MDBTN_MODE = (1 << 11),
};
-static const enum mdbtn evdev_md_map[KEY_CNT] = {
+#define BTN_JOY BTN_JOYSTICK
+
+static const uint32_t evdev_md_default_map[KEY_CNT] = {
[KEY_UP] = MDBTN_UP,
[KEY_DOWN] = MDBTN_DOWN,
[KEY_LEFT] = MDBTN_LEFT,
[KEY_RIGHT] = MDBTN_RIGHT,
+ [KEY_Z] = MDBTN_A,
+ [KEY_X] = MDBTN_B,
+ [KEY_C] = MDBTN_C,
+ [KEY_A] = MDBTN_X,
+ [KEY_S] = MDBTN_Y,
+ [KEY_D] = MDBTN_Z,
+ [KEY_F] = MDBTN_MODE,
+ [KEY_ENTER] = MDBTN_START,
+ // gamepad
+ [BTN_JOY + 0] = MDBTN_A,
+ [BTN_JOY + 1] = MDBTN_B,
+ [BTN_JOY + 2] = MDBTN_C,
+ [BTN_JOY + 3] = MDBTN_START,
+ // pandora
[KEY_HOME] = MDBTN_A,
[KEY_PAGEDOWN] = MDBTN_B,
[KEY_END] = MDBTN_C,
[KEY_LEFTALT] = MDBTN_START,
};
-int do_evdev_input(int fd)
+static struct player_state {
+ uint32_t kc_map[KEY_CNT];
+ uint32_t state;
+ int dirty;
+} players[4];
+
+static int do_evdev_input(int fd, unsigned int player_i)
{
- uint8_t old_state[STATE_BYTES];
- uint8_t changed_bits[STATE_BYTES] = { 0, };
+ struct player_state *player;
struct input_event ev;
- enum mdbtn mdbtn;
- int i, ret;
+ uint32_t mask_clear = 0;
+ uint32_t mask_set = 0;
+ uint32_t old_state;
+ int ret;
ret = read(fd, &ev, sizeof(ev));
if (ret != sizeof(ev)) {
return 0;
}
- if (ev.type != EV_KEY)
- return 0;
-
- if (ev.value != 0 && ev.value != 1)
- return 0;
-
- if ((uint32_t)ev.code >= ARRAY_SIZE(evdev_md_map)) {
- fprintf(stderr, "evdev read bad key: %u\n", ev.code);
+ if (player_i >= ARRAY_SIZE(players)) {
+ fprintf(stderr, "bad player: %u\n", player_i);
return 0;
}
+ player = &players[player_i];
+ old_state = player->state;
- mdbtn = evdev_md_map[ev.code];
- if (mdbtn == 0)
- return 0;
-
- memcpy(old_state, fixed_input_state, STATE_BYTES);
-
- /* ?0SA 00DU, ?1CB RLDU */
- switch (mdbtn) {
- case MDBTN_UP:
- changed_bits[0] = 0x01;
- changed_bits[1] = 0x01;
- break;
- case MDBTN_DOWN:
- changed_bits[0] = 0x02;
- changed_bits[1] = 0x02;
- break;
- case MDBTN_LEFT:
- changed_bits[0] = 0x00;
- changed_bits[1] = 0x04;
- break;
- case MDBTN_RIGHT:
- changed_bits[0] = 0x00;
- changed_bits[1] = 0x08;
- break;
- case MDBTN_A:
- changed_bits[0] = 0x10;
- changed_bits[1] = 0x00;
- break;
- case MDBTN_B:
- changed_bits[0] = 0x00;
- changed_bits[1] = 0x10;
- break;
- case MDBTN_C:
- changed_bits[0] = 0x00;
- changed_bits[1] = 0x20;
- break;
- case MDBTN_START:
- changed_bits[0] = 0x20;
- changed_bits[1] = 0x00;
- break;
- }
-
- if (ev.value) {
- // key press
- for (i = 0; i < STATE_BYTES; i++)
- fixed_input_state[i] &= ~changed_bits[i];
- }
- else {
- // key release
- for (i = 0; i < STATE_BYTES; i++)
- fixed_input_state[i] |= changed_bits[i];
+ if (ev.type == EV_ABS) {
+ if (ev.code == 0) {
+ mask_clear = MDBTN_LEFT | MDBTN_RIGHT;
+ if (ev.value < 10)
+ mask_set = MDBTN_LEFT;
+ else if (ev.value > 210)
+ mask_set = MDBTN_RIGHT;
+ }
+ else {
+ mask_clear = MDBTN_UP | MDBTN_DOWN;
+ if (ev.value < 10)
+ mask_set = MDBTN_UP;
+ else if (ev.value > 210)
+ mask_set = MDBTN_DOWN;
+ }
+ printf("abs, s %x %x\n", mask_clear, mask_set);
}
+ else if (ev.type == EV_KEY) {
+ if (ev.value != 0 && ev.value != 1)
+ return 0;
- return memcmp(old_state, fixed_input_state, STATE_BYTES) ? 1 : 0;
-}
-
-#define MAX_INPUT_BYTES 2
+ if ((uint32_t)ev.code >= ARRAY_SIZE(player->kc_map)) {
+ fprintf(stderr, "evdev read bad key: %u\n", ev.code);
+ return 0;
+ }
-// TODO: 6btn
-static int tas_data_to_teensy(uint16_t b, uint8_t *data, FILE *logf)
-{
- uint8_t t;
-
- /* SCBA RLDU */
- /* v */
- /* ?0SA 00DU, ?1CB RLDU */
- data[0] = (b & 0x13) | ((b >> 2) & 0x20);
- data[1] = (b & 0x0f) | ((b >> 1) & 0x30);
-
- if (logf != NULL) {
- fwrite(&data[0], 1, 1, logf);
- t = data[1] | 0x40; // expected TH
- fwrite(&t, 1, 1, logf);
+ if (ev.value) // press?
+ mask_set = player->kc_map[ev.code];
+ else
+ mask_clear = player->kc_map[ev.code];
}
- return 2;
-}
+ player->state &= ~mask_clear;
+ player->state |= mask_set;
-struct gmv_tas {
- char sig[15];
- char ver;
- uint32_t rerecord_count;
- char ctrl1;
- char ctrl2;
- uint16_t flags;
- char name[40];
- uint8_t data[0][3];
-};
+ player->dirty |= old_state != player->state;
+ return player->dirty;
+}
-static int import_gmv(FILE *f, long size,
- uint8_t *out[2], int out_byte_count[2], FILE *logf)
+static int open_evdev(const char *name)
{
- struct gmv_tas *gmv;
- int frame_count;
- int count = 0;
- uint16_t val;
- int ret;
- int i;
-
- out_byte_count[0] = out_byte_count[1] = 0;
+ int evdev_support = 0;
+ int fd, ret;
- if (size < (long)sizeof(*gmv)) {
- fprintf(stderr, "bad gmv size: %ld\n", size);
- return -1;
- }
-
- gmv = malloc(size);
- if (gmv == NULL) {
- fprintf(stderr, "OOM?\n");
- return -1;
- }
- ret = fread(gmv, 1, size, f);
- if (ret != size) {
- fprintf(stderr, "fread %d/%ld: ", ret, size);
+ fd = open(name, O_RDONLY);
+ if (fd == -1) {
+ fprintf(stderr, "open %s: ", name);
perror("");
return -1;
}
-
- frame_count = (size - sizeof(*gmv)) / sizeof(gmv->data[0]);
-
- /* check the GMV.. */
- if (frame_count <= 0 || size != sizeof(*gmv) + frame_count * 3) {
- fprintf(stderr, "broken gmv? frames=%d\n", frame_count);
- return -1;
- }
-
- if (strncmp(gmv->sig, "Gens Movie TEST", 15) != 0) {
- fprintf(stderr, "bad GMV sig\n");
- return -1;
- }
- if (gmv->ctrl1 != '3') {
- fprintf(stderr, "unhandled controlled config: '%c'\n", gmv->ctrl1);
- //return -1;
- }
- if (gmv->ver >= 'A') {
- if (gmv->flags & 0x40) {
- fprintf(stderr, "unhandled flag: movie requires a savestate\n");
- return -1;
- }
- if (gmv->flags & 0x20) {
- fprintf(stderr, "unhandled flag: 3-player movie\n");
- return -1;
- }
- if (gmv->flags & ~0x80) {
- //fprintf(stderr, "unhandled flag(s): %04x\n", gmv->flags);
- //return 1;
- }
- }
- gmv->name[39] = 0;
- printf("loaded GMV: %s\n", gmv->name);
- printf("%d frames, %u rerecords\n",
- frame_count, gmv->rerecord_count);
-
- out[0] = malloc(frame_count * MAX_INPUT_BYTES);
- if (out[0] == NULL) {
- fprintf(stderr, "OOM?\n");
+ ret = ioctl(fd, EVIOCGBIT(0, sizeof(evdev_support)),
+ &evdev_support);
+ if (ret < 0)
+ perror("EVIOCGBIT");
+ if (!(evdev_support & (1 << EV_KEY))) {
+ fprintf(stderr, "%s doesn't have keys\n", name);
+ close(fd);
return -1;
}
- for (i = 0; i < frame_count; i++) {
- val = gmv->data[i][0] | ((gmv->data[i][2] & 0x0f) << 8);
- count += tas_data_to_teensy(val, out[0] + count, logf);
-
- if (gmv->data[i][1] != 0xff || gmv->data[i][2] != 0xff)
- {
- fprintf(stderr, "f %d: unhandled byte(s) %02x %02x\n",
- i, gmv->data[i][1], gmv->data[i][2]);
- }
- }
-
- out_byte_count[0] = count;
- return 0;
+ return fd;
}
-static int do_bkm_char(char c, char expect, uint16_t *val, int bit)
+static void do_stdin_input(uint32_t *mode, int *changed)
{
- if (c == expect) {
- *val &= ~(1 << bit);
- return 0;
- }
- if (c == '.')
- return 0;
-
- fprintf(stderr, "unexpected bkm char: '%c' instead of '%c'\n",
- c, expect);
- return 1;
-}
-
-static int import_bkm(FILE *f, uint8_t *out[2], int out_byte_count[2],
- FILE *logf)
-{
- int teensy_bytes = 0;
- int have_pl2 = 0;
- int have_xyz = 0;
- int frames = 0;
- int count = 0;
- int alloc = 0;
- int line = 0;
- char buf[256];
- const char *r;
- uint16_t val;
- char *p;
- int pl, i;
-
- while ((p = fgets(buf, sizeof(buf), f)) != NULL)
- {
- line++;
- if (p[0] != '|')
- continue;
-
- if (strlen(p) < 30)
- goto unhandled_line;
- if (p[30] != '\r' && p[30] != '\n')
- goto unhandled_line;
- p[30] = 0;
-
- if (count >= alloc - MAX_INPUT_BYTES) {
- alloc = alloc * 2 + 64;
- for (pl = 0; pl < 2; pl++) {
- out[pl] = realloc(out[pl], alloc * sizeof(out[0][0]));
- if (out[pl] == NULL) {
- fprintf(stderr, "OOM?\n");
- return -1;
- }
- }
- }
-
- if (strncmp(p, "|.|", 3) != 0)
- goto unhandled_line;
- p += 3;
-
- for (pl = 0; pl < 2; pl++) {
- static const char ref[] = "UDLRABCSXYZM";
-
- val = 0xfff;
- for (r = ref, i = 0; *r != 0; p++, r++, i++) {
- if (do_bkm_char(*p, *r, &val, i))
- goto unhandled_line;
- }
-
- if (*p++ != '|')
- goto unhandled_line;
-
- teensy_bytes = tas_data_to_teensy(val, out[pl] + count, logf);
-
- if ((val & 0xf00) != 0xf00)
- have_xyz = 1;
- if (pl == 1)
- have_pl2 |= (val != 0xfff);
- }
- count += teensy_bytes;
-
- if (strcmp(p, "|") != 0)
- goto unhandled_line;
-
- frames++;
- continue;
+ char c = 0;
+ int ret;
-unhandled_line:
- fprintf(stderr, "unhandled bkm line %d: '%s'\n", line, buf);
- return -1;
+ ret = read(STDIN_FILENO, &c, 1);
+ if (ret <= 0) {
+ perror("read stdin");
+ return;
}
- printf("loaded bkm, %d players, %d frames, %d bytes, have_xyz=%d\n",
- have_pl2 ? 2 : 1, frames, count, have_xyz);
- out_byte_count[0] = count;
- if (have_pl2)
- out_byte_count[1] = count;
- else {
- free(out[1]);
- out[1] = NULL;
+ switch (c) {
+ case '1':
+ printf("3btn mode\n");
+ *mode = OP_MODE_3BTN;
+ *changed = 1;
+ break;
+ case '2':
+ printf("6btn mode\n");
+ *mode = OP_MODE_6BTN;
+ *changed = 1;
+ break;
+ case '3':
+ printf("teamplayer mode\n");
+ *mode = OP_MODE_TEAMPLAYER;
+ *changed = 1;
+ break;
}
-
- return 0;
}
-static int import_raw(FILE *f, uint8_t **out, int *out_byte_count,
- FILE *logf)
+static int parse_binds(unsigned int player_i, const char *binds)
{
- int count = 0;
- int alloc = 0;
- int line = 0;
- int first = 1;
- char buf[256];
- uint8_t val;
- char *p;
- int i;
-
- *out_byte_count = 0;
-
- while ((p = fgets(buf, sizeof(buf), f)) != NULL)
- {
- line++;
- if (p[0] == '#')
- continue;
- if (p[0] != 'e') {
- printf("skipping: %s", p);
- continue;
- }
-
- val = 0;
- p++;
- for (i = 6; i >= 0; i--, p++) {
- if (*p != '0' && *p != '1')
- goto bad;
- if (*p == '1')
- val |= 1 << i;
- }
- if (*p != ' ')
- goto bad;
-
- if (first && (val & 0x40))
- continue; // XXX..
- first = 0;
-
- if (count >= alloc) {
- alloc = alloc * 2 + 64;
- *out = realloc(*out, alloc * sizeof((*out)[0]));
- if (*out == NULL) {
- fprintf(stderr, "OOM?\n");
- return -1;
- }
- }
-
- if (logf)
- fwrite(&val, 1, 1, logf);
-
- (*out)[count++] = val & 0x3f;
- continue;
-
-bad:
- fprintf(stderr, "bad raw line %d: '%s'\n", line, buf);
- return -1;
- }
-
- printf("loaded raw, %d bytes\n", count);
- *out_byte_count = count;
return 0;
}
-static int write_bkm_frame(FILE *f, const uint8_t *data)
-{
- /* ?0SA 00DU, ?1CB RLDU */
- static const char ref[] = "UDLRABCSXYZM";
- static const char bits[] = { 0,1,2,3, 12,4,5,13, 16,16,16,16 };
- uint32_t idata[2];
- int p, i;
-
- if (f == NULL) {
- fprintf(stderr, "%s called without outfile\n", __func__);
- goto out;
- }
-
- idata[0] = 0x10000 | (data[0] << 8) | data[1];
- idata[1] = ~0;
-
- fprintf(f, "|.|");
- for (p = 0; p < 2; p++) {
- for (i = 0; i < 12; i++)
- fprintf(f, "%c", (idata[p] & (1 << bits[i])) ? '.' : ref[i]);
- fprintf(f, "|");
- }
- fprintf(f, "|\n");
-
-out:
- return 2;
-}
-
static int submit_urb(int fd, struct usbdevfs_urb *urb, int ep,
void *buf, size_t buf_size)
{
URB_CNT
};
-static void missing_arg(int a)
+static void usage(const char *argv0)
{
- fprintf(stderr, "missing arg: %d\n", a);
+ fprintf(stderr, "usage:\n%s <-e player /dev/input/node>*\n"
+ " [-b <player> <keycode=mdbtn>[,keycode=mdbtn]]\n"
+ " [-m <mode>]\n\n"
+ " mdbtn: int 0-11: UDLR ABCS XYZM)\n"
+ " mode: int 0-2: 3btn 6btn teamplayer\n", argv0);
exit(1);
}
+static void bad_arg(char *argv[], int a)
+{
+ fprintf(stderr, "bad arg %d: '%s'\n", a, argv[a]);
+ usage(argv[0]);
+}
+
int main(int argc, char *argv[])
{
struct teensy_dev dev;
struct usbdevfs_urb urb[URB_CNT];
struct usbdevfs_urb *reaped_urb;
- int fixed_input_changed = 0;
+ uint32_t evdev_players[16];
int evdev_fds[16];
int evdev_fd_cnt = 0;
- int evdev_support;
int wait_device = 0;
int pending_urbs = 0;
+ int had_input = 0;
fd_set rfds, wfds;
- const char *tasfn = NULL;
- const char *tasfn_p2 = NULL;
- const char *outfn = NULL;
- const char *logfn = NULL;
- uint8_t *tas_data[2] = { NULL, NULL };
- int tas_data_size[2] = { 0, 0 };
- int bytes_sent[2] = { 0, 0 };
- int use_vsync = 0; // frame increment on vsync
- int separate_2p = 0;
- int no_start_seq = 0;
- int enable_sent = 0;
- int abort_sent = 0;
- int frame_count = 0;
+ int mode_changed = 0;
char buf_dbg[64 + 1];
- struct tas_pkt pkt_in;
- struct tas_pkt pkt_out;
+ struct tp_pkt pkt_in;
+ struct tp_pkt pkt_out;
struct timeval *timeout = NULL;
struct timeval tout;
- FILE *outf = NULL;
- FILE *logf = NULL;
+ uint32_t mode = OP_MODE_3BTN;
+ uint32_t player;
int i, ret = -1;
int fd;
+ for (i = 0; i < ARRAY_SIZE(players); i++)
+ memcpy(&players[i].kc_map, evdev_md_default_map,
+ sizeof(players[i].kc_map));
+
for (i = 1; i < argc; i++) {
if (argv[i][0] == '-') {
switch (argv[i][1] | (argv[i][2] << 8)) {
- case 'm':
- i++;
- if (argv[i] == NULL)
- missing_arg(i);
- tasfn = argv[i];
- continue;
- case '2':
- i++;
- if (argv[i] == NULL)
- missing_arg(i);
- tasfn_p2 = argv[i];
- continue;
- case 'w':
- i++;
- if (argv[i] == NULL)
- missing_arg(i);
- outfn = argv[i];
- continue;
- case 'l':
- i++;
- if (argv[i] == NULL)
- missing_arg(i);
- logfn = argv[i];
+ case 'e':
+ if (argv[++i] == NULL)
+ bad_arg(argv, i);
+ player = strtoul(argv[i], NULL, 0);
+ if (player >= ARRAY_SIZE(players))
+ bad_arg(argv, i);
+
+ if (argv[++i] == NULL)
+ bad_arg(argv, i);
+ fd = open_evdev(argv[i]);
+ if (fd == -1)
+ bad_arg(argv, i);
+ if (evdev_fd_cnt >= ARRAY_SIZE(evdev_fds)) {
+ fprintf(stderr, "too many evdevs\n");
+ break;
+ }
+ evdev_players[evdev_fd_cnt] = player;
+ evdev_fds[evdev_fd_cnt] = fd;
+ evdev_fd_cnt++;
continue;
- case 'v':
- use_vsync = 1;
+ case 'b':
+ if (argv[++i] == NULL)
+ bad_arg(argv, i);
+ player = strtoul(argv[i], NULL, 0);
+ if (player >= ARRAY_SIZE(players))
+ bad_arg(argv, i);
+
+ if (argv[++i] == NULL)
+ bad_arg(argv, i);
+ ret = parse_binds(player, argv[i]);
+ if (ret != 0)
+ bad_arg(argv, i);
continue;
- case 'n':
- no_start_seq = 1;
+ case 'm':
+ if (argv[++i] == NULL)
+ bad_arg(argv, i);
+ mode = strtoul(argv[i], NULL, 0);
+ mode_changed = 1;
continue;
- default:
- fprintf(stderr, "bad arg: %s\n", argv[i]);
- return 1;
- }
- }
-
- /* remaining args are evdev filenames */
- if (evdev_fd_cnt >= ARRAY_SIZE(evdev_fds)) {
- fprintf(stderr, "too many evdevs\n");
- break;
- }
- fd = open(argv[i], O_RDONLY);
- if (fd == -1) {
- fprintf(stderr, "open %s: ", argv[i]);
- perror("");
- continue;
- }
- evdev_support = 0;
- ret = ioctl(fd, EVIOCGBIT(0, sizeof(evdev_support)),
- &evdev_support);
- if (ret < 0)
- perror("EVIOCGBIT");
- if (!(evdev_support & (1 << EV_KEY))) {
- fprintf(stderr, "%s doesn't have keys\n", argv[i]);
- close(fd);
- continue;
- }
- evdev_fds[evdev_fd_cnt++] = fd;
- }
-
- if (logfn != NULL) {
- logf = fopen(logfn, "wb");
- if (logf == NULL) {
- fprintf(stderr, "fopen %s: ", logfn);
- perror("");
- return 1;
- }
- }
-
- if (tasfn != NULL) {
- FILE *f, *f_p2 = NULL;
- const char *ext;
- long size;
-
- f = fopen(tasfn, "rb");
- if (f == NULL) {
- fprintf(stderr, "fopen %s: ", tasfn);
- perror("");
- return 1;
- }
-
- if (tasfn_p2 != NULL) {
- f_p2 = fopen(tasfn_p2, "rb");
- if (f_p2 == NULL) {
- fprintf(stderr, "fopen %s: ", tasfn_p2);
- perror("");
- return 1;
}
}
-
- fseek(f, 0, SEEK_END);
- size = ftell(f);
- fseek(f, 0, SEEK_SET);
- if (size <= 0) {
- fprintf(stderr, "bad size: %ld\n", size);
- return 1;
- }
-
- ext = strrchr(tasfn, '.');
- if (ext == NULL)
- ext = tasfn;
- else
- ext++;
-
- if (strcasecmp(ext, "gmv") == 0)
- ret = import_gmv(f, size, tas_data, tas_data_size, logf);
- else if (strcasecmp(ext, "bkm") == 0)
- ret = import_bkm(f, tas_data, tas_data_size, logf);
- else if (strcasecmp(ext, "txt") == 0)
- ret = import_raw(f, &tas_data[0], &tas_data_size[0], logf);
- else {
- fprintf(stderr, "unknown movie type: '%s'\n", ext);
- return 1;
- }
- fclose(f);
-
- if (ret != 0 || tas_data[0] == NULL || tas_data_size[0] <= 0) {
- fprintf(stderr, "failed fo parse %s\n", tasfn);
- return 1;
- }
-
- // separate file with p2 input?
- if (f_p2 != NULL) {
- ret = import_raw(f_p2, &tas_data[1], &tas_data_size[1], NULL);
- if (ret != 0 || tas_data[1] == NULL || tas_data_size[1] <= 0) {
- fprintf(stderr, "failed fo parse %s\n", tasfn_p2);
- return 1;
- }
- fclose(f_p2);
- separate_2p = 1;
- }
-
- if (logf != NULL) {
- fclose(logf);
- logf = NULL;
- }
-
- if (tas_data_size[1] != 0 && tas_data[1] == NULL) {
- fprintf(stderr, "missing tas_data[1]\n");
- return 1;
- }
+ bad_arg(argv, i);
}
- if (outfn != NULL) {
- outf = fopen(outfn, "w");
- if (outf == NULL) {
- fprintf(stderr, "fopen %s: ", outfn);
- perror("");
- return 1;
- }
- }
+ if (evdev_fd_cnt == 0)
+ usage(argv[0]);
enable_echo(0);
signal(SIGINT, signal_handler);
if (ret == 0) {
if (!wait_device) {
- printf("waiting for device..\n");
+ printf("waiting for device...\n");
wait_device = 1;
}
usleep(250000);
wait_device = 0;
pending_urbs = 0;
- enable_sent = 0;
- bytes_sent[0] = 0;
- bytes_sent[1] = 0;
/* we wait first, then send commands, but if teensy
- * is started already, it won't send anything */
+ * is started already, it won't send anything back */
tout.tv_sec = 1;
tout.tv_usec = 0;
timeout = &tout;
}
timeout = NULL;
- /* sometihng form stdin? */
- if (FD_ISSET(STDIN_FILENO, &rfds)) {
- char c = 0;
- ret = read(STDIN_FILENO, &c, 1);
- if (ret <= 0) {
- perror("read stdin");
- break;
- }
-
- switch (c) {
- case 'r':
- enable_sent = 0;
- break;
- }
- }
+ /* something form stdin? */
+ if (FD_ISSET(STDIN_FILENO, &rfds))
+ do_stdin_input(&mode, &mode_changed);
/* something from input devices? */
+ had_input = 0;
for (i = 0; i < evdev_fd_cnt; i++) {
if (FD_ISSET(evdev_fds[i], &rfds)) {
- fixed_input_changed |=
- do_evdev_input(evdev_fds[i]);
+ do_evdev_input(evdev_fds[i], evdev_players[i]);
+ had_input = 1;
}
}
+ if (had_input) {
+ /* collect any other input changes before starting
+ * the slow USB transfer */
+ tout.tv_sec = tout.tv_usec = 0;
+ timeout = &tout;
+ continue;
+ }
/* something from USB? */
if (FD_ISSET(dev.fd, &wfds))
}
else if (reaped_urb == &urb[URB_DATA_IN])
{
- int p;
-
/* some request from teensy */
- switch (pkt_in.type) {
- case PKT_STREAM_REQ:
- p = pkt_in.req.is_p2 ? 1 : 0;
- printf("req%d: %d/%d/%d\n", pkt_in.req.is_p2,
- pkt_in.req.frame * 2, bytes_sent[p], tas_data_size[p]);
-
- pkt_out.size = 0;
- if (bytes_sent[p] < tas_data_size[p]) {
- pkt_out.type = p ? PKT_STREAM_DATA_TO_P2
- : PKT_STREAM_DATA_TO_P1;
-
- i = tas_data_size[p] - bytes_sent[p];
- if (i > sizeof(pkt_out.data))
- i = sizeof(pkt_out.data);
- memcpy(pkt_out.data, tas_data[p] + bytes_sent[p], i);
- bytes_sent[p] += i;
- pkt_out.size = i;
- }
- else {
- pkt_out.type = PKT_STREAM_END;
- }
-
- ret = submit_urb(dev.fd, &urb[URB_DATA_OUT],
- dev.ifaces[0].ep_out, &pkt_out, sizeof(pkt_out));
- if (ret != 0)
- perror("USBDEVFS_SUBMITURB PKT_STREAM_DATA_TO");
- break;
-
- case PKT_STREAM_DATA_FROM:
- printf("f: %d\n", frame_count);
- if (pkt_in.size == 0 || pkt_in.size > sizeof(pkt_out.data)) {
- printf("host: got bad DATA_FROM size: %u\n", pkt_in.size);
- break;
- }
- for (i = 0; i < pkt_in.size; ) {
- i += write_bkm_frame(outf, pkt_in.data + i);
- frame_count++;
- }
- break;
-
- default:
- printf("host: got unknown pkt type: %04x\n", pkt_in.type);
- break;
- }
+ printf("rx data?\n");
}
else if (reaped_urb == &urb[URB_DATA_OUT])
{
/* something to send? */
if (pending_urbs & (1 << URB_DATA_OUT))
- // can't do that yet
+ // can't do that yet - out urb still busy
continue;
- if ((tas_data[0] != NULL || outf != NULL) && !enable_sent) {
+ if (mode_changed) {
memset(&pkt_out, 0, sizeof(pkt_out));
- pkt_out.type = PKT_STREAM_ENABLE;
- pkt_out.enable.stream_to = (tas_data[0] != NULL);
- pkt_out.enable.stream_from = (outf != NULL);
- pkt_out.enable.no_start_seq = no_start_seq;
- if (use_vsync)
- pkt_out.enable.inc_mode = INC_MODE_VSYNC;
- else if (tas_data_size[1] != 0 && separate_2p)
- pkt_out.enable.inc_mode = INC_MODE_SEPARATE;
- else if (tas_data_size[1] != 0)
- pkt_out.enable.inc_mode = INC_MODE_SHARED_PL2;
- else
- pkt_out.enable.inc_mode = INC_MODE_SHARED_PL1;
+ pkt_out.type = PKT_UPD_MODE;
+ pkt_out.mode = mode;
ret = submit_urb(dev.fd, &urb[URB_DATA_OUT], dev.ifaces[0].ep_out,
&pkt_out, sizeof(pkt_out));
continue;
}
pending_urbs |= 1 << URB_DATA_OUT;
- enable_sent = 1;
- bytes_sent[0] = 0;
- bytes_sent[1] = 0;
+ mode_changed = 0;
continue;
}
- if (tas_data[0] == NULL && fixed_input_changed) {
- memset(&pkt_out, 0, sizeof(pkt_out));
- pkt_out.type = PKT_FIXED_STATE;
- memcpy(pkt_out.data, fixed_input_state, sizeof(fixed_input_state));
- ret = submit_urb(dev.fd, &urb[URB_DATA_OUT], dev.ifaces[0].ep_out,
- &pkt_out, sizeof(pkt_out));
- if (ret != 0) {
- perror("USBDEVFS_SUBMITURB PKT_FIXED_STATE");
- break;
- }
- fixed_input_changed = 0;
- pending_urbs |= 1 << URB_DATA_OUT;
- continue;
+ /* send buttons if there were any changes */
+ memset(&pkt_out, 0, sizeof(pkt_out));
+ for (i = 0; i < ARRAY_SIZE(players); i++) {
+ if (players[i].dirty)
+ pkt_out.changed_players |= 1 << i;
+ players[i].dirty = 0;
+
+ pkt_out.bnts[i] = players[i].state;
}
- if (g_exit && !abort_sent) {
- memset(&pkt_out, 0, sizeof(pkt_out));
- pkt_out.type = PKT_STREAM_ABORT;
+ if (pkt_out.changed_players != 0) {
+ pkt_out.type = PKT_UPD_BTNS;
ret = submit_urb(dev.fd, &urb[URB_DATA_OUT], dev.ifaces[0].ep_out,
&pkt_out, sizeof(pkt_out));
if (ret != 0) {
- perror("USBDEVFS_SUBMITURB PKT_STREAM_ABORT");
+ perror("USBDEVFS_SUBMITURB PKT_FIXED_STATE");
break;
}
pending_urbs |= 1 << URB_DATA_OUT;
- abort_sent = 1;
continue;
}
enable_echo(1);
- if (outf != NULL)
- fclose(outf);
-
if (dev.fd != -1) {
/* deal with pending URBs */
if (pending_urbs & (1 << URB_DATA_IN))
/*
- * TeensyTAS, TAS input player for MegaDrive
- * Copyright (c) 2014 notaz
+ * TeensyTP, Team Player/4-Player Adaptor implementation for Teensy3
+ * using a host machine with USB hub
+ * Copyright (c) 2015 notaz
*
* Permission is hereby granted, free of charge, to any person obtaining
* a copy of this software and associated documentation files (the
#define ARRAY_SIZE(x) (sizeof(x) / sizeof(x[0]))
-#define noinline __attribute__((noinline))
-
-// use power of 2
-#define STREAM_BUF_SIZE 512
-#define STREAM_BUF_MASK (512 - 1)
-
-/* ?0SA 00DU, ?1CB RLDU */
-#define STREAM_EL_SZ 2
-
-static struct {
- uint8_t stream_to[2][STREAM_BUF_SIZE][STREAM_EL_SZ];
- uint8_t stream_from[STREAM_BUF_SIZE][STREAM_EL_SZ];
- struct {
- union {
- uint8_t fixed_state[4];
- uint32_t fixed_state32;
- };
- union {
- uint8_t pending_state[4];
- uint32_t pending_state32;
- };
- } pl[2];
- uint32_t stream_enable_to:1;
- uint32_t stream_enable_from:1;
- uint32_t stream_started:1;
- uint32_t stream_ended:1;
- uint32_t inc_mode:2;
- uint32_t use_pending:1;
- uint32_t frame_cnt;
- uint32_t edge_cnt;
- struct {
- uint32_t i;
- uint32_t o;
- } pos_to_p[2], pos_from;
-} g;
+#define noinline __attribute__((noclone,noinline))
ssize_t _write(int fd, const void *buf, size_t nbyte)
{
{
}
-static noinline void choose_isrs_idle(void);
+/*
+ * 00157:231: w 70 @ 007ef2
+ * 00157:231: r 7f @ 007f06
+ * 00157:231: w 30 @ 007efa
+ * 00157:231: r 33 @ 007f06
+ * 00157:232: w 40 @ 007f6a
+ * 00157:232: r 7f @ 007f70
+ */
+
+/* ?0SA 00DU, ?1CB RLDU */
+
+static struct {
+ union {
+ uint16_t hw;
+ uint8_t b[2];
+ } btn3_state[2];
+ //uint8_t btn6_state[2][4];
+ uint8_t tp_state[16];
+
+ uint32_t cnt;
+ uint32_t mode;
+ uint32_t pl1th:1;
+} g;
/* player1 TH */
-#define PL1_ISFR PORTD_ISFR
-#define PL1_TH() ((CORE_PIN21_PINREG >> CORE_PIN21_BIT) & 1)
+#define PL1_ISFR PORTD_ISFR
+#define PL1_TH() ((CORE_PIN21_PINREG >> CORE_PIN21_BIT) & 1)
+#define PL1_TR() ((CORE_PIN20_PINREG >> CORE_PIN20_BIT) & 1)
+#define PL1_TH_MASK CORE_PIN21_BITMASK
+#define PL1_TR_MASK CORE_PIN20_BITMASK
-static void pl1th_isr_fixed(void)
+static void pl1_isr_3btn(void)
{
- uint32_t isfr, th;
+ uint32_t isfr;
isfr = PL1_ISFR;
PL1_ISFR = isfr;
- th = PL1_TH();
- GPIOD_PDOR = g.pl[0].fixed_state[th];
- g.edge_cnt++;
+ GPIOD_PDOR = g.btn3_state[0].b[PL1_TH()];
}
-static noinline void do_to_step_pl1(void)
+static noinline void pl1_isr_tp_do_th(void)
{
- g.frame_cnt++;
-
- g.pos_to_p[0].o = (g.pos_to_p[0].o + 1) & STREAM_BUF_MASK;
- if (g.pos_to_p[0].o == g.pos_to_p[0].i)
- // done
- choose_isrs_idle();
-}
+ uint32_t cnt, th;
-static void pl1th_isr_do_to_inc(void)
-{
- uint32_t isfr, th;
-
- isfr = PL1_ISFR;
- PL1_ISFR = isfr;
th = PL1_TH();
+ cnt = !th;
- GPIOD_PDOR = g.stream_to[0][g.pos_to_p[0].o][th];
- if (th)
- do_to_step_pl1();
+ GPIOD_PDOR = g.tp_state[cnt] | (PL1_TR() << 4);
+ g.cnt = cnt;
+ g.pl1th = th;
}
-static void pl1th_isr_do_to(void)
+static void pl1_isr_tp(void)
{
- uint32_t isfr, th;
+ uint32_t isfr;
isfr = PL1_ISFR;
PL1_ISFR = isfr;
- th = PL1_TH();
- GPIOD_PDOR = g.stream_to[0][g.pos_to_p[0].o][th];
- g.edge_cnt++;
+ if (isfr & PL1_TH_MASK)
+ pl1_isr_tp_do_th();
+ if (!(isfr & PL1_TR_MASK))
+ return;
+ if (g.pl1th)
+ return;
+
+ g.cnt++;
+ GPIOD_PDOR = g.tp_state[g.cnt & 0x0f] | (PL1_TR() << 4);
}
/* player2 TH */
#define PL2_TH() ((CORE_PIN15_PINREG >> CORE_PIN15_BIT) & 1)
#define PL2_ADJ(x) ((x) | ((x) << 12))
-static void pl2th_isr_fixed(void)
-{
- uint32_t isfr, th, v;
-
- isfr = PL2_ISFR;
- PL2_ISFR = isfr;
- th = PL2_TH();
-
- v = g.pl[1].fixed_state[th];
- GPIOB_PDOR = PL2_ADJ(v);
-}
-
-static noinline void do_to_step_pl2(void)
-{
- g.pos_to_p[1].o = (g.pos_to_p[1].o + 1) & STREAM_BUF_MASK;
- if (g.pos_to_p[1].o == g.pos_to_p[1].i)
- // done
- choose_isrs_idle();
-}
-
-static void pl2th_isr_do_to_inc(void)
-{
- uint32_t isfr, th, v;
-
- isfr = PL2_ISFR;
- PL2_ISFR = isfr;
- th = PL2_TH();
-
- v = g.stream_to[1][g.pos_to_p[1].o][th];
- GPIOB_PDOR = PL2_ADJ(v);
- if (th)
- do_to_step_pl2();
-}
-
-static void pl2th_isr_do_to_p1d(void)
+static void pl2_isr_nop(void)
{
- uint32_t isfr, th, v;
-
- isfr = PL2_ISFR;
- PL2_ISFR = isfr;
- th = PL2_TH();
-
- v = g.stream_to[1][g.pos_to_p[0].o][th];
- GPIOB_PDOR = PL2_ADJ(v);
-
- g.pos_to_p[1].o = g.pos_to_p[0].o;
-}
-
-static void pl2th_isr_do_to_inc_pl1(void)
-{
- uint32_t isfr, th, v;
+ uint32_t isfr;
isfr = PL2_ISFR;
PL2_ISFR = isfr;
- th = PL2_TH();
-
- v = g.stream_to[1][g.pos_to_p[1].o][th];
- GPIOB_PDOR = PL2_ADJ(v);
- if (th) {
- do_to_step_pl1();
- g.pos_to_p[1].o = g.pos_to_p[0].o;
- }
-}
-
-/* vsync handler */
-#define VSYNC_ISFR PORTC_ISFR
-
-static void vsync_isr_nop(void)
-{
- uint32_t isfr;
- isfr = VSYNC_ISFR;
- VSYNC_ISFR = isfr;
-}
-
-// /vsync starts at line 235/259 (ntsc/pal), just as vcounter jumps back
-// we care when it comes out (/vsync goes high) after 3 lines at 238/262
-static void vsync_isr_frameinc(void)
-{
- uint32_t isfr;
-
- isfr = VSYNC_ISFR;
- VSYNC_ISFR = isfr;
-
- g.pos_to_p[0].o = (g.pos_to_p[0].o + 1) & STREAM_BUF_MASK;
- g.pos_to_p[1].o = g.pos_to_p[0].o;
-
- if (g.pos_to_p[0].o == g.pos_to_p[0].i)
- choose_isrs_idle();
- g.frame_cnt++;
-}
-
-/* "recording" data */
-static noinline void do_from_step(void)
-{
- uint32_t s;
-
- // should hopefully give atomic fixed_state read..
- s = g.pl[0].fixed_state32;
- g.pl[0].fixed_state32 = g.pl[0].pending_state32;
- g.stream_from[g.pos_from.i][0] = s;
- g.stream_from[g.pos_from.i][1] = s >> 8;
- g.pos_from.i = (g.pos_from.i + 1) & STREAM_BUF_MASK;
-}
-
-static void pl1th_isr_fixed_do_from(void)
-{
- uint32_t isfr, th;
-
- isfr = PL1_ISFR;
- PL1_ISFR = isfr;
- th = PL1_TH();
-
- GPIOD_PDOR = g.pl[0].fixed_state[th];
- if (th)
- do_from_step();
- g.edge_cnt++;
-}
-
-static void vsync_isr_frameinc_do_from(void)
-{
- uint32_t isfr;
-
- isfr = VSYNC_ISFR;
- VSYNC_ISFR = isfr;
-
- do_from_step();
- g.frame_cnt++;
+ //GPIOB_PDOR = PL2_ADJ(v);
}
/* * */
-static void choose_isrs(void)
+static void clear_state()
{
- void (*pl1th_handler)(void) = pl1th_isr_fixed;
- void (*pl2th_handler)(void) = pl2th_isr_fixed;
- void (*vsync_handler)(void) = vsync_isr_nop;
-
- if (g.stream_enable_to) {
- switch (g.inc_mode) {
- case INC_MODE_VSYNC:
- pl1th_handler = pl1th_isr_do_to;
- pl2th_handler = pl2th_isr_do_to_p1d;
- vsync_handler = vsync_isr_frameinc;
- break;
- case INC_MODE_SHARED_PL1:
- pl1th_handler = pl1th_isr_do_to_inc;
- pl2th_handler = pl2th_isr_do_to_p1d;
- break;
- case INC_MODE_SHARED_PL2:
- pl1th_handler = pl1th_isr_do_to;
- pl2th_handler = pl2th_isr_do_to_inc_pl1;
- break;
- case INC_MODE_SEPARATE:
- pl1th_handler = pl1th_isr_do_to_inc;
- pl2th_handler = pl2th_isr_do_to_inc;
- break;
- }
+ int p, i;
+
+ // no hw connected
+ for (p = 0; p < 2; p++) {
+ for (i = 0; i < 2; i++)
+ g.btn3_state[p].b[i] = 0x3f;
+ //for (i = 0; i < 4; i++)
+ // g.btn6_state[p][i] = 0x3f;
}
- else if (g.stream_enable_from) {
- g.use_pending = 1;
- switch (g.inc_mode) {
- case INC_MODE_VSYNC:
- vsync_handler = vsync_isr_frameinc_do_from;
- break;
- case INC_MODE_SHARED_PL1:
- pl1th_handler = pl1th_isr_fixed_do_from;
- break;
- case INC_MODE_SHARED_PL2:
- case INC_MODE_SEPARATE:
- /* TODO */
- break;
- }
- }
-
- attachInterruptVector(IRQ_PORTD, pl1th_handler);
- attachInterruptVector(IRQ_PORTC, pl2th_handler);
- attachInterruptVector(IRQ_PORTA, vsync_handler);
-}
-
-static noinline void choose_isrs_idle(void)
-{
- attachInterruptVector(IRQ_PORTD, pl1th_isr_fixed);
- attachInterruptVector(IRQ_PORTC, pl2th_isr_fixed);
- attachInterruptVector(IRQ_PORTA, vsync_isr_nop);
-}
-
-static void udelay(uint32_t us)
-{
- uint32_t start = micros();
- while ((micros() - start) < us) {
- asm volatile("nop; nop; nop; nop");
- yield();
- }
+ // 4 pads, nothing pressed
+ g.tp_state[0] = 0x03;
+ g.tp_state[1] = 0x0f;
+ g.tp_state[2] = 0x00;
+ g.tp_state[3] = 0x00;
+ for (i = 4; i < 8; i++)
+ g.tp_state[i] = 0x00; // 3btn
+ for (; i < 16; i++)
+ g.tp_state[i] = 0x0f;
+
+ g.cnt = 0;
+ g.pl1th = PL1_TH();
}
-static void do_start_seq(void)
+static void switch_mode(int mode)
{
- uint32_t edge_cnt_last;
- uint32_t edge_cnt;
- uint32_t start, t1, t2;
- int tout;
-
- start = micros();
- edge_cnt = g.edge_cnt;
-
- /* magic value */
- g.pl[0].fixed_state[0] =
- g.pl[0].fixed_state[1] = 0x25;
-
- for (tout = 10000; tout > 0; tout--) {
- edge_cnt_last = edge_cnt;
- udelay(100);
- edge_cnt = g.edge_cnt;
-
- if (edge_cnt != edge_cnt_last)
- continue;
- if (!PL1_TH())
- break;
- }
+ void (*pl1_handler)(void) = pl1_isr_3btn;
+ void (*pl2_handler)(void) = pl2_isr_nop;
- g.pl[0].fixed_state[0] = 0x33;
- g.pl[0].fixed_state[1] = 0x3f;
- GPIOD_PDOR = 0x33;
+ clear_state();
- t1 = micros();
- if (tout == 0) {
- printf("start_seq timeout1, t=%u\n", t1 - start);
- return;
- }
-
- for (tout = 100000; tout > 0; tout--) {
- udelay(1);
-
- if (PL1_TH())
- break;
- }
-
- t2 = micros();
- if (tout == 0) {
- printf("start_seq timeout2, t1=%u, t2=%u\n",
- t1 - start, t2 - t1);
- return;
- }
-
- //printf(" t1=%u, t2=%u\n", t1 - start, t2 - t1);
-
- if (g.stream_started) {
- printf("got start_seq when already started\n");
- return;
- }
-
- if (!g.stream_enable_to && !g.stream_enable_from) {
- printf("got start_seq, without enable from USB\n");
- return;
- }
-
- if (g.stream_enable_to && g.pos_to_p[0].i == g.pos_to_p[0].o) {
- printf("got start_seq while stream_to is empty\n");
- return;
- }
-
- if (g.stream_enable_from && g.pos_from.i != g.pos_from.o) {
- printf("got start_seq while stream_from is not empty\n");
- return;
+ switch (mode) {
+ default:
+ case OP_MODE_3BTN:
+ case OP_MODE_6BTN:
+ pinMode(20, OUTPUT);
+ break;
+ case OP_MODE_TEAMPLAYER:
+ pinMode(20, INPUT);
+ attachInterrupt(20, pl1_handler, CHANGE);
+ pl1_handler = pl1_isr_tp;
+ pl2_handler = pl2_isr_nop;
+ GPIOB_PDOR = PL2_ADJ(0x3f);
+ break;
}
- __disable_irq();
- choose_isrs();
- g.stream_started = 1;
- __enable_irq();
+ attachInterruptVector(IRQ_PORTD, pl1_handler);
+ attachInterruptVector(IRQ_PORTC, pl2_handler);
+ g.mode = mode;
}
-// callers must disable IRQs
-static void clear_state(void)
+// btns: MXYZ SACB RLDU
+static void update_btns_3btn(const struct tp_pkt *pkt, uint32_t player)
{
- int i;
-
- g.stream_enable_to = 0;
- g.stream_enable_from = 0;
- g.stream_started = 0;
- g.stream_ended = 0;
- g.inc_mode = INC_MODE_VSYNC;
- g.use_pending = 0;
- for (i = 0; i < ARRAY_SIZE(g.pos_to_p); i++)
- g.pos_to_p[i].i = g.pos_to_p[i].o = 0;
- g.pos_from.i = g.pos_from.o = 0;
- g.frame_cnt = 0;
- memset(g.stream_to[1], 0x3f, sizeof(g.stream_to[1]));
- choose_isrs_idle();
-}
+ // ?1CB RLDU ?0SA 00DU
+ uint16_t s_3btn;
-static int get_space_to(int p)
-{
- return STREAM_BUF_SIZE - ((g.pos_to_p[p].i - g.pos_to_p[p].o)
- & STREAM_BUF_MASK);
+ s_3btn = (~pkt->bnts[player] << 8) & 0x3f00;
+ s_3btn |= (~pkt->bnts[player] >> 2) & 0x0030; // SA
+ s_3btn |= (~pkt->bnts[player] ) & 0x0003; // DU
+ g.btn3_state[player].hw = s_3btn;
}
-static int get_used_from(void)
+static void update_btns_tp(const struct tp_pkt *pkt, uint32_t player)
{
- return (g.pos_from.i - g.pos_from.o) & STREAM_BUF_MASK;
+ uint8_t b0, b1;
+
+ b0 = ~pkt->bnts[player] & 0x0f;
+ b1 = (~pkt->bnts[player] >> 4) & 0x0f;
+ g.tp_state[8 + player * 2 ] = b0;
+ g.tp_state[8 + player * 2 + 1] = b1;
}
-static void do_usb(void *buf)
+static void do_usb(const void *buf)
{
- struct tas_pkt *pkt = buf;
- uint32_t pos_to_i, i, p;
- int space;
+ const struct tp_pkt *pkt = buf;
+ uint32_t i;
switch (pkt->type) {
- case PKT_FIXED_STATE:
- memcpy(&i, pkt->data, sizeof(i));
- if (g.use_pending)
- g.pl[0].pending_state32 = i;
- else
- g.pl[0].fixed_state32 = i;
- break;
- case PKT_STREAM_ENABLE:
- __disable_irq();
- clear_state();
- /* wait for start from MD */
- g.stream_enable_to = pkt->enable.stream_to;
- g.stream_enable_from = pkt->enable.stream_from;
- g.inc_mode = pkt->enable.inc_mode;
- if (pkt->enable.no_start_seq) {
- GPIOD_PDOR = 0x3f;
- choose_isrs();
- g.stream_started = 1;
- }
- __enable_irq();
- break;
- case PKT_STREAM_ABORT:
+ case PKT_UPD_MODE:
__disable_irq();
- clear_state();
+ switch_mode(pkt->mode);
__enable_irq();
break;
- case PKT_STREAM_END:
- g.stream_ended = 1;
- printf("end of stream\n");
- break;
- case PKT_STREAM_DATA_TO_P1:
- case PKT_STREAM_DATA_TO_P2:
- p = pkt->type == PKT_STREAM_DATA_TO_P1 ? 0 : 1;
- pos_to_i = g.pos_to_p[p].i;
- space = get_space_to(p);
- if (space <= pkt->size / STREAM_EL_SZ) {
- printf("got data pkt while space=%d\n", space);
- return;
- }
- for (i = 0; i < pkt->size / STREAM_EL_SZ; i++) {
- memcpy(&g.stream_to[p][pos_to_i++],
- pkt->data + i * STREAM_EL_SZ,
- STREAM_EL_SZ);
- pos_to_i &= STREAM_BUF_MASK;
+ case PKT_UPD_BTNS:
+ switch (g.mode) {
+ case OP_MODE_3BTN:
+ if (pkt->changed_players & 1)
+ update_btns_3btn(pkt, 0);
+ if (pkt->changed_players & 2)
+ update_btns_3btn(pkt, 1);
+ break;
+ case OP_MODE_TEAMPLAYER:
+ for (i = 0; i < 4; i++) {
+ if (!(pkt->changed_players & (1 << i)))
+ continue;
+ update_btns_tp(pkt, i);
+ }
}
- g.pos_to_p[p].i = pos_to_i;
break;
default:
printf("got unknown pkt type: %04x\n", pkt->type);
}
}
-static void check_get_data(int p)
-{
- struct tas_pkt pkt;
- uint8_t buf[64];
- int ret;
-
- if (get_space_to(p) <= sizeof(pkt.data) / STREAM_EL_SZ)
- return;
-
- if (g.pos_to_p[p].i == g.pos_to_p[p].o && g.frame_cnt != 0) {
- printf("underflow detected\n");
- g.stream_enable_to = 0;
- return;
- }
-
- pkt.type = PKT_STREAM_REQ;
- pkt.req.frame = g.frame_cnt;
- pkt.req.is_p2 = p;
-
- ret = usb_rawhid_send(&pkt, 1000);
- if (ret != sizeof(pkt)) {
- printf("send STREAM_REQ/%d: %d\n", p, ret);
- return;
- }
-
- ret = usb_rawhid_recv(buf, 1000);
- if (ret != 64)
- printf("usb_rawhid_recv/s: %d\n", ret);
- else
- do_usb(buf);
-}
-
int main(void)
{
uint32_t led_time = 0;
- uint32_t scheck_time = 0;
- uint32_t edge_cnt_last;
- uint32_t edge_cnt;
uint8_t buf[64];
- int i, ret;
+ int ret;
delay(1000); // wait for usb..
- /* ?0SA 00DU, ?1CB RLDU */
- for (i = 0; i < 2; i++) {
- g.pl[i].fixed_state[0] = 0x33;
- g.pl[i].fixed_state[1] = 0x3f;
- }
-
printf("starting, rawhid: %d\n", usb_rawhid_available());
- choose_isrs_idle();
+ switch_mode(OP_MODE_3BTN);
// md pin th tr tl r l d u vsync th tr tl r l d u
// 7 9 6 4 3 2 1 7 9 6 4 3 2 1
// player1
pinMode(21, INPUT);
- attachInterrupt(21, pl1th_isr_fixed, CHANGE);
+ // note: func is not used, see attachInterruptVector()
+ attachInterrupt(21, pl1_isr_3btn, CHANGE);
NVIC_SET_PRIORITY(IRQ_PORTD, 0);
pinMode( 2, OUTPUT);
// player2
pinMode(15, INPUT);
- attachInterrupt(15, pl1th_isr_fixed, CHANGE);
+ attachInterrupt(15, pl2_isr_nop, CHANGE);
NVIC_SET_PRIORITY(IRQ_PORTC, 0);
pinMode(16, OUTPUT);
pinMode( 0, OUTPUT);
pinMode( 1, OUTPUT);
- // vsync line
- pinMode(3, INPUT);
- attachInterrupt(3, vsync_isr_nop, RISING);
- NVIC_SET_PRIORITY(IRQ_PORTA, 16);
-
// led
pinMode(13, OUTPUT);
printf("BASEPRI: %d, SHPR: %08x %08x %08x\n",
ret, SCB_SHPR1, SCB_SHPR2, SCB_SHPR3);
- edge_cnt_last = g.edge_cnt;
-
while (1) {
- struct tas_pkt pkt;
uint32_t now;
- if (g.stream_enable_to && !g.stream_ended) {
- check_get_data(0);
- if (g.inc_mode == INC_MODE_SHARED_PL2
- || g.inc_mode == INC_MODE_SEPARATE)
- check_get_data(1);
- }
-
- while (g.stream_enable_from && !g.stream_ended
- && get_used_from() >= sizeof(pkt.data) / STREAM_EL_SZ)
- {
- uint32_t o;
- int i;
-
- o = g.pos_from.o;
- for (i = 0; i < sizeof(pkt.data); i += STREAM_EL_SZ) {
- memcpy(pkt.data + i, &g.stream_from[o++],
- STREAM_EL_SZ);
- o &= STREAM_BUF_MASK;
- }
- g.pos_from.o = o;
-
- pkt.type = PKT_STREAM_DATA_FROM;
- pkt.size = i;
-
- ret = usb_rawhid_send(&pkt, 1000);
- if (ret != sizeof(pkt)) {
- printf("send DATA_FROM: %d\n", ret);
- break;
- }
- }
-
now = millis();
- // start condition check
- if (now - scheck_time > 1000) {
- edge_cnt = g.edge_cnt;
- //printf("e: %d th: %d\n", edge_cnt - edge_cnt_last,
- // PL1_TH());
- if ((g.stream_enable_to || g.stream_enable_from)
- && !g.stream_started
- && edge_cnt - edge_cnt_last > 10000)
- {
- do_start_seq();
- edge_cnt = g.edge_cnt;
- }
- edge_cnt_last = edge_cnt;
- scheck_time = now;
- }
-
// led?
if (CORE_PIN13_PORTREG & CORE_PIN13_BITMASK) {
if ((int)(now - led_time) > 10)
notaz.gp2x.de / megadrive.git / commitdiff