diff --git a/Multiprotocol/Hisky_nrf24l01.ino b/Multiprotocol/Hisky_nrf24l01.ino index 4076f7a..d413cbe 100644 --- a/Multiprotocol/Hisky_nrf24l01.ino +++ b/Multiprotocol/Hisky_nrf24l01.ino @@ -144,10 +144,14 @@ uint16_t hisky_cb() NRF24L01_SetPower(); phase=2; break; + case 3: + if (! bind_counter) + NRF24L01_WritePayload(packet,10); // 2 packets per 5ms + break; case 4: phase=6; break; - case 7: // build packet and send failsafe every 100ms + case 7: // build packet with failsafe every 100ms convert_channel_HK310(hopping_frequency_no!=0?RUDDER:AUX2,&packet[0],&packet[1]); convert_channel_HK310(hopping_frequency_no!=0?THROTTLE:AUX3,&packet[2],&packet[3]); convert_channel_HK310(hopping_frequency_no!=0?AUX1:AUX4,&packet[4],&packet[5]); diff --git a/Multiprotocol/Multiprotocol.ino b/Multiprotocol/Multiprotocol.ino index 543a12c..89084f1 100644 --- a/Multiprotocol/Multiprotocol.ino +++ b/Multiprotocol/Multiprotocol.ino @@ -150,6 +150,9 @@ void setup() // Read or create protocol id MProtocol_id_master=random_id(10,false); + //Init RF modules + CC2500_Reset(); + //Protocol and interrupts initialization if(mode_select != MODE_SERIAL) { // PPM @@ -481,7 +484,6 @@ static void module_reset() case MODE_FRSKYX: CC2500_Reset(); break; - break; case MODE_DSM2: case MODE_DEVO: CYRF_Reset();