Fix formatJointPosition handle of cartesian seed

tesseract-robotics · Dec 25, 2024 · ceecb4b · ceecb4b
1 parent e00ae6f
commit ceecb4b
Showing 1 changed file with 9 additions and 5 deletions.
diff --git a/tesseract_command_language/src/utils.cpp b/tesseract_command_language/src/utils.cpp
@@ -241,11 +241,15 @@ bool formatJointPosition(const std::vector<std::string>& joint_names, WaypointPo
   else if (waypoint.isCartesianWaypoint())
   {
     auto& cwp = waypoint.as<CartesianWaypointPoly>();
-    if (!cwp.hasSeed())
-      throw std::runtime_error("Cartesian waypoint does not have a seed.");
-
-    jv = &(cwp.getSeed().position);
-    jn = &(cwp.getSeed().joint_names);
+    if (cwp.hasSeed())
+    {
+      jv = &(cwp.getSeed().position);
+      jn = &(cwp.getSeed().joint_names);
+    }
+    else
+    {
+      return false;
+    }
   }
   else
   {