rusefi
/
atbetaflight
mirror of https://github.com/rusefi/atbetaflight.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Merge remote-tracking branch 'cleanflight/sbus-rx-failsafe'

This commit is contained in:
Dominic Clifton 2015-03-04 20:37:47 +00:00
parent 3e73b3de53 1c9ebf9437
commit 0b1de28e95
2 changed files with 19 additions and 21 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/main/rx/rx.c
View File

@ -294,11 +294,9 @@ void processRxChannels(void)
void processDataDrivenRx(void) void processDataDrivenRx(void)
{ {
if (!rcDataReceived) { if (rcDataReceived) {
return;
}
failsafe->vTable->reset(); failsafe->vTable->reset();
}
processRxChannels(); processRxChannels();

34
src/main/rx/sbus.c
View File

@ -176,25 +176,10 @@ bool sbusFrameComplete(void)
sbusFrameDone = false; sbusFrameDone = false;
#ifdef DEBUG_SBUS_PACKETS #ifdef DEBUG_SBUS_PACKETS
sbusStateFlags = 0;
debug[1] = sbusFrame.frame.flags; debug[1] = sbusFrame.frame.flags;
#endif #endif
if (sbusFrame.frame.flags & SBUS_FLAG_SIGNAL_LOSS) {
// internal failsafe enabled and rx failsafe flag set
#ifdef DEBUG_SBUS_PACKETS
sbusStateFlags |= SBUS_STATE_SIGNALLOSS;
debug[0] |= SBUS_STATE_SIGNALLOSS;
#endif
}
if (sbusFrame.frame.flags & SBUS_FLAG_FAILSAFE_ACTIVE) {
#ifdef DEBUG_SBUS_PACKETS
sbusStateFlags |= SBUS_STATE_FAILSAFE;
debug[0] = sbusStateFlags;
#endif
// internal failsafe enabled and rx failsafe flag set
return false;
}
sbusChannelData[0] = sbusFrame.frame.chan0; sbusChannelData[0] = sbusFrame.frame.chan0;
sbusChannelData[1] = sbusFrame.frame.chan1; sbusChannelData[1] = sbusFrame.frame.chan1;
sbusChannelData[2] = sbusFrame.frame.chan2; sbusChannelData[2] = sbusFrame.frame.chan2;
@ -224,8 +209,23 @@ bool sbusFrameComplete(void)
sbusChannelData[17] = SBUS_DIGITAL_CHANNEL_MIN; sbusChannelData[17] = SBUS_DIGITAL_CHANNEL_MIN;
} }
if (sbusFrame.frame.flags & SBUS_FLAG_SIGNAL_LOSS) {
#ifdef DEBUG_SBUS_PACKETS
sbusStateFlags |= SBUS_STATE_SIGNALLOSS;
debug[0] = sbusStateFlags;
#endif
}
if (sbusFrame.frame.flags & SBUS_FLAG_FAILSAFE_ACTIVE) {
// internal failsafe enabled and rx failsafe flag set
#ifdef DEBUG_SBUS_PACKETS
sbusStateFlags |= SBUS_STATE_FAILSAFE;
debug[0] = sbusStateFlags;
#endif
// RX *should* still be sending valid channel data, so use it.
return false;
}
#ifdef DEBUG_SBUS_PACKETS #ifdef DEBUG_SBUS_PACKETS
sbusStateFlags = 0;
debug[0] = sbusStateFlags; debug[0] = sbusStateFlags;
#endif #endif
return true; return true;