修正初始链接,去掉注释

This commit is contained in:
zj
2025-11-20 10:46:16 +08:00
parent e831c50c67
commit 4be8691b53

View File

@@ -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<CollisionStructureInfo *> child = {colStruct};
int childIndex = 0;
int childCnt = 1;