TrajectoryFollowingController: if trajectory is empty: don't move

source/armarx/navigation/trajectory_control/TrajectoryFollowingController.cpp

@@ -131,6 +131,14 @@ namespace armarx::navigation::traj_ctrl
     {
         ARMARX_CHECK_NOT_NULL(robot) << "Robot not available";
 
+        if (trajectory.points().empty())
+        {
+            ARMARX_INFO << "Trajectory is empty.";
+            return TrajectoryControllerResult{
+                .twist = core::Twist::Zero(),
+                .dropPoint = {.waypoint = {.pose = core::Pose::Identity()}, .velocity = 0}};
+        }
+
         const core::Pose currentPose(robot->getGlobalPose());
 
         const auto projectedPose = trajectory.getProjection(