dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Navigator: Initialize RTL state properly

This commit is contained in:
Lorenz Meier 2017-04-07 22:36:59 +02:00
parent 8c9affddc8
commit f74d6e443e
1 changed files with 2 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/modules/navigator/rtl.cpp
View File

@ -99,6 +99,8 @@ RTL::on_activation()
set_current_position_item(&_mission_item);
struct position_setpoint_triplet_s *pos_sp_triplet = _navigator->get_position_setpoint_triplet();
mission_item_to_position_setpoint(&_mission_item, &pos_sp_triplet->current);
pos_sp_triplet->previous.valid = false;
pos_sp_triplet->next.valid = false;
/* for safety reasons don't go into RTL if landed */
if (_navigator->get_land_detected()->landed) {