Fix false triggering (#61)

ethz-asl · Mar 29, 2024 · 2f9b9ae · 2f9b9ae
1 parent e5ea100
commit 2f9b9ae
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/terrain_navigation/include/terrain_navigation/path.h b/terrain_navigation/include/terrain_navigation/path.h
@@ -136,7 +136,7 @@ class Path {
         Eigen::Vector3d next_segment_start = segments[segment_idx].states.front().position;
         if ((closest_point - next_segment_start).norm() < epsilon_) {
           segment.reached = true;
-          return segment;
+          return segments[segment_idx];
         }
       }