[HrpsysSeqStateROSBridge.cpp] add warning message

kazuki0824 · Apr 17, 2022 · 7137679 · 7137679
1 parent 298bb42
commit 7137679
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/hrpsys_ros_bridge/src/HrpsysSeqStateROSBridge.cpp b/hrpsys_ros_bridge/src/HrpsysSeqStateROSBridge.cpp
@@ -190,6 +190,7 @@ void HrpsysSeqStateROSBridge::onJointTrajectory(trajectory_msgs::JointTrajectory
     for (unsigned int j=0; j < trajectory.joint_names.size(); j++ ) {
       hrp::Link* l = body->link(joint_names[j]);
       if(l) l->q = point.positions[j];
+      else ROS_WARN_STREAM_ONCE("[" << getInstanceName() << "] @onJointTrajectoryAction : joint named " << joint_names[j] << " is not found. Skipping ...");
     }
 
     body->calcForwardKinematics();