gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-02-04 19:58:13 +00:00
Code Issues Projects Releases Wiki Activity

Important changes of the scheduler and interrupts

Browse Source
This commit is contained in:
pascallanger 2016-08-31 10:26:27 +02:00
parent b7b2799611
commit eabfd8b5c4
4 changed files with 233 additions and 169 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
Multiprotocol/FrSkyX_cc2500.ino
View File

@ -252,7 +252,6 @@ uint16_t ReadFrSkyX()
CC2500_WriteReg(CC2500_0C_FSCTRL0,option); // Frequency offset hack CC2500_WriteReg(CC2500_0C_FSCTRL0,option); // Frequency offset hack
prev_option = option ; prev_option = option ;
} }
LED_ON;
CC2500_SetTxRxMode(TX_EN); CC2500_SetTxRxMode(TX_EN);
set_start(hopping_frequency_no); set_start(hopping_frequency_no);
CC2500_SetPower(); CC2500_SetPower();

25
Multiprotocol/Multiprotocol.h
View File

@ -273,10 +273,17 @@ struct PPM_Parameters
#endif #endif
// TX // TX
#define TX_ON PORTD |= _BV(1) #ifdef DEBUG_TX
#define TX_OFF PORTD &= ~_BV(1) #define TX_ON PORTD |= _BV(1)
#define TX_TOGGLE PORTD ^= _BV(1) #define TX_OFF PORTD &= ~_BV(1)
#define TX_SET_OUTPUT DDRD |= _BV(1) #define TX_TOGGLE PORTD ^= _BV(1)
#define TX_SET_OUTPUT DDRD |= _BV(1)
#else
#define TX_ON
#define TX_OFF
#define TX_TOGGLE
#define TX_SET_OUTPUT
#endif
// Macros // Macros
#define NOP() __asm__ __volatile__("nop") #define NOP() __asm__ __volatile__("nop")
@ -329,6 +336,16 @@ struct PPM_Parameters
#define RX_MISSED_BUFF_on protocol_flags2 |= _BV(2) #define RX_MISSED_BUFF_on protocol_flags2 |= _BV(2)
#define IS_RX_MISSED_BUFF_on ( ( protocol_flags2 & _BV(2) ) !=0 ) #define IS_RX_MISSED_BUFF_on ( ( protocol_flags2 & _BV(2) ) !=0 )
#define TX_MAIN_PAUSE_off protocol_flags2 &= ~_BV(3)
#define TX_MAIN_PAUSE_on protocol_flags2 |= _BV(3)
#define IS_TX_MAIN_PAUSE_on ( ( protocol_flags2 & _BV(3) ) !=0 )
#define TX_RX_PAUSE_off protocol_flags2 &= ~_BV(4)
#define TX_RX_PAUSE_on protocol_flags2 |= _BV(4)
#define IS_TX_RX_PAUSE_on ( ( protocol_flags2 & _BV(4) ) !=0 )
#define IS_TX_PAUSE_on ( ( protocol_flags2 & (_BV(4)|_BV(3)) ) !=0 )
#define BLINK_BIND_TIME 100 #define BLINK_BIND_TIME 100
#define BLINK_SERIAL_TIME 500 #define BLINK_SERIAL_TIME 500
#define BLINK_BAD_PROTO_TIME_LOW 1000 #define BLINK_BAD_PROTO_TIME_LOW 1000

367
Multiprotocol/Multiprotocol.ino
View File

