Fix misleading error message in RobotState::setFromIKSubgroups()

backport from moveit/moveit2#3263
ubi-agni · Jan 24, 2025 · e773340 · e773340
1 parent b9ed835
commit e773340
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
@@ -1940,8 +1940,8 @@ bool RobotState::setFromIKSubgroups(const JointModelGroup* jmg, const EigenSTL::
   {
     if (consistency_limits[i].size() != sub_groups[i]->getVariableCount())
     {
-      ROS_ERROR_NAMED(LOGNAME, "Number of joints in consistency_limits is %zu but it should be should be %u", i,
-                      sub_groups[i]->getVariableCount());
+      ROS_ERROR_NAMED(LOGNAME, "Number of joints in consistency_limits[%zu] is %zu but it should be should be %zu", i,
+                      consistency_limits[i].size(), sub_groups[i]->getVariableCount());
       return false;
     }
   }