From 6ff1a5162f99fb08dbf78311f0ebc0212d0b0506 Mon Sep 17 00:00:00 2001 From: Robert Haschke Date: Fri, 19 Jul 2019 13:42:35 +0200 Subject: [PATCH] Fixup: adding cost calculations to connect and move_to Need to handle nullptr trajectories. --- core/src/stages/connect.cpp | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/core/src/stages/connect.cpp b/core/src/stages/connect.cpp index 91ecccf8..c5f84934 100644 --- a/core/src/stages/connect.cpp +++ b/core/src/stages/connect.cpp @@ -189,6 +189,8 @@ Connect::makeSequential(const std::vectorgetWayPointDurations()) cost += distance; } @@ -224,6 +226,8 @@ SubTrajectoryPtr Connect::merge(const std::vectorgetWayPointDurations()) cost += distance; }