From f20de073955d85e0f7594a40056674cab99fe79c Mon Sep 17 00:00:00 2001 From: notaz Date: Fri, 3 Oct 2014 02:44:03 +0300 Subject: [PATCH] first working gmv streamer --- host/main.c | 243 +++++++++++++++++++++++++++++++++++++++++++++------- main.c | 211 +++++++++++++++++++++++++++++++++++++++++++-- pkts.h | 26 ++++++ 3 files changed, 438 insertions(+), 42 deletions(-) create mode 100644 pkts.h diff --git a/host/main.c b/host/main.c index a7f57d2..e372b2b 100644 --- a/host/main.c +++ b/host/main.c @@ -14,6 +14,7 @@ #include #include #include +#include "../pkts.h" #define ARRAY_SIZE(x) (sizeof(x) / sizeof(x[0])) @@ -392,6 +393,29 @@ int do_evdev_input(int fd) return memcmp(old_state, fixed_input_state, STATE_BYTES) ? 1 : 0; } +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]; +}; + +static int submit_urb(int fd, struct usbdevfs_urb *urb, int ep, + void *buf, size_t buf_size) +{ + memset(urb, 0, sizeof(*urb)); + urb->type = USBDEVFS_URB_TYPE_INTERRUPT; + urb->endpoint = ep; + urb->buffer = buf; + urb->buffer_length = buf_size; + + return ioctl(fd, USBDEVFS_SUBMITURB, urb); +} + enum my_urbs { URB_DATA_IN, URB_DATA_OUT, @@ -401,7 +425,7 @@ enum my_urbs { int main(int argc, char *argv[]) { - char buf_dbg[64 + 1], buf_in[64], buf_out[64]; + const char *tasfn = NULL; struct teensy_dev dev; struct usbdevfs_urb urb[URB_CNT]; struct usbdevfs_urb *reaped_urb; @@ -413,22 +437,44 @@ int main(int argc, char *argv[]) int dbg_in_sent = 0; int data_in_sent = 0; fd_set rfds, wfds; + struct gmv_tas *gmv = NULL; + int enable_sent = 0; + int frame_count = 0; + int frames_sent = 0; + char buf_dbg[64 + 1]; + struct tas_pkt pkt_in; + struct tas_pkt pkt_out; + struct timeval *timeout = NULL; + struct timeval tout; int i, ret; int fd; for (i = 1; i < argc; i++) { + if (argv[i][0] == '-') { + if (strcmp(argv[i], "-m") != 0) { + fprintf(stderr, "bad arg: %s\n", argv[i]); + return 1; + } + i++; + if (argv[i] == NULL) { + fprintf(stderr, "missing arg\n"); + return 1; + } + tasfn = argv[i]; + continue; + } if (evdev_fd_cnt >= ARRAY_SIZE(evdev_fds)) { fprintf(stderr, "too many evdevs\n"); break; } - fd = open(argv[i], O_RDONLY); + 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)), + ret = ioctl(fd, EVIOCGBIT(0, sizeof(evdev_support)), &evdev_support); if (ret < 0) perror("EVIOCGBIT"); @@ -440,6 +486,72 @@ int main(int argc, char *argv[]) evdev_fds[evdev_fd_cnt++] = fd; } + if (tasfn != NULL) { + long size; + FILE *f; + + f = fopen(tasfn, "rb"); + if (f == NULL) { + fprintf(stderr, "fopen %s: ", tasfn); + perror(""); + return 1; + } + + fseek(f, 0, SEEK_END); + size = ftell(f); + fseek(f, 0, SEEK_SET); + 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); + perror(""); + return 1; + } + fclose(f); + frame_count = (size - sizeof(*gmv)) / 3; + + /* 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); + } + enable_echo(0); signal(SIGINT, signal_handler); @@ -464,34 +576,35 @@ int main(int argc, char *argv[]) wait_device = 0; data_in_sent = 0; dbg_in_sent = 0; + enable_sent = 0; + frames_sent = 0; + + /* we wait first, then send commands, but if teensy + * is started already, it won't send anything */ + tout.tv_sec = 1; + tout.tv_usec = 0; + timeout = &tout; } if (!data_in_sent) { - memset(&urb[URB_DATA_IN], 0, sizeof(urb[URB_DATA_IN])); - urb[URB_DATA_IN].type = USBDEVFS_URB_TYPE_INTERRUPT; - urb[URB_DATA_IN].endpoint = dev.ifaces[0].ep_in; - urb[URB_DATA_IN].buffer = buf_in; - urb[URB_DATA_IN].buffer_length = sizeof(buf_in); - - ret = ioctl(dev.fd, USBDEVFS_SUBMITURB, &urb[URB_DATA_IN]); + memset(&pkt_in, 0, sizeof(pkt_in)); + ret = submit_urb(dev.fd, &urb[URB_DATA_IN], dev.ifaces[0].ep_in, + &pkt_in, sizeof(pkt_in)); if (ret != 0) { perror("USBDEVFS_SUBMITURB URB_DATA_IN"); break; } + data_in_sent = 1; } if (!dbg_in_sent) { - memset(&urb[URB_DBG_IN], 0, sizeof(urb[URB_DBG_IN])); - urb[URB_DBG_IN].type = USBDEVFS_URB_TYPE_INTERRUPT; - urb[URB_DBG_IN].endpoint = dev.ifaces[1].ep_in; - urb[URB_DBG_IN].buffer = buf_dbg; - urb[URB_DBG_IN].buffer_length = sizeof(buf_dbg) - 1; - - ret = ioctl(dev.fd, USBDEVFS_SUBMITURB, &urb[URB_DBG_IN]); + ret = submit_urb(dev.fd, &urb[URB_DBG_IN], dev.ifaces[1].ep_in, + buf_dbg, sizeof(buf_dbg) - 1); if (ret != 0) { perror("USBDEVFS_SUBMITURB URB_DBG_IN"); break; } + dbg_in_sent = 1; } @@ -502,11 +615,12 @@ int main(int argc, char *argv[]) FD_ZERO(&wfds); FD_SET(dev.fd, &wfds); - ret = select(dev.fd + 1, &rfds, &wfds, NULL, NULL); + ret = select(dev.fd + 1, &rfds, &wfds, NULL, timeout); if (ret < 0) { perror("select"); break; } + timeout = NULL; /* something from input devices? */ fixed_input_changed = 0; @@ -518,7 +632,8 @@ int main(int argc, char *argv[]) } /* something from USB? */ - if (FD_ISSET(dev.fd, &wfds)) { + if (FD_ISSET(dev.fd, &wfds)) + { reaped_urb = NULL; ret = ioctl(dev.fd, USBDEVFS_REAPURB, &reaped_urb); if (ret != 0) { @@ -530,7 +645,11 @@ int main(int argc, char *argv[]) if (reaped_urb != NULL && reaped_urb->status != 0) { errno = -reaped_urb->status; - perror("urb status"); + if ((unsigned long)(reaped_urb - urb) < ARRAY_SIZE(urb)) + fprintf(stderr, "urb #%zu: ", reaped_urb - urb); + else + fprintf(stderr, "unknown urb: "); + perror(""); if (reaped_urb->status == -EILSEQ) { /* this is usually a sign of disconnect.. */ usleep(250000); @@ -539,10 +658,60 @@ int main(int argc, char *argv[]) } if (reaped_urb == &urb[URB_DATA_IN]) { - printf("*data*\n"); + /* some request from teensy */ + int count; + uint8_t b; + + switch (pkt_in.type) { + case PKT_STREAM_REQ: + printf("%d/%d\n", frames_sent, frame_count); + + for (i = 0; i < sizeof(pkt_out.data); i++) { + pkt_out.data[i * 2 + 0] = 0x33; + pkt_out.data[i * 2 + 1] = 0x3f; + } + if (frames_sent < frame_count) { + pkt_out.type = PKT_STREAM_DATA; + + count = frame_count - frames_sent; + if (count > sizeof(pkt_out.data) / 2) + count = sizeof(pkt_out.data) / 2; + for (i = 0; i < count; i++) { + /* SCBA RLDU */ + b = gmv->data[frames_sent][0]; + + /* ?0SA 00DU, ?1CB RLDU */ + pkt_out.data[i * 2 + 0] = (b & 0x13) | ((b >> 2) & 0x20); + pkt_out.data[i * 2 + 1] = (b & 0x0f) | ((b >> 1) & 0x30); + + if (gmv->data[frames_sent][1] != 0xff + || gmv->data[frames_sent][2] != 0xff) + { + fprintf(stderr, "f %d: unhandled byte(s) %02x %02x\n", + frames_sent, gmv->data[frames_sent][1], + gmv->data[frames_sent][2]); + } + + frames_sent++; + } + } + 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 URB_DATA_OUT PKT_STREAM_DATA"); + break; + + default: + printf("host: got unknown pkt type: %04x\n", pkt_in.type); + break; + } + data_in_sent = 0; } - if (reaped_urb == &urb[URB_DATA_OUT]) { + else if (reaped_urb == &urb[URB_DATA_OUT]) { } else if (reaped_urb == &urb[URB_DBG_IN]) { /* debug text */ @@ -551,22 +720,30 @@ int main(int argc, char *argv[]) dbg_in_sent = 0; } else { - fprintf(stderr, "reaped unknown urb? %p\n", reaped_urb); + fprintf(stderr, "reaped unknown urb? %p #%zu\n", + reaped_urb, reaped_urb - urb); } } /* something to send? */ - if (fixed_input_changed) { - memset(buf_out, 0, sizeof(buf_out)); - memcpy(buf_out, fixed_input_state, sizeof(fixed_input_state)); - - memset(&urb[URB_DATA_OUT], 0, sizeof(urb[URB_DATA_OUT])); - urb[URB_DATA_OUT].type = USBDEVFS_URB_TYPE_INTERRUPT; - urb[URB_DATA_OUT].endpoint = dev.ifaces[0].ep_out; - urb[URB_DATA_OUT].buffer = buf_out; - urb[URB_DATA_OUT].buffer_length = sizeof(buf_out); + if (gmv != NULL && !enable_sent) { + memset(&pkt_out, 0, sizeof(pkt_out)); + pkt_out.type = PKT_STREAM_ENABLE; + 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_ENABLE"); + continue; + } + enable_sent = 1; + } + if (gmv == 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 = ioctl(dev.fd, USBDEVFS_SUBMITURB, &urb[URB_DATA_OUT]); + 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 URB_DATA_OUT"); break; diff --git a/main.c b/main.c index 37be879..72b3acd 100644 --- a/main.c +++ b/main.c @@ -4,9 +4,25 @@ #include "teensy3/core_pins.h" #include "teensy3/usb_seremu.h" #include "teensy3/usb_rawhid.h" +#include "pkts.h" + +// use power of 2 +#define STREAM_BUF_SIZE 512 +#define STREAM_BUF_MASK (512 - 1) /* ?0SA 00DU, ?1CB RLDU */ -static uint8_t fixed_state[4] = { 0x33, 0x3f }; +static struct { + uint8_t stream[STREAM_BUF_SIZE][2]; + uint8_t fixed_state[4]; + uint32_t stream_enable:1; + uint32_t stream_started:1; + uint32_t stream_received:1; + uint32_t edge_cnt; + uint32_t i; + uint32_t o; +} g; + +#define STREAM_EL_SZ sizeof(g.stream[0]) ssize_t _write(int fd, const void *buf, size_t nbyte) { @@ -28,24 +44,169 @@ void yield(void) static void my_portb_isr(void) { - uint32_t isfr; + uint32_t isfr, th; //printf("irq, GPIOB_PDIR: %08x\n", GPIOB_PDIR); - GPIOD_PDOR = fixed_state[(GPIOB_PDIR >> CORE_PIN0_BIT) & 1]; - isfr = PORTB_ISFR; PORTB_ISFR = isfr; + th = (GPIOB_PDIR >> CORE_PIN0_BIT) & 1; + + if (g.stream_started) { + GPIOD_PDOR = g.stream[g.o][th]; + if (th) { + g.o = (g.o + 1) & STREAM_BUF_MASK; + if (g.o == g.i) { + g.stream_started = 0; + g.stream_enable = 0; + } + } + } + else { + GPIOD_PDOR = g.fixed_state[th]; + } + g.edge_cnt++; +} + +static void udelay(uint32_t us) +{ + uint32_t start = micros(); + + while ((micros() - start) < us) { + asm volatile("nop; nop; nop; nop"); + yield(); + } +} + +static void do_start_seq(void) +{ + 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.fixed_state[0] = + g.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 (!(GPIOB_PDIR & CORE_PIN0_BITMASK)) + break; + } + + g.fixed_state[0] = 0x33; + g.fixed_state[1] = 0x3f; + GPIOD_PDOR = 0x33; + + t1 = micros(); + if (tout == 0) { + printf("start_seq timeout1, t=%u\n", t1 - start); + return; + } + + for (tout = 100000; tout > 0; tout--) { + udelay(1); + + if (GPIOB_PDIR & CORE_PIN0_BITMASK) + 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) { + printf("got start_seq, without enable from USB\n"); + return; + } + + if (g.i == g.o) { + printf("got start_seq while buffer is empty\n"); + return; + } + + g.stream_started = 1; +} + +static int get_space(void) +{ + return STREAM_BUF_SIZE - ((g.i - g.o) & STREAM_BUF_MASK); +} + +static void do_usb(void *buf) +{ + struct tas_pkt *pkt = buf; + uint32_t i, g_i; + int space; + + switch (pkt->type) { + case PKT_FIXED_STATE: + memcpy(g.fixed_state, pkt->data, sizeof(g.fixed_state)); + break; + case PKT_STREAM_ENABLE: + g.stream_enable = 1; + g.stream_started = 0; + g.stream_received = 0; + g.i = g.o = 0; + break; + case PKT_STREAM_END: + g.stream_received = 1; + printf("end of data\n"); + break; + case PKT_STREAM_DATA: + g_i = g.i; + space = get_space(); + if (space <= sizeof(pkt->data) / STREAM_EL_SZ) { + printf("got data pkt while space=%d\n", space); + return; + } + for (i = 0; i < sizeof(pkt->data) / STREAM_EL_SZ; i++) { + memcpy(&g.stream[g_i++], + pkt->data + i * STREAM_EL_SZ, + STREAM_EL_SZ); + g_i &= STREAM_BUF_MASK; + } + g.i = g_i; + break; + default: + printf("got unknown pkt type: %04x\n", pkt->type); + break; + } } int main(void) { - char buf[64]; + uint32_t edge_cnt_last; + uint32_t edge_cnt; + uint8_t buf[64]; int timeout; int ret; delay(1000); // wait for usb.. + /* ?0SA 00DU, ?1CB RLDU */ + g.fixed_state[0] = 0x33; + g.fixed_state[1] = 0x3f; + printf("starting, rawhid: %d\n", usb_rawhid_available()); // md pin th tr tl r l d u @@ -57,6 +218,9 @@ int main(void) attachInterrupt(0, my_portb_isr, CHANGE); attachInterruptVector(IRQ_PORTB, my_portb_isr); + // NVIC_SET_PRIORITY(104, 0); // portb + NVIC_SET_PRIORITY(IRQ_PORTB, 0); // portb + pinMode( 2, OUTPUT); pinMode(14, OUTPUT); pinMode( 7, OUTPUT); @@ -66,24 +230,53 @@ int main(void) // led pinMode(13, OUTPUT); - // CORE_PIN13_PORTSET = CORE_PIN13_BITMASK; - // CORE_PIN13_PORTCLEAR = CORE_PIN13_BITMASK; // CORE_PIN0_PORTSET CORE_PIN0_BITMASK PORTB_PCR16 printf("GPIOC PDDR, PDIR: %08x %08x\n", GPIOC_PDIR, GPIOC_PDDR); printf("GPIOD PDDR, PDIR: %08x %08x\n", GPIOD_PDIR, GPIOD_PDDR); printf("PORTB_PCR16: %08x\n", PORTB_PCR16); - // ret = usb_rawhid_send(buf, 2000); + asm("mrs %0, BASEPRI" : "=r"(ret)); + printf("BASEPRI: %d\n", ret); timeout = 1000; + edge_cnt_last = g.edge_cnt; while (1) { + struct tas_pkt pkt; + while (g.stream_enable && !g.stream_received + && get_space() > sizeof(pkt.data) / STREAM_EL_SZ) + { + pkt.type = PKT_STREAM_REQ; + ret = usb_rawhid_send(&pkt, 1000); + if (ret != sizeof(pkt)) { + printf("send STREAM_REQ: %d\n", ret); + break; + } + + ret = usb_rawhid_recv(buf, 1000); + if (ret != 64) + printf("usb_rawhid_recv/s: %d\n", ret); + else + do_usb(buf); + } + + if (timeout == 1000) { + edge_cnt = g.edge_cnt; + //printf("e: %d th: %d\n", edge_cnt - edge_cnt_last, + // (GPIOB_PDIR >> CORE_PIN0_BIT) & 1); + if (edge_cnt - edge_cnt_last > 10000) { + do_start_seq(); + edge_cnt = g.edge_cnt; + } + edge_cnt_last = edge_cnt; + } + ret = usb_rawhid_recv(buf, timeout); if (ret == 64) { CORE_PIN13_PORTSET = CORE_PIN13_BITMASK; - memcpy(fixed_state, buf, sizeof(fixed_state)); + do_usb(buf); timeout = 20; } else if (ret == 0) { diff --git a/pkts.h b/pkts.h new file mode 100644 index 0000000..86e24b8 --- /dev/null +++ b/pkts.h @@ -0,0 +1,26 @@ + +enum tas_pkt_type { + PKT_FIXED_STATE = 0xef01, + PKT_STREAM_ENABLE = 0xef02, + PKT_STREAM_REQ = 0xef03, + PKT_STREAM_DATA = 0xef04, + PKT_STREAM_END = 0xef06, + PKT_STREAM_ABORT = 0xef07, +}; + +struct tas_pkt { + uint16_t type; + uint16_t size; // for DATA_FROM/TO + union { + uint8_t data[60]; + struct { + uint32_t frame; // just fyi + } req; + struct { + uint8_t stream_to; + uint8_t stream_from; + // frame increment on read + uint8_t use_readinc; + } enable; + }; +} __attribute__((packed)); -- 2.39.5