@ -22,9 +22,8 @@
*/ */
#include <avr/eeprom.h> #include <avr/eeprom.h>
#include <avr/pgmspace.h> #include <avr/pgmspace.h>
#include "Multiprotocol.h"
//#define DEBUG_TX //#define DEBUG_TX
#include "Multiprotocol.h"
//Multiprotocol module configuration file //Multiprotocol module configuration file
#include "_Config.h" #include "_Config.h"
@ -113,6 +112,7 @@ uint8_t prev_protocol=0;
#define MAX_PKT 27 #define MAX_PKT 27
uint8_t pkt[MAX_PKT];//telemetry receiving packets uint8_t pkt[MAX_PKT];//telemetry receiving packets
#if defined(TELEMETRY) #if defined(TELEMETRY)
uint8_t pass = 0;
uint8_t pktt[MAX_PKT];//telemetry receiving packets uint8_t pktt[MAX_PKT];//telemetry receiving packets
#ifndef BASH_SERIAL #ifndef BASH_SERIAL
volatile uint8_t tx_head=0; volatile uint8_t tx_head=0;
@ -215,19 +215,8 @@ void setup()
MProtocol_id_master=random_id(10,false); MProtocol_id_master=random_id(10,false);
//Init RF modules //Init RF modules
#ifdef CC2500_INSTALLED modules_reset();
CC2500_Reset();
#endif
#ifdef A7105_INSTALLED
A7105_Reset();
#endif
#ifdef CYRF6936_INSTALLED
CYRF_Reset();
#endif
#ifdef NFR24L01_INSTALLED
NRF24L01_Reset();
#endif
#ifdef ENABLE_PPM #ifdef ENABLE_PPM
//Protocol and interrupts initialization //Protocol and interrupts initialization
if(mode_select != MODE_SERIAL) if(mode_select != MODE_SERIAL)
@ -271,8 +260,99 @@ void setup()
} }
// Main // Main
// Protocol scheduler
void loop() void loop()
{
uint16_t next_callback,diff=0xFFFF;
while(1)
{
if(remote_callback==0 || diff>2*200)
{
do
{
Update_All();
}
while(remote_callback==0);
}
#ifdef XMEGA
if( (TCC1.INTFLAGS & TC1_CCAIF_bm) != 0)
{
cli(); // Disable global int due to RW of 16 bits registers
TCC1.CCA = TCC1.CNT ; // Callback should already have been called... Use "now" as new sync point.
sei(); // Enable global int
}
else
while((TCC1.INTFLAGS & TC1_CCAIF_bm) == 0); // wait before callback
#else
if( (TIFR1 & (1<<OCF1A)) != 0)
{
cli(); // Disable global int due to RW of 16 bits registers
OCR1A=TCNT1; // Callback should already have been called... Use "now" as new sync point.
sei(); // Enable global int
}
else
while((TIFR1 & (1<<OCF1A)) == 0); // Wait before callback
#endif
do
{
TX_ON;
TX_MAIN_PAUSE_on;
tx_pause();
next_callback=remote_callback();
TX_MAIN_PAUSE_off;
tx_resume();
TX_OFF;
while(next_callback>4000)
{ // start to wait here as much as we can...
next_callback-=2000; // We will wait below for 2ms
#ifdef XMEGA
cli(); // Disable global int due to RW of 16 bits registers
TCC1.CCA +=2000*2; // set compare A for callback
TCC1.INTFLAGS = TC1_CCAIF_bm ; // clear compare A=callback flag
sei(); // enable global int
Update_All();
if(IS_CHANGE_PROTOCOL_FLAG_on)
break; // Protocol has been changed
while((TCC1.INTFLAGS & TC1_CCAIF_bm) == 0); // wait 2ms...
#else
cli(); // Disable global int due to RW of 16 bits registers
OCR1A += 2000*2 ; // set compare A for callback
TIFR1=(1<<OCF1A); // clear compare A=callback flag
sei(); // enable global int
Update_All();
if(IS_CHANGE_PROTOCOL_FLAG_on)
break; // Protocol has been changed
while((TIFR1 & (1<<OCF1A)) == 0); // wait 2ms...
#endif
}
// at this point we have a maximum of 4ms in next_callback
next_callback *= 2 ;
#ifdef XMEGA
cli(); // Disable global int due to RW of 16 bits registers
TCC1.CCA +=next_callback; // set compare A for callback
TCC1.INTFLAGS = TC1_CCAIF_bm ; // clear compare A=callback flag
diff=TCC1.CCA-TCC1.CNT; // compare timer and comparator
sei(); // enable global int
#else
cli(); // Disable global int due to RW of 16 bits registers
OCR1A+= next_callback ; // set compare A for callback
TIFR1=(1<<OCF1A); // clear compare A=callback flag
diff=OCR1A-TCNT1; // compare timer and comparator
sei(); // enable global int
#endif
}
while(diff&0x8000); // Callback did not took more than requested time for next callback
// so we can launch Update_All before next callback
}
}
void Update_All()
{ {
TX_ON;
NOP();
TX_OFF;
#ifdef ENABLE_SERIAL #ifdef ENABLE_SERIAL
if(mode_select==MODE_SERIAL && IS_RX_FLAG_on) // Serial mode and something has been received if(mode_select==MODE_SERIAL && IS_RX_FLAG_on) // Serial mode and something has been received
{ {
@ -281,9 +361,8 @@ void loop()
if(IS_CHANGE_PROTOCOL_FLAG_on) if(IS_CHANGE_PROTOCOL_FLAG_on)
{ // Protocol needs to be changed { // Protocol needs to be changed
LED_OFF; //led off during protocol init LED_OFF; //led off during protocol init
module_reset(); //reset previous module modules_reset(); //reset all modules
protocol_init(); //init new protocol protocol_init(); //init new protocol
CHANGE_PROTOCOL_FLAG_off; //done
} }
} }
#endif //ENABLE_SERIAL #endif //ENABLE_SERIAL
@ -306,11 +385,13 @@ void loop()
#endif //ENABLE_PPM #endif //ENABLE_PPM
update_led_status(); update_led_status();
#if defined(TELEMETRY) #if defined(TELEMETRY)
if( ((cur_protocol[0]&0x1F)==MODE_FRSKY) || ((cur_protocol[0]&0x1F)==MODE_HUBSAN) || ((cur_protocol[0]&0x1F)==MODE_FRSKYX) || ((cur_protocol[0]&0x1F)==MODE_DSM2) ) uint8_t protocol=cur_protocol[0]&0x1F;
frskyUpdate(); if( (protocol==MODE_FRSKY) || (protocol==MODE_HUBSAN) || (protocol==MODE_FRSKYX) || (protocol==MODE_DSM2) )
#endif TelemetryUpdate();
if (remote_callback != 0) #endif
CheckTimer(remote_callback); TX_ON;
NOP();
TX_OFF;
} }
// Update Servo_AUX flags based on servo AUX positions // Update Servo_AUX flags based on servo AUX positions
@ -346,67 +427,29 @@ static void update_led_status(void)
} }
} }
// Protocol scheduler inline void tx_pause()
static void CheckTimer(uint16_t (*cb)(void)) {
{ #ifdef TELEMETRY
uint16_t next_callback,diff; #ifdef XMEGA
#ifdef XMEGA USARTC0.CTRLA &= ~0x03 ; // Pause telemetry by disabling transmitter interrupt
if( (TCC1.INTFLAGS & TC1_CCAIF_bm) != 0) #else
{ #ifndef BASH_SERIAL
cli(); // Disable global int due to RW of 16 bits registers UCSR0B &= ~(1<<UDRIE0); // Pause telemetry by disabling transmitter interrupt
TCC1.CCA = TCC1.CNT ; // Callback should already have been called... Use "now" as new sync point. #endif
sei(); // Enable global int #endif
}
else
while((TCC1.INTFLAGS & TC1_CCAIF_bm) == 0); // wait before callback
#else
if( (TIFR1 & (1<<OCF1A)) != 0)
{
cli(); // Disable global int due to RW of 16 bits registers
OCR1A=TCNT1; // Callback should already have been called... Use "now" as new sync point.
sei(); // Enable global int
}
else
while((TIFR1 & (1<<OCF1A)) == 0); // Wait before callback
#endif #endif
do }
{
next_callback=cb(); inline void tx_resume()
while(next_callback>4000) {
{ // start to wait here as much as we can... #ifdef TELEMETRY
next_callback-=2000; // We will wait below for 2ms if(!IS_TX_PAUSE_on)
#ifdef XMEGA #ifdef XMEGA
cli(); // Disable global int due to RW of 16 bits registers USARTC0.CTRLA = (USARTC0.CTRLA & 0xFC) | 0x01 ; // Resume telemetry by enabling transmitter interrupt
TCC1.CCA +=2000*2; // set compare A for callback #else
TCC1.INTFLAGS = TC1_CCAIF_bm ; // clear compare A=callback flag UCSR0B |= (1<<UDRIE0); // Resume telemetry by enabling transmitter interrupt
sei(); // enable global int #endif
while((TCC1.INTFLAGS & TC1_CCAIF_bm) == 0); // wait 2ms...
#else
cli(); // Disable global int due to RW of 16 bits registers
OCR1A += 2000*2 ; // set compare A for callback
TIFR1=(1<<OCF1A); // clear compare A=callback flag
sei(); // enable global int
while((TIFR1 & (1<<OCF1A)) == 0); // wait 2ms...
#endif #endif
}
// at this point we have a maximum of 4ms in next_callback
next_callback *= 2 ;
#ifdef XMEGA
cli(); // Disable global int due to RW of 16 bits registers
TCC1.CCA +=next_callback; // set compare A for callback
TCC1.INTFLAGS = TC1_CCAIF_bm ; // clear compare A=callback flag
diff=TCC1.CCA-TCC1.CNT; // compare timer and comparator
sei(); // enable global int
#else
cli(); // Disable global int due to RW of 16 bits registers
OCR1A+= next_callback ; // set compare A for callback
TIFR1=(1<<OCF1A); // clear compare A=callback flag
diff=OCR1A-TCNT1; // compare timer and comparator
sei(); // enable global int
#endif
}
while(diff&0x8000); // Callback did not took more than requested time for next callback
// so we can let main do its stuff before next callback
} }
// Protocol start // Protocol start
@ -415,7 +458,17 @@ static void protocol_init()
uint16_t next_callback=0; // Default is immediate call back uint16_t next_callback=0; // Default is immediate call back
remote_callback = 0; remote_callback = 0;
set_rx_tx_addr(MProtocol_id); set_rx_tx_addr(MProtocol_id); // Reset rx_tx_addr
// reset telemetry
#ifdef TELEMETRY
tx_pause();
pass=0;
telemetry_link=0;
tx_tail=0;
tx_head=0;
#endif
blink=millis(); blink=millis();
if(IS_BIND_BUTTON_FLAG_on) if(IS_BIND_BUTTON_FLAG_on)
AUTOBIND_FLAG_on; AUTOBIND_FLAG_on;
@ -424,8 +477,8 @@ static void protocol_init()
else else
BIND_DONE; BIND_DONE;
CTRL1_on; //NRF24L01 antenna RF3 by default CTRL1_on; //NRF24L01 antenna RF3 by default
CTRL2_off; //NRF24L01 antenna RF3 by default CTRL2_off; //NRF24L01 antenna RF3 by default
switch(cur_protocol[0]&0x1F) // Init the requested protocol switch(cur_protocol[0]&0x1F) // Init the requested protocol
{ {
@ -624,8 +677,8 @@ static void protocol_init()
void update_serial_data() void update_serial_data()
{ {
RX_FLAG_off; //data has been processed
RX_DONOTUPDTAE_on; RX_DONOTUPDTAE_on;
RX_FLAG_off; //data is being processed
if(rx_ok_buff[0]&0x20) //check range if(rx_ok_buff[0]&0x20) //check range
RANGE_FLAG_on; RANGE_FLAG_on;
else else
@ -653,6 +706,8 @@ void update_serial_data()
else else
if( ((rx_ok_buff[0]&0x80)!=0) && ((cur_protocol[0]&0x80)==0) ) // Bind flag has been set if( ((rx_ok_buff[0]&0x80)!=0) && ((cur_protocol[0]&0x80)==0) ) // Bind flag has been set
CHANGE_PROTOCOL_FLAG_on; //restart protocol with bind CHANGE_PROTOCOL_FLAG_on; //restart protocol with bind
else
CHANGE_PROTOCOL_FLAG_off; //no need to restart
cur_protocol[0] = rx_ok_buff[0]; //store current protocol cur_protocol[0] = rx_ok_buff[0]; //store current protocol
// decode channel values // decode channel values
@ -676,9 +731,10 @@ void update_serial_data()
UCSR0B &= ~(1<<RXCIE0); // RX interrupt disable UCSR0B &= ~(1<<RXCIE0); // RX interrupt disable
#endif #endif
if(IS_RX_MISSED_BUFF_on) // If the buffer is still valid if(IS_RX_MISSED_BUFF_on) // If the buffer is still valid
memcpy((void*)rx_ok_buff,(const void*)rx_buff,RXBUFFER_SIZE);// Duplicate the buffer { memcpy((void*)rx_ok_buff,(const void*)rx_buff,RXBUFFER_SIZE);// Duplicate the buffer
RX_FLAG_on; // data to be processed next time... RX_FLAG_on; // data to be processed next time...
RX_MISSED_BUFF_off; RX_MISSED_BUFF_off;
}
#ifdef XMEGA #ifdef XMEGA
sei(); sei();
#else #else
@ -686,33 +742,24 @@ void update_serial_data()
#endif #endif
} }
void module_reset() void modules_reset()
{ {
if(remote_callback) #ifdef CC2500_INSTALLED
{ // previous protocol loaded CC2500_Reset();
remote_callback = 0; #endif
switch(prev_protocol) #ifdef A7105_INSTALLED
{ A7105_Reset();
case MODE_FLYSKY: #endif
case MODE_HUBSAN: #ifdef CYRF6936_INSTALLED
A7105_Reset(); CYRF_Reset();
break; #endif
case MODE_FRSKY: #ifdef NFR24L01_INSTALLED
case MODE_FRSKYX: NRF24L01_Reset();
case MODE_SFHSS: #endif
CC2500_Reset();
break; //Wait for every component to reset
case MODE_DSM2: delayMilliseconds(100);
case MODE_DEVO: prev_power=0xFD; // unused power value
case MODE_J6PRO:
CYRF_Reset();
break;
default: // MODE_HISKY, MODE_V2X2, MODE_YD717, MODE_KN, MODE_SYMAX, MODE_SLT, MODE_CX10, MODE_CG023, MODE_BAYANG, MODE_ESKY, MODE_MT99XX, MODE_MJXQ, MODE_SHENQI, MODE_FY326, MODE_FQ777, MODE_ASSAN
NRF24L01_Reset();
break;
}
}
prev_power=0xFD; // unused power value
} }
int16_t map( int16_t x, int16_t in_min, int16_t in_max, int16_t out_min, int16_t out_max) int16_t map( int16_t x, int16_t in_min, int16_t in_max, int16_t out_min, int16_t out_max)
@ -872,12 +919,9 @@ void SPI_Write(uint8_t command)
SDI_on; SDI_on;
else else
SDI_off; SDI_off;
NOP();
SCK_on; SCK_on;
NOP();
command = command << 1; command = command << 1;
SCK_off; SCK_off;
NOP();
} }
while(--n) ; while(--n) ;
SDI_on; SDI_on;
@ -894,7 +938,6 @@ uint8_t SPI_Read(void)
SCK_on; SCK_on;
NOP(); NOP();
SCK_off; SCK_off;
NOP();
} }
return result; return result;
} }
@ -1058,52 +1101,47 @@ ISR(USART_RX_vect)
#endif #endif
{ // RX interrupt { // RX interrupt
static uint8_t idx=0; static uint8_t idx=0;
#ifdef XMEGA #ifdef XMEGA
if((USARTC0.STATUS & 0x1C)==0) // Check frame error, data overrun and parity error if((USARTC0.STATUS & 0x1C)==0) // Check frame error, data overrun and parity error
#else #else
UCSR0B &= ~(1<<RXCIE0) ; // RX interrupt disable UCSR0B &= ~(1<<RXCIE0) ; // RX interrupt disable
sei() ; sei() ;
if((UCSR0A&0x1C)==0) // Check frame error, data overrun and parity error if((UCSR0A&0x1C)==0) // Check frame error, data overrun and parity error
#endif #endif
{ // received byte is ok to process { // received byte is ok to process
if(idx==0||discard_frame==1) if(idx==0||discard_frame==1)
{ // Let's try to sync at this point { // Let's try to sync at this point
idx=0;discard_frame=0; idx=0;discard_frame=0;
#ifdef XMEGA #ifdef XMEGA
if(USARTC0.DATA==0x55) // If 1st byte is 0x55 it looks ok if(USARTC0.DATA==0x55) // If 1st byte is 0x55 it looks ok
#else #else
if(UDR0==0x55) // If 1st byte is 0x55 it looks ok if(UDR0==0x55) // If 1st byte is 0x55 it looks ok
#endif #endif
{ {
#ifdef XMEGA TX_RX_PAUSE_on;
TCC1.CCB = TCC1.CNT+(6500L) ; // Full message should be received within timer of 3250us tx_pause();
TCC1.INTFLAGS = TC1_CCBIF_bm ; // clear OCR1B match flag #ifdef XMEGA
TCC1.INTCTRLB = (TCC1.INTCTRLB & 0xF3) | 0x04 ; // enable interrupt on compare B match TCC1.CCB = TCC1.CNT+(6500L) ; // Full message should be received within timer of 3250us
#else TCC1.INTFLAGS = TC1_CCBIF_bm ; // clear OCR1B match flag
OCR1B=TCNT1+6500L; // Full message should be received within timer of 3250us TCC1.INTCTRLB = (TCC1.INTCTRLB & 0xF3) | 0x04 ; // enable interrupt on compare B match
TIFR1=(1<<OCF1B); // clear OCR1B match flag #else
TIMSK1 |=(1<<OCIE1B); // enable interrupt on compare B match OCR1B=TCNT1+6500L; // Full message should be received within timer of 3250us
#endif TIFR1=(1<<OCF1B); // clear OCR1B match flag
TIMSK1 |=(1<<OCIE1B); // enable interrupt on compare B match
#endif
idx++; idx++;
} }
} }
else else
{ {
RX_MISSED_BUFF_off; // if rx_buff was good it's not anymore... RX_MISSED_BUFF_off; // if rx_buff was good it's not anymore...
#ifdef XMEGA #ifdef XMEGA
rx_buff[(idx++)-1]=USARTC0.DATA; // Store received byte rx_buff[(idx++)-1]=USARTC0.DATA; // Store received byte
#else #else
rx_buff[(idx++)-1]=UDR0; // Store received byte rx_buff[(idx++)-1]=UDR0; // Store received byte
#endif #endif
if(idx>RXBUFFER_SIZE) if(idx>RXBUFFER_SIZE)
{ // A full frame has been received { // A full frame has been received
#ifdef XMEGA
TCC1.INTCTRLB &=0xF3; // disable interrupt on compare B match
#else
TIMSK1 &=~(1<<OCIE1B); // disable interrupt on compare B match
#endif
if(!IS_RX_DONOTUPDTAE_on) if(!IS_RX_DONOTUPDTAE_on)
{ //Good frame received and main is not working on the buffer { //Good frame received and main is not working on the buffer
memcpy((void*)rx_ok_buff,(const void*)rx_buff,RXBUFFER_SIZE);// Duplicate the buffer memcpy((void*)rx_ok_buff,(const void*)rx_buff,RXBUFFER_SIZE);// Duplicate the buffer
@ -1111,24 +1149,33 @@ ISR(USART_RX_vect)
} }
else else
RX_MISSED_BUFF_on; // notify that rx_buff is good RX_MISSED_BUFF_on; // notify that rx_buff is good
idx=0; // start again discard_frame=1; // start again
} }
} }
} }
else else
{ {
#ifdef XMEGA #ifdef XMEGA
idx = USARTC0.DATA; // Dummy read idx = USARTC0.DATA; // Dummy read
#else #else
idx=UDR0; // Dummy read idx=UDR0; // Dummy read
#endif #endif
discard_frame=1; // Error encountered discard full frame... discard_frame=1; // Error encountered discard full frame...
} }
if(discard_frame==1)
#ifndef XMEGA {
cli() ; #ifdef XMEGA
UCSR0B |= (1<<RXCIE0) ; // RX interrupt enable TCC1.INTCTRLB &=0xF3; // Disable interrupt on compare B match
#endif #else
TIMSK1 &=~(1<<OCIE1B); // Disable interrupt on compare B match
#endif
TX_RX_PAUSE_off;
tx_resume();
}
#ifndef XMEGA
cli() ;
UCSR0B |= (1<<RXCIE0) ; // RX interrupt enable
#endif
} }
//Serial timer //Serial timer
@ -1140,5 +1187,11 @@ ISR(TIMER1_COMPB_vect, ISR_NOBLOCK )
#endif #endif
{ // Timer1 compare B interrupt { // Timer1 compare B interrupt
discard_frame=1; discard_frame=1;
#ifdef XMEGA
TCC1.INTCTRLB &=0xF3; // Disable interrupt on compare B match
#else
TIMSK1 &=~(1<<OCIE1B); // Disable interrupt on compare B match
#endif
tx_resume();
} }
#endif //ENABLE_SERIAL #endif //ENABLE_SERIAL

