2 * TeensyTP, Team Player/4-Player Adaptor implementation for Teensy3
3 * using a host machine with USB hub
4 * Copyright (c) 2015 notaz
6 * Permission is hereby granted, free of charge, to any person obtaining
7 * a copy of this software and associated documentation files (the
8 * "Software"), to deal in the Software without restriction, including
9 * without limitation the rights to use, copy, modify, merge, publish,
10 * distribute, sublicense, and/or sell copies of the Software, and to
11 * permit persons to whom the Software is furnished to do so, subject to
12 * the following conditions:
14 * The above copyright notice and this permission notice shall be
15 * included in all copies or substantial portions of the Software.
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
18 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
19 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
20 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
21 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
22 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
23 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30 #include "teensy3/core_pins.h"
31 #include "teensy3/usb_seremu.h"
32 #include "teensy3/usb_rawhid.h"
35 #define ARRAY_SIZE(x) (sizeof(x) / sizeof(x[0]))
37 #define noinline __attribute__((noclone,noinline))
39 ssize_t _write(int fd, const void *buf, size_t nbyte)
44 if (fd != 1 && fd != 2) {
45 snprintf(tbuf, sizeof(tbuf), "write to fd %d\n", fd);
46 usb_seremu_write(tbuf, strlen(tbuf));
49 ret = usb_seremu_write(buf, nbyte);
50 return ret < 0 ? ret : nbyte;
58 * 00157:231: w 70 @ 007ef2
59 * 00157:231: r 7f @ 007f06
60 * 00157:231: w 30 @ 007efa
61 * 00157:231: r 33 @ 007f06
62 * 00157:232: w 40 @ 007f6a
63 * 00157:232: r 7f @ 007f70
66 /* ?0SA 00DU, ?1CB RLDU */
72 uint8_t b6[4 * 2]; // 6btn
73 uint32_t w; // for more atomic change
75 uint32_t phase; // 6btn
87 #define PL1_ISFR PORTD_ISFR
88 #define PL1_TH() ((CORE_PIN21_PINREG >> CORE_PIN21_BIT) & 1)
89 #define PL1_TR() ((CORE_PIN20_PINREG >> CORE_PIN20_BIT) & 1)
90 #define PL1_TH_MASK CORE_PIN21_BITMASK
91 #define PL1_TR_MASK CORE_PIN20_BITMASK
93 static void pl1_isr_3btn(void)
100 GPIOD_PDOR = g.btn_state[0].b[PL1_TH()];
103 static void pl1_isr_6btn(void)
105 uint32_t isfr, th, phase = 0;
112 g.btn_state[0].phase++;
113 if (g.btn_state[0].phase < 4)
114 phase = g.btn_state[0].phase;
116 GPIOD_PDOR = g.btn_state[0].b[(phase << 1) | PL1_TH()];
117 g.btn_state[0].time = millis();
121 static noinline void pl1_isr_tp_do_th(void)
128 GPIOD_PDOR = g.tp_state[cnt] | (PL1_TR() << 4);
133 static void pl1_isr_tp(void)
140 if (isfr & PL1_TH_MASK)
142 if (!(isfr & PL1_TR_MASK))
148 GPIOD_PDOR = g.tp_state[g.tp_cnt & 0x0f] | (PL1_TR() << 4);
152 #define PL2_ISFR PORTC_ISFR
153 #define PL2_TH() ((CORE_PIN15_PINREG >> CORE_PIN15_BIT) & 1)
154 #define PL2_ADJ(x) ((x) | ((x) << 12))
156 static void pl2_isr_nop(void)
163 GPIOB_PDOR = PL2_ADJ(0x3f);
166 static void pl2_isr_3btn(void)
173 GPIOB_PDOR = PL2_ADJ(g.btn_state[1].b[PL2_TH()]);
176 static void pl2_isr_6btn(void)
178 uint32_t isfr, th, phase = 0;
185 g.btn_state[1].phase++;
186 if (g.btn_state[1].phase < 4)
187 phase = g.btn_state[1].phase;
189 GPIOB_PDOR = PL2_ADJ(g.btn_state[1].b[(phase << 1) | PL2_TH()]);
190 g.btn_state[1].time = millis();
194 static void clear_state()
199 for (p = 0; p < 2; p++) {
200 for (i = 0; i < 4 * 2; i++)
201 g.btn_state[p].b6[i] = 0x3f;
202 g.btn_state[p].phase = 0;
205 // 4 pads, nothing pressed
206 g.tp_state[0] = 0x03;
207 g.tp_state[1] = 0x0f;
208 g.tp_state[2] = 0x00;
209 g.tp_state[3] = 0x00;
210 for (i = 4; i < 8; i++)
211 g.tp_state[i] = 0x00; // 3btn
213 g.tp_state[i] = 0x0f;
219 static void switch_mode(int mode)
221 void (*pl1_handler)(void) = pl1_isr_3btn;
222 void (*pl2_handler)(void) = pl2_isr_3btn;
233 pl1_handler = pl1_isr_6btn;
234 pl2_handler = pl2_isr_6btn;
236 case OP_MODE_TEAMPLAYER:
238 attachInterrupt(20, pl1_handler, CHANGE);
239 pl1_handler = pl1_isr_tp;
240 pl2_handler = pl2_isr_nop;
241 GPIOB_PDOR = PL2_ADJ(0x3f);
245 attachInterruptVector(IRQ_PORTD, pl1_handler);
246 attachInterruptVector(IRQ_PORTC, pl2_handler);
250 // btns: MXYZ SACB RLDU
251 static void update_btns_btn(const struct tp_pkt *pkt, uint32_t player)
253 // ?1CB RLDU ?0SA 00DU
254 uint32_t s_6btn0, s_6btn1;
257 s_3btn = (~pkt->bnts[player] << 8) & 0x3f00;
258 s_3btn |= (~pkt->bnts[player] >> 2) & 0x0030; // SA
259 s_3btn |= (~pkt->bnts[player] ) & 0x0003; // DU
260 s_3btn |= s_3btn << 16;
261 g.btn_state[player].w = s_3btn;
264 s_6btn0 = s_3btn & 0x30;
265 s_6btn1 = s_3btn >> 8;
266 g.btn_state[player].b6[4] = s_6btn0; // ?0SA 0000
267 g.btn_state[player].b6[5] = s_6btn1; // ?1CB RLDU
268 g.btn_state[player].b6[6] = s_6btn0 | 0x0f; // ?0SA 1111
270 s_6btn1 |= (~pkt->bnts[player] >> 8) & 0x0f;
271 g.btn_state[player].b6[7] = s_6btn1; // ?1CB MXYZ
274 static void update_btns_tp(const struct tp_pkt *pkt, uint32_t player)
278 b0 = ~pkt->bnts[player] & 0x0f;
279 b1 = (~pkt->bnts[player] >> 4) & 0x0f;
280 g.tp_state[8 + player * 2 ] = b0;
281 g.tp_state[8 + player * 2 + 1] = b1;
284 static void do_usb(const void *buf)
286 const struct tp_pkt *pkt = buf;
292 switch_mode(pkt->mode);
299 if (pkt->changed_players & 1)
300 update_btns_btn(pkt, 0);
301 if (pkt->changed_players & 2)
302 update_btns_btn(pkt, 1);
304 case OP_MODE_TEAMPLAYER:
305 for (i = 0; i < 4; i++) {
306 if (!(pkt->changed_players & (1 << i)))
308 update_btns_tp(pkt, i);
313 printf("got unknown pkt type: %04x\n", pkt->type);
320 uint32_t led_time = 0;
324 delay(1000); // wait for usb..
326 printf("starting, rawhid: %d\n", usb_rawhid_available());
328 switch_mode(OP_MODE_3BTN);
330 // md pin th tr tl r l d u vsync th tr tl r l d u
331 // 7 9 6 4 3 2 1 7 9 6 4 3 2 1
332 // md bit* 6 5 4 3 2 1 0 6 5 4 3 2 1 0
333 // t bit d6 d5 d4 d3 d2 d1 d0 a12 c0 b17 b16 b3 b2 b1 b0
334 // t pin 21 20 6 8 7 14 2 3 15 1 0 18 19 17 16
335 // * - note: tl/tr mixed in most docs
339 // note: func is not used, see attachInterruptVector()
340 attachInterrupt(21, pl1_isr_3btn, CHANGE);
341 NVIC_SET_PRIORITY(IRQ_PORTD, 0);
352 attachInterrupt(15, pl2_isr_nop, CHANGE);
353 NVIC_SET_PRIORITY(IRQ_PORTC, 0);
365 // lower other priorities
366 SCB_SHPR1 = SCB_SHPR2 = SCB_SHPR3 = 0x10101010;
368 // CORE_PIN0_PORTSET CORE_PIN0_BITMASK PORTB_PCR16
369 printf("GPIOB PDDR, PDIR: %08x %08x\n", GPIOB_PDIR, GPIOB_PDDR);
370 printf("GPIOC PDDR, PDIR: %08x %08x\n", GPIOC_PDIR, GPIOC_PDDR);
371 printf("GPIOD PDDR, PDIR: %08x %08x\n", GPIOD_PDIR, GPIOD_PDDR);
372 printf("PORTB_PCR16: %08x\n", PORTB_PCR16);
373 printf("PORTC_PCR6: %08x\n", PORTC_PCR6);
374 printf("PORTD_PCR0: %08x\n", PORTD_PCR0);
376 asm("mrs %0, BASEPRI" : "=r"(ret));
377 printf("BASEPRI: %d, SHPR: %08x %08x %08x\n",
378 ret, SCB_SHPR1, SCB_SHPR2, SCB_SHPR3);
384 for (i = 0; i < 2; i++) {
385 if (g.btn_state[i].phase == 0)
387 if (now - g.btn_state[i].time > 1)
388 g.btn_state[i].phase = 0;
392 if (CORE_PIN13_PORTREG & CORE_PIN13_BITMASK) {
393 if ((int)(now - led_time) > 10)
394 CORE_PIN13_PORTCLEAR = CORE_PIN13_BITMASK;
397 // something on rawhid?
398 if (usb_rawhid_available() > 0)
400 ret = usb_rawhid_recv(buf, 20);
403 CORE_PIN13_PORTSET = CORE_PIN13_BITMASK;
408 printf("usb_rawhid_recv: %d\n", ret);