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

FlightTaskAuto: fix triplet reset

This commit is contained in:
Martina 2018-07-26 15:52:35 +02:00 committed by ChristophTobler
parent f379035a3b
commit e13ca0d990
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
src/lib/FlightTasks/tasks/FlightTaskAuto.cpp
View File

@ -126,12 +126,12 @@ bool FlightTaskAuto::_evaluateTriplets()
|| !PX4_ISFINITE(_sub_triplet_setpoint->get().current.lon)) {
// No position provided in xy. Lock position
if (!PX4_ISFINITE(_lock_position_xy(0))) {
_triplet_target(0) = _lock_position_xy(0) = _position(0);
_triplet_target(1) = _lock_position_xy(1) = _position(1);
tmp_target(0) = _lock_position_xy(0) = _position(0);
tmp_target(1) = _lock_position_xy(1) = _position(1);
} else {
_triplet_target(0) = _lock_position_xy(0);
_triplet_target(1) = _lock_position_xy(1);
tmp_target(0) = _lock_position_xy(0);
tmp_target(1) = _lock_position_xy(1);
_lock_position_xy *= NAN;
}