diff --git a/rm_arm_control/simulator/col_simulator.cpp b/rm_arm_control/simulator/col_simulator.cpp index b04beb4..456d550 100644 --- a/rm_arm_control/simulator/col_simulator.cpp +++ b/rm_arm_control/simulator/col_simulator.cpp @@ -607,10 +607,6 @@ int CollisionSimulator::CheckBodyAngleLimit(int simple, int bodyType) int CollisionSimulator::CheckArmJointsAngleLimit(float *joints) { CollisionStructureInfo *colStruct = &collision_structures_[g_linkStartIndex[BODY_TYPE_LEFT_ARM]]; - int jointIndex2 = colStruct->jointIndexList[0]; - JointsInfo *jointInfo2 = &jointMap_[jointIndex2]; - RCLCPP_INFO(rclcpp::get_logger(GET_FUNC_LINE_STR()), "first link:%s, first joint:%s", - colStruct->link_name.c_str(), jointInfo2->name.c_str()); std::vector child = {colStruct}; int childIndex = 0; int childCnt = 1;