Merge pull request #203 from krisgry/fix/fref_z

Maneuver/FollowReference: fix start z
LSTS · May 5, 2022 · e98a788 · e98a788
2 parents 55effc9 + 19eb920
commit e98a788
Showing 1 changed file with 2 additions and 1 deletion.
diff --git 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)