9
Multiprotocol/Telemetry.ino
View File

@ -26,7 +26,6 @@
uint8_t pktx[MAX_PKTX]; uint8_t pktx[MAX_PKTX];
uint8_t pktx1[MAX_PKTX]; uint8_t pktx1[MAX_PKTX];
uint8_t index; uint8_t index;
uint8_t pass = 0;
uint8_t frame[18]; uint8_t frame[18];
#ifdef BASH_SERIAL #ifdef BASH_SERIAL
@ -395,7 +394,7 @@ void proces_sport_data(uint8_t data)
#endif #endif
void frskyUpdate() void TelemetryUpdate()
{ {
#if defined SPORT_TELEMETRY #if defined SPORT_TELEMETRY
if ((cur_protocol[0]&0x1F)==MODE_FRSKYX) if ((cur_protocol[0]&0x1F)==MODE_FRSKYX)
@ -503,11 +502,7 @@ void Serial_write(uint8_t data)
nextHead = 0 ; nextHead = 0 ;
tx_buff[nextHead]=data; tx_buff[nextHead]=data;
tx_head = nextHead ; tx_head = nextHead ;
#ifdef XMEGA tx_resume();
USARTC0.CTRLA = (USARTC0.CTRLA & 0xFC) | 0x01 ;
#else
UCSR0B |= (1<<UDRIE0);//enable UDRE interrupt
#endif
} }
// Speed is 0 for 100K and 1 for 9600 // Speed is 0 for 100K and 1 for 9600