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 */
73 //uint8_t btn6_state[2][4];
82 #define PL1_ISFR PORTD_ISFR
83 #define PL1_TH() ((CORE_PIN21_PINREG >> CORE_PIN21_BIT) & 1)
84 #define PL1_TR() ((CORE_PIN20_PINREG >> CORE_PIN20_BIT) & 1)
85 #define PL1_TH_MASK CORE_PIN21_BITMASK
86 #define PL1_TR_MASK CORE_PIN20_BITMASK
88 static void pl1_isr_3btn(void)
95 GPIOD_PDOR = g.btn3_state[0].b[PL1_TH()];
98 static noinline void pl1_isr_tp_do_th(void)
105 GPIOD_PDOR = g.tp_state[cnt] | (PL1_TR() << 4);
110 static void pl1_isr_tp(void)
117 if (isfr & PL1_TH_MASK)
119 if (!(isfr & PL1_TR_MASK))
125 GPIOD_PDOR = g.tp_state[g.cnt & 0x0f] | (PL1_TR() << 4);
129 #define PL2_ISFR PORTC_ISFR
130 #define PL2_TH() ((CORE_PIN15_PINREG >> CORE_PIN15_BIT) & 1)
131 #define PL2_ADJ(x) ((x) | ((x) << 12))
133 static void pl2_isr_nop(void)
140 //GPIOB_PDOR = PL2_ADJ(v);
144 static void clear_state()
149 for (p = 0; p < 2; p++) {
150 for (i = 0; i < 2; i++)
151 g.btn3_state[p].b[i] = 0x3f;
152 //for (i = 0; i < 4; i++)
153 // g.btn6_state[p][i] = 0x3f;
156 // 4 pads, nothing pressed
157 g.tp_state[0] = 0x03;
158 g.tp_state[1] = 0x0f;
159 g.tp_state[2] = 0x00;
160 g.tp_state[3] = 0x00;
161 for (i = 4; i < 8; i++)
162 g.tp_state[i] = 0x00; // 3btn
164 g.tp_state[i] = 0x0f;
170 static void switch_mode(int mode)
172 void (*pl1_handler)(void) = pl1_isr_3btn;
173 void (*pl2_handler)(void) = pl2_isr_nop;
183 case OP_MODE_TEAMPLAYER:
185 attachInterrupt(20, pl1_handler, CHANGE);
186 pl1_handler = pl1_isr_tp;
187 pl2_handler = pl2_isr_nop;
188 GPIOB_PDOR = PL2_ADJ(0x3f);
192 attachInterruptVector(IRQ_PORTD, pl1_handler);
193 attachInterruptVector(IRQ_PORTC, pl2_handler);
197 // btns: MXYZ SACB RLDU
198 static void update_btns_3btn(const struct tp_pkt *pkt, uint32_t player)
200 // ?1CB RLDU ?0SA 00DU
203 s_3btn = (~pkt->bnts[player] << 8) & 0x3f00;
204 s_3btn |= (~pkt->bnts[player] >> 2) & 0x0030; // SA
205 s_3btn |= (~pkt->bnts[player] ) & 0x0003; // DU
206 g.btn3_state[player].hw = s_3btn;
209 static void update_btns_tp(const struct tp_pkt *pkt, uint32_t player)
213 b0 = ~pkt->bnts[player] & 0x0f;
214 b1 = (~pkt->bnts[player] >> 4) & 0x0f;
215 g.tp_state[8 + player * 2 ] = b0;
216 g.tp_state[8 + player * 2 + 1] = b1;
219 static void do_usb(const void *buf)
221 const struct tp_pkt *pkt = buf;
227 switch_mode(pkt->mode);
233 if (pkt->changed_players & 1)
234 update_btns_3btn(pkt, 0);
235 if (pkt->changed_players & 2)
236 update_btns_3btn(pkt, 1);
238 case OP_MODE_TEAMPLAYER:
239 for (i = 0; i < 4; i++) {
240 if (!(pkt->changed_players & (1 << i)))
242 update_btns_tp(pkt, i);
247 printf("got unknown pkt type: %04x\n", pkt->type);
254 uint32_t led_time = 0;
258 delay(1000); // wait for usb..
260 printf("starting, rawhid: %d\n", usb_rawhid_available());
262 switch_mode(OP_MODE_3BTN);
264 // md pin th tr tl r l d u vsync th tr tl r l d u
265 // 7 9 6 4 3 2 1 7 9 6 4 3 2 1
266 // md bit* 6 5 4 3 2 1 0 6 5 4 3 2 1 0
267 // t bit d6 d5 d4 d3 d2 d1 d0 a12 c0 b17 b16 b3 b2 b1 b0
268 // t pin 21 20 6 8 7 14 2 3 15 1 0 18 19 17 16
269 // * - note: tl/tr mixed in most docs
273 // note: func is not used, see attachInterruptVector()
274 attachInterrupt(21, pl1_isr_3btn, CHANGE);
275 NVIC_SET_PRIORITY(IRQ_PORTD, 0);
286 attachInterrupt(15, pl2_isr_nop, CHANGE);
287 NVIC_SET_PRIORITY(IRQ_PORTC, 0);
299 // lower other priorities
300 SCB_SHPR1 = SCB_SHPR2 = SCB_SHPR3 = 0x10101010;
302 // CORE_PIN0_PORTSET CORE_PIN0_BITMASK PORTB_PCR16
303 printf("GPIOB PDDR, PDIR: %08x %08x\n", GPIOB_PDIR, GPIOB_PDDR);
304 printf("GPIOC PDDR, PDIR: %08x %08x\n", GPIOC_PDIR, GPIOC_PDDR);
305 printf("GPIOD PDDR, PDIR: %08x %08x\n", GPIOD_PDIR, GPIOD_PDDR);
306 printf("PORTB_PCR16: %08x\n", PORTB_PCR16);
307 printf("PORTC_PCR6: %08x\n", PORTC_PCR6);
308 printf("PORTD_PCR0: %08x\n", PORTD_PCR0);
310 asm("mrs %0, BASEPRI" : "=r"(ret));
311 printf("BASEPRI: %d, SHPR: %08x %08x %08x\n",
312 ret, SCB_SHPR1, SCB_SHPR2, SCB_SHPR3);
320 if (CORE_PIN13_PORTREG & CORE_PIN13_BITMASK) {
321 if ((int)(now - led_time) > 10)
322 CORE_PIN13_PORTCLEAR = CORE_PIN13_BITMASK;
325 // something on rawhid?
326 if (usb_rawhid_available() > 0)
328 ret = usb_rawhid_recv(buf, 20);
331 CORE_PIN13_PORTSET = CORE_PIN13_BITMASK;
336 printf("usb_rawhid_recv: %d\n", ret);