Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-30 20:48:33 -04:00
Code Issues Packages Projects Releases Wiki Activity

Failsafe: only read RC on new data

Browse Source
This commit is contained in:
Andrew Tridgell 2012-08-05 14:46:13 +10:00
parent 9c19ff1a2c
commit 26749a7486
1 changed files with 5 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
Tools/Failsafe/Failsafe.pde
View File

@ -10,6 +10,7 @@ version 2.1 of the License, or (at your option) any later version.
// Libraries
#include <FastSerial.h>
#include <AP_Common.h>
#include <AP_Math.h>
#include <Arduino_Mega_ISR_Registry.h>
#include <APM_RC.h> // ArduPilot Mega RC Library
@ -52,8 +53,10 @@ void loop()
uint32_t tnow = millis();
uint8_t heartbeat_pin = digitalRead(HEARTBEAT_PIN);
// to minimise latency run the main loop at 200Hz
delay(5);
// see if we have a new radio frame
if (APM_RC.GetState() != 1) {
return;
}
if (heartbeat_pin != last_heartbeat) {
last_heartbeat = heartbeat_pin;