fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-07-03 10:00:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

if V_RCL_LT < 0 go directly to termination

Browse Source
This commit is contained in:
Thomas Gubler
2014-09-07 15:31:58 +02:00
parent 21009e89a4
commit a8239b2c45
2 changed files with 13 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/navigator/rcloss.cpp
+11 -4
View File
@@ -153,10 +153,17 @@ RCLoss::advance_rcl()
{
switch (_rcl_state) {
case RCL_STATE_NONE:
/* Check the number of data link losses. If above home fly home directly */
warnx("RC loss, OBC mode, loiter");
mavlink_log_info(_navigator->get_mavlink_fd(), "#audio: rc loss, loitering");
_rcl_state = RCL_STATE_LOITER;
if (_param_loitertime.get() > 0.0f) {
warnx("RC loss, OBC mode, loiter");
mavlink_log_info(_navigator->get_mavlink_fd(), "#audio: rc loss, loitering");
_rcl_state = RCL_STATE_LOITER;
} else {
warnx("RC loss, OBC mode, slip loiter, terminate");
mavlink_log_info(_navigator->get_mavlink_fd(), "#audio: rc loss, terminating");
_rcl_state = RCL_STATE_TERMINATE;
_navigator->get_mission_result()->stay_in_failsafe = true;
_navigator->publish_mission_result();
}
break;
case RCL_STATE_LOITER:
_rcl_state = RCL_STATE_TERMINATE;