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

Update Propel_nrf24l01.ino

Browse Source
This commit is contained in:
Pascal Langer 2021-10-24 11:04:57 +02:00
parent fff3b8830e
commit 694d968e8c
1 changed files with 7 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
Multiprotocol/Propel_nrf24l01.ino
View File

@ -250,11 +250,16 @@ uint16_t PROPEL_callback()
if (_BV(NRF24L01_07_RX_DR) & NRF24L01_ReadReg(NRF24L01_07_STATUS)) if (_BV(NRF24L01_07_RX_DR) & NRF24L01_ReadReg(NRF24L01_07_STATUS))
{// data received from the model {// data received from the model
NRF24L01_ReadPayload(packet_in, PROPEL_PACKET_SIZE); NRF24L01_ReadPayload(packet_in, PROPEL_PACKET_SIZE);
#if 1
for(uint8_t i=0; i<PROPEL_PACKET_SIZE; i++)
debug("%02X ",packet_in[i]);
debugln("");
#endif
if (packet_in[0] == 0xa3 && memcmp(&packet_in[1],rx_id,3)==0) if (packet_in[0] == 0xa3 && memcmp(&packet_in[1],rx_id,3)==0)
{ {
telemetry_counter++; //LQI telemetry_counter++; //LQI
v_lipo1=packet[5]; //number of life left? v_lipo1=packet_in[5]; //number of life left?
v_lipo2=packet[4]; //bit mask: 0x80=flying, 0x08=taking off, 0x04=landing, 0x00=landed/crashed v_lipo2=packet_in[4]; //bit mask: 0x80=flying, 0x08=taking off, 0x04=landing, 0x00=landed/crashed
if(telemetry_lost==0) if(telemetry_lost==0)
telemetry_link=1; telemetry_link=1;
} }