Fix: misleading error logs in RobotState::setFromIKSubgroups() (backp…

…ort #3263) (#3267) (cherry picked from commit 524ca4f) Co-authored-by: Zhong Jin <[email protected]>
moveit · Jan 25, 2025 · 8d89f73 · 8d89f73
1 parent e893db5
commit 8d89f73
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/moveit_core/robot_state/src/robot_state.cpp b/moveit_core/robot_state/src/robot_state.cpp
@@ -1828,8 +1828,8 @@ bool RobotState::setFromIKSubgroups(const JointModelGroup* jmg, const EigenSTL::
   {
     if (consistency_limits[i].size() != sub_groups[i]->getVariableCount())
     {
-      RCLCPP_ERROR(LOGGER, "Number of joints in consistency_limits is %zu but it should be should be %u", i,
-                   sub_groups[i]->getVariableCount());
+      RCLCPP_ERROR(LOGGER, "Number of joints in consistency_limits[%zu] is %lu but it should be should be %u", i,
+                   consistency_limits[i].size(), sub_groups[i]->getVariableCount());
       return false;
     }
   }