gomaomao/DIY-Multiprotocol-TX-Module
1
0
Fork 0
mirror of https://github.com/pascallanger/DIY-Multiprotocol-TX-Module.git synced 2025-07-01 10:17:53 +00:00
Code Issues Projects Releases Wiki Activity

SGF22 telem improvement?

Browse Source
This commit is contained in:
pascallanger 2025-04-16 07:53:47 +02:00
parent 9ef2415178
commit e556f5cc40
2 changed files with 19 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

18
Multiprotocol/SGF22_nrf24l01.ino
View File

@ -169,6 +169,7 @@ uint16_t SGF22_callback()
{ {
#ifdef SGF22_HUB_TELEMETRY #ifdef SGF22_HUB_TELEMETRY
bool rx = false; bool rx = false;
static uint8_t telem_count = 0;
#endif #endif
switch(phase) switch(phase)
@ -195,6 +196,8 @@ uint16_t SGF22_callback()
{//packets: 00 0B 00 -> 00 0B 01 {//packets: 00 0B 00 -> 00 0B 01
telemetry_link = 1; telemetry_link = 1;
v_lipo1 = packet_in[2] ? 0 : 255; //2.9V for 1S, 7.0V for 2S v_lipo1 = packet_in[2] ? 0 : 255; //2.9V for 1S, 7.0V for 2S
telemetry_lost = 0;
telem_count = 0;
} }
#if 0 #if 0
debug("L %d ",p_len); debug("L %d ",p_len);
@ -204,6 +207,20 @@ uint16_t SGF22_callback()
debugln(""); debugln("");
#endif #endif
} }
if(telem_count > 4*63) // Around 3.5sec with no telemetry
telemetry_lost = 1;
else
{
telem_count++;
if(!telemetry_lost && (telem_count & 0x3F) == 0)
{// Should have received a telem packet but... Send telem to the radio to keep it alive
telemetry_link = 1;
#if 0
debugln("Miss");
#endif
}
}
#endif #endif
phase++; phase++;
break; break;
@ -245,6 +262,7 @@ void SGF22_init()
phase = SGF22_DATA1; phase = SGF22_DATA1;
#ifdef SGF22_HUB_TELEMETRY #ifdef SGF22_HUB_TELEMETRY
RX_RSSI = 100; // Dummy value RX_RSSI = 100; // Dummy value
telemetry_lost = 1;
#endif #endif
} }

2
Multiprotocol/V761_nrf24l01.ino
View File

@ -244,7 +244,7 @@ uint16_t V761_callback()
else else
{ {
packet_count++; packet_count++;
if(!telemetry_lost && !rx && (packet_count%64) == 0) if(!telemetry_lost && !rx && (packet_count & 0x3F) == 0)
{// Should have received a telem packet but... Send telem to the radio to keep it alive {// Should have received a telem packet but... Send telem to the radio to keep it alive
telemetry_link = 1; telemetry_link = 1;
#ifdef V761_TELEM_DEBUG #ifdef V761_TELEM_DEBUG