transmit 6 servos instead of 3

[protos/rc_servos.git] / main.c

diff --git a/main.c b/main.c
index 923a8ea1bcd4ce553b2b089644768e77294f0b6c..f06bc44b4f92191d8be816fe52afd4c7a8d0ccb0 100644 (file)
--- a/main.c
+++ b/main.c
@@ -120,7 +120,7 @@ static void poll_spi(void)
                SPDR = byte1_tx.u8;
        }
        spi_out_idx ++;
-       if (spi_out_idx >= NB_SERVO)
+       if (spi_out_idx >= NB_SERVO * 2)
                spi_out_idx = 0;
 
        /* RX */
@@ -177,7 +177,7 @@ static void poll_input_capture(void)
        icp = ICR1;
        sei();
 
-       rising = TCCR1B & _BV(ICES1);
+       rising = !!(TCCR1B & _BV(ICES1));
 
        /* change the edge type */
        TCCR1B ^= _BV(ICES1);