rc_servos: implement bypass mode

diff --git a/main.c b/main.c
index a27bf10b821ae74236ec19e6ba77324ea936a304..53fd747dc8b45f40a82bc523c3e4045ec2901f97 100644 (file)
--- a/main.c
+++ b/main.c
@@ -24,6 +24,7 @@ static volatile uint8_t rxbuf[16];
 register uint8_t rxlen asm("r2");
 register uint8_t done asm("r3");
 register uint8_t portval asm("r4");
+register uint8_t bypass asm("r5");
 
 SIGNAL(TIMER1_COMPA_vect)
 {
@@ -94,6 +95,10 @@ int main(void)
                                break;
                        poll_spi();
                }
+               /* bypass mode */
+               while (bypass == 1) {
+                       PORTC = PORTB;
+               }
        }
 
        return 0;