Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

faster FS timer

This commit is contained in:
Jason Short 2012-02-09 22:20:20 -08:00
parent 0f3c3bb563
commit 471bd12799
1 changed files with 6 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
ArduCopter/radio.pde
View File

@ -144,7 +144,7 @@ static void read_radio()
throttle_failsafe(g.rc_3.radio_in); throttle_failsafe(g.rc_3.radio_in);
} }
} }
#define FS_COUNTER 3
static void throttle_failsafe(uint16_t pwm) static void throttle_failsafe(uint16_t pwm)
{ {
// Don't enter Failsafe if not enabled by user // Don't enter Failsafe if not enabled by user
@ -157,19 +157,19 @@ static void throttle_failsafe(uint16_t pwm)
// we detect a failsafe from radio // we detect a failsafe from radio
// throttle has dropped below the mark // throttle has dropped below the mark
failsafeCounter++; failsafeCounter++;
if (failsafeCounter == 9){ if (failsafeCounter == FS_COUNTER-1){
// //
}else if(failsafeCounter == 10) { }else if(failsafeCounter == FS_COUNTER) {
// Don't enter Failsafe if we are not armed // Don't enter Failsafe if we are not armed
// home distance is in meters // home distance is in meters
// This is to prevent accidental RTL // This is to prevent accidental RTL
if((motor_armed == true) && (home_distance > 1000) && (current_loc.alt > 400)){ if((motor_armed == true) && (home_distance > 1000)){
SendDebug("MSG FS ON "); SendDebug("MSG FS ON ");
SendDebugln(pwm, DEC); SendDebugln(pwm, DEC);
set_failsafe(true); set_failsafe(true);
} }
}else if (failsafeCounter > 10){ }else if (failsafeCounter > FS_COUNTER){
failsafeCounter = 11; failsafeCounter = FS_COUNTER+1;
} }
}else if(failsafeCounter > 0){ }else if(failsafeCounter > 0){