From 13801172d405da3409d1a1b495848dea9113e6c2 Mon Sep 17 00:00:00 2001 From: "mergify[bot]" <37929162+mergify[bot]@users.noreply.github.com> Date: Fri, 24 Jan 2025 20:26:23 -0500 Subject: [PATCH] Fix: misleading error logs in RobotState::setFromIKSubgroups() (#3263) (#3266) (cherry picked from commit 524ca4f15bb449e1f8d25223d9725ca7868c32ee) Co-authored-by: Zhong Jin --- moveit_core/robot_state/src/robot_state.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/moveit_core/robot_state/src/robot_state.cpp b/moveit_core/robot_state/src/robot_state.cpp index ff847bcb54..d24a19b371 100644 --- a/moveit_core/robot_state/src/robot_state.cpp +++ b/moveit_core/robot_state/src/robot_state.cpp @@ -2039,8 +2039,8 @@ bool RobotState::setFromIKSubgroups(const JointModelGroup* jmg, const EigenSTL:: { if (consistency_limits[i].size() != sub_groups[i]->getVariableCount()) { - RCLCPP_ERROR(getLogger(), "Number of joints in consistency_limits is %zu but it should be should be %u", i, - sub_groups[i]->getVariableCount()); + RCLCPP_ERROR(getLogger(), "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; } }