From 69d31001418fbeee1d912cd38216e0a271dfbb4c Mon Sep 17 00:00:00 2001
From: mrceki <105711013+mrceki@users.noreply.github.com>
Date: Wed, 8 Mar 2023 09:30:48 +0300
Subject: [PATCH] fix gripper action

---
 moveit_task_constructor/core/src/storage.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/moveit_task_constructor/core/src/storage.cpp b/moveit_task_constructor/core/src/storage.cpp
index e59fda6..dc88661 100644
--- a/moveit_task_constructor/core/src/storage.cpp
+++ b/moveit_task_constructor/core/src/storage.cpp
@@ -221,7 +221,7 @@ void SubTrajectory::fillMessage(moveit_task_constructor_msgs::Solution& msg, Int
 	moveit_task_constructor_msgs::SubTrajectory& t = msg.sub_trajectory.back();
 	SolutionBase::fillInfo(t.info, introspection);
 
-	if (trajectory())
+	if (trajectory() && trajectory()->getWayPointDurationFromStart(trajectory()->getWayPointCount() - 1) > 0.0)
 		trajectory()->getRobotTrajectoryMsg(t.trajectory);
 
 	this->end()->scene()->getPlanningSceneDiffMsg(t.scene_diff);