From 19eb920adaeb37296d93efe819b06a876ef92466 Mon Sep 17 00:00:00 2001 From: Kristoffer Gryte Date: Sun, 26 May 2019 22:09:43 +0200 Subject: [PATCH] Maneuver/FollowReference: fix start z --- src/Maneuver/FollowReference/UAV/Task.cpp | 3 ++- 1 file changed, 2 insertions(+), 1 deletion(-) diff --git a/src/Maneuver/FollowReference/UAV/Task.cpp b/src/Maneuver/FollowReference/UAV/Task.cpp index 1d817147fd..aaba79c838 100644 --- a/src/Maneuver/FollowReference/UAV/Task.cpp +++ b/src/Maneuver/FollowReference/UAV/Task.cpp @@ -362,7 +362,8 @@ namespace Maneuver // command start corresponds to reference position m_desired_path.start_lat = m_cur_ref.lat; m_desired_path.start_lon = m_cur_ref.lon; - m_desired_path.start_lon = m_cur_ref.lon; + m_desired_path.start_z = m_cur_ref.z->value; + m_desired_path.start_z_units = m_cur_ref.z->z_units; m_desired_path.flags &= ~IMC::DesiredPath::FL_DIRECT; } else if (m_cur_ref.flags & IMC::Reference::FLAG_DIRECT)