From 2181d0b33cf4c87656a1abe0e69bf2a8e6752de6 Mon Sep 17 00:00:00 2001 From: Pascal Langer Date: Sun, 26 Nov 2017 08:41:55 +0100 Subject: [PATCH] Final bit bashing fix? --- Multiprotocol/Telemetry.ino | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/Multiprotocol/Telemetry.ino b/Multiprotocol/Telemetry.ino index 52af18a..9b8d9bf 100644 --- a/Multiprotocol/Telemetry.ino +++ b/Multiprotocol/Telemetry.ino @@ -975,7 +975,7 @@ void Serial_write( uint8_t byte ) byte |= 1 ; // Start bit #endif uint8_t next = SerialControl.head + 2; - if(next>TXBUFFER_SIZE) + if(next>=TXBUFFER_SIZE) next=0; if ( next != SerialControl.tail ) { @@ -1069,7 +1069,7 @@ ISR(TIMER0_COMPB_vect) GPIOR0 = ptr->data[ptr->tail] ; GPIOR2 = ptr->data[ptr->tail+1] ; uint8_t nextTail = ptr->tail + 2 ; - if ( nextTail > TXBUFFER_SIZE ) + if ( nextTail >= TXBUFFER_SIZE ) nextTail = 0 ; ptr->tail = nextTail ; GPIOR1 = 8 ; @@ -1112,7 +1112,7 @@ ISR(TIMER0_OVF_vect) GPIOR0 = ptr->data[ptr->tail] ; GPIOR2 = ptr->data[ptr->tail+1] ; uint8_t nextTail = ptr->tail + 2 ; - if ( nextTail > TXBUFFER_SIZE ) + if ( nextTail >= TXBUFFER_SIZE ) nextTail = 0 ; ptr->tail = nextTail ; GPIOR1 = 10 ;