修正初始链接,去掉注释
This commit is contained in:
@@ -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;
|
||||
|
||||
Reference in New Issue
Block a user