rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2024-11-29 07:24:13 +01:00
Code Issues Releases Activity

LP-215 Set correct failsafe values if PPM stream fails.

Browse Source
This commit is contained in:
Laurent Lalanne 2016-01-17 12:10:59 +01:00
parent 0fe61b1677
commit a0d7af7f55
1 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
flight/pios/common/pios_rfm22b.c
View File

@ -1968,7 +1968,8 @@ static enum pios_radio_event radio_receivePacket(struct pios_rfm22b_dev *radio_d
if (val != RFM22B_PPM_INVALID) { if (val != RFM22B_PPM_INVALID) {
radio_dev->ppm[i] = (uint16_t)(RFM22B_PPM_MIN_US + (val - RFM22B_PPM_MIN) * RFM22B_PPM_SCALE); radio_dev->ppm[i] = (uint16_t)(RFM22B_PPM_MIN_US + (val - RFM22B_PPM_MIN) * RFM22B_PPM_SCALE);
} else { } else {
radio_dev->ppm[i] = PIOS_RCVR_INVALID; // Set failsafe value
radio_dev->ppm[i] = PIOS_RCVR_TIMEOUT;
} }
} }
@ -2117,7 +2118,7 @@ static void rfm22_updateStats(struct pios_rfm22b_dev *rfm22b_dev)
rfm22b_dev->stats.rx_error = 0; rfm22b_dev->stats.rx_error = 0;
rfm22b_dev->stats.rx_failure = 0; rfm22b_dev->stats.rx_failure = 0;
if(!rfm22_isConnected(rfm22b_dev)) { if (!rfm22_isConnected(rfm22b_dev)) {
// Set link_quality to 0 and Rssi to noise floor if disconnected // Set link_quality to 0 and Rssi to noise floor if disconnected
rfm22b_dev->stats.link_quality = 0; rfm22b_dev->stats.link_quality = 0;
rfm22b_dev->stats.rssi = -127; rfm22b_dev->stats.rssi = -127;
@ -2127,7 +2128,7 @@ static void rfm22_updateStats(struct pios_rfm22b_dev *rfm22b_dev)
// Check if connection is timed out // Check if connection is timed out
if (rfm22_checkTimeOut(rfm22b_dev)) { if (rfm22_checkTimeOut(rfm22b_dev)) {
// Set the link state to disconnected. // Set the link state to disconnected.
rfm22b_dev->stats.link_state = OPLINKSTATUS_LINKSTATE_DISCONNECTED; rfm22b_dev->stats.link_state = OPLINKSTATUS_LINKSTATE_DISCONNECTED;
} }
for (uint8_t i = 0; i < RFM22B_RX_PACKET_STATS_LEN; ++i) { for (uint8_t i = 0; i < RFM22B_RX_PACKET_STATS_LEN; ++i) {