diff --git a/Multiprotocol/Multiprotocol.ino b/Multiprotocol/Multiprotocol.ino index 392e51e..dfff25d 100644 --- a/Multiprotocol/Multiprotocol.ino +++ b/Multiprotocol/Multiprotocol.ino @@ -407,6 +407,7 @@ inline void tx_resume() { #ifdef TELEMETRY if(!IS_TX_PAUSE_on) + { #ifdef XMEGA USARTC0.CTRLA = (USARTC0.CTRLA & 0xFC) | 0x01 ; // Resume telemetry by enabling transmitter interrupt #else @@ -414,6 +415,7 @@ inline void tx_resume() UCSR0B |= _BV(UDRIE0); // Resume telemetry by enabling transmitter interrupt #endif #endif + } #endif } @@ -430,8 +432,10 @@ static void protocol_init() tx_pause(); pass=0; telemetry_link=0; - tx_tail=0; - tx_head=0; + #ifndef BASH_SERIAL + tx_tail=0; + tx_head=0; + #endif #endif blink=millis();