teensy3lib: do level masking instead of disable

[megadrive.git] / main.c

diff --git a/main.c b/main.c
index 8287fb5..37be879 100644 (file)
--- a/main.c
+++ b/main.c
@@ -26,11 +26,7 @@ void yield(void)
 {
 }
 
-static void pin0_irq(void)
-{
-}
-
-void portb_isr(void)
+static void my_portb_isr(void)
 {
        uint32_t isfr;
 
@@ -44,7 +40,9 @@ void portb_isr(void)
 
 int main(void)
 {
-       //int ret;
+       char buf[64];
+       int timeout;
+       int ret;
 
        delay(1000); // wait for usb..
 
@@ -56,7 +54,8 @@ int main(void)
        // t pin     0 20  6  8  7 14  2
        // * - note: tl/tr mixed in most docs
        pinMode(0, INPUT);
-       attachInterrupt(0, pin0_irq, CHANGE);
+       attachInterrupt(0, my_portb_isr, CHANGE);
+       attachInterruptVector(IRQ_PORTB, my_portb_isr);
 
        pinMode( 2, OUTPUT);
        pinMode(14, OUTPUT);
@@ -75,16 +74,27 @@ int main(void)
        printf("GPIOD PDDR, PDIR: %08x %08x\n", GPIOD_PDIR, GPIOD_PDDR);
        printf("PORTB_PCR16: %08x\n", PORTB_PCR16);
 
-       // ret = usb_rawhid_recv(buf, 2000);
        // ret = usb_rawhid_send(buf, 2000);
 
-       while (1) {
-               delay(4000);
-               fixed_state[1] &= ~0x20;
-               CORE_PIN13_PORTSET = CORE_PIN13_BITMASK;
+       timeout = 1000;
 
-               delay(700);
-               fixed_state[1] |= 0x20;
-               CORE_PIN13_PORTCLEAR = CORE_PIN13_BITMASK;
+       while (1) {
+               ret = usb_rawhid_recv(buf, timeout);
+               if (ret == 64) {
+                       CORE_PIN13_PORTSET = CORE_PIN13_BITMASK;
+
+                       memcpy(fixed_state, buf, sizeof(fixed_state));
+                       timeout = 20;
+               }
+               else if (ret == 0) {
+                       CORE_PIN13_PORTCLEAR = CORE_PIN13_BITMASK;
+                       timeout = 1000;
+               }
+               else {
+                       printf("usb_rawhid_recv: %d\n", ret);
+                       timeout = 1000;
+               }
        }
+
+       return 0;
 }