Invert serial atmega bug correction

This commit is contained in:
Pascal Langer 2017-11-25 09:32:00 +01:00
parent 7d41017850
commit 41d579dc23
2 changed files with 4 additions and 2 deletions

View File

@ -327,7 +327,7 @@ enum FailSafeMode {
#define IS_EXTRA_TELEMETRY_ON (multi_config & 0x04)
// Failsafe
#define failsafeToPPM(i) (Failsafe_data[i]* 5/8+860)
#define failsafeToPPM(i) (Failsafe_data[i]* 5/8+860)
#define isNormalFailsafeChanel(i) (Failsafe_data[i] != FAILSAFE_CHANNEL_HOLD && Failsafe_data[i] != FAILSAFE_CHANNEL_NOPULSES)

View File

@ -974,7 +974,9 @@ void Serial_write( uint8_t byte )
#ifdef INVERT_SERIAL
byte |= 1 ; // Start bit
#endif
uint8_t next = (SerialControl.head + 2) & 0x7f ;
uint8_t next = SerialControl.head + 2;
if(next>TXBUFFER_SIZE)
next=0;
if ( next != SerialControl.tail )
{
SerialControl.data[SerialControl.head] = byte ;