Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
18 changes: 17 additions & 1 deletion Multiprotocol/FX_nrf24l01.ino
Original file line number Diff line number Diff line change
Expand Up @@ -282,7 +282,7 @@ uint16_t FX_callback()
{
#ifdef FX_HUB_TELEMETRY
bool rx=false;

static uint8_t telem_count = 0;
switch(phase)
{
case FX_DATA:
Expand Down Expand Up @@ -319,6 +319,8 @@ uint16_t FX_callback()
if(XN297_ReadPayload(packet_in, FX_QF012_RX_PAYLOAD_SIZE))
{//Good CRC
telemetry_link = 1;
telemetry_lost = 0;
telem_count = 0;
if ( sub_protocol == FX_BM26 )
v_lipo1 = packet_in[0] < packet_in[2] ? 60:81; // packets: AA 00 55 -> 55 00 AA = low voltage 3.7V
else
Expand All @@ -330,6 +332,19 @@ uint16_t FX_callback()
}
debugln();
}
if(telem_count > 4*63) // Around 3.5 sec 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
}
}
phase++;
return FX9630_WRITE_TIME;
default: //FX_RX
Expand Down Expand Up @@ -362,6 +377,7 @@ void FX_init()
bind_counter=FX_BIND_COUNT;
#ifdef FX_HUB_TELEMETRY
RX_RSSI = 100; // Dummy value
telemetry_lost = 1;
phase = FX_DATA;
#endif
}
Expand Down
5 changes: 3 additions & 2 deletions Protocols_Details.md
Original file line number Diff line number Diff line change
Expand Up @@ -1871,15 +1871,16 @@ FX9630 and FX9603 Gyro: -100%=6G small throw, 0%=6G large throw, +100%=3D
QIDI-550 Gyro: -100%=3D, 0%=6G, +100%=Torque

### Sub_protocol Q560 - *3*
Model: QIDI-560
Model: QIDI-560, QIDI-580 (Cirrus SR22)

CH1|CH2|CH3|CH4|CH5|CH6|CH7
---|---|---|---|---|---|---
A|E|T|R|FLIP|GYRO|LEDs

FLIP is a toggle channel meaning that -100% to +100% is a command and +100% to -100% is also a command

Gyro: -100%=6G, 0%=3D+Gyro, +100%=3D
- GYRO QIDI-560: -100%=6G, 0%=3D+Gyro, +100%=3D
- GYRO QIDI-580: -100%=6G, 0%=6G+Inverted, +100%=3D+Gyro

### Sub_protocol QF012 - *4*
Model: QF012 SBD Dauntless
Expand Down
Loading