us.ihmc.mecano.multiBodySystem.interfaces.RigidBodyBasics.childrenSubtreeIterable()方法的使用及代码示例

x33g5p2x  于2022-01-29 转载在 其他  
字(4.0k)|赞(0)|评价(0)|浏览(59)

本文整理了Java中us.ihmc.mecano.multiBodySystem.interfaces.RigidBodyBasics.childrenSubtreeIterable方法的一些代码示例,展示了RigidBodyBasics.childrenSubtreeIterable的具体用法。这些代码示例主要来源于Github/Stackoverflow/Maven等平台,是从一些精选项目中提取出来的代码,具有较强的参考意义,能在一定程度帮忙到你。RigidBodyBasics.childrenSubtreeIterable方法的具体详情如下:
包路径:us.ihmc.mecano.multiBodySystem.interfaces.RigidBodyBasics
类名称:RigidBodyBasics
方法名:childrenSubtreeIterable

RigidBodyBasics.childrenSubtreeIterable介绍

暂无

代码示例

代码示例来源:origin: us.ihmc/mecano

/**
* Combines {@link #collectSupportJoints(RigidBodyBasics)} with
* {@link #collectSubtreeJoints(RigidBodyBasics...)}.
* 
* @param rigidBody the rigid-body to collect the support and subtree joints of.
* @return the array containing the support and subtree joints.
*/
public static JointBasics[] collectSupportAndSubtreeJoints(RigidBodyBasics rigidBody)
{
 List<JointBasics> supportAndSubtreeJoints = new ArrayList<>();
 Stream.of(collectSupportJoints(rigidBody)).forEach(supportAndSubtreeJoints::add);
 rigidBody.childrenSubtreeIterable().forEach(supportAndSubtreeJoints::add);
 return supportAndSubtreeJoints.toArray(new JointBasics[supportAndSubtreeJoints.size()]);
}

代码示例来源:origin: us.ihmc/ihmc-robotics-toolkit

public AfterJointReferenceFrameNameMap(RigidBodyBasics base)
{
 for(JointBasics joint : base.childrenSubtreeIterable())
 {
   afterJointReferenceFrames.put(joint.getFrameAfterJoint().getName(), joint.getFrameAfterJoint());
 }
}

代码示例来源:origin: us.ihmc/ihmc-avatar-interfaces

public KinematicsPlanningToolboxCommandConverter(RigidBodyBasics rootBody)
{
 List<ReferenceFrame> referenceFrames = new ArrayList<>();
 for (JointBasics joint : rootBody.childrenSubtreeIterable())
 {
   referenceFrames.add(joint.getFrameAfterJoint());
   referenceFrames.add(joint.getFrameBeforeJoint());
 }
 for (RigidBodyBasics rigidBody : rootBody.subtreeIterable())
 {
   referenceFrames.add(rigidBody.getBodyFixedFrame());
 }
 referenceFrameHashCodeResolver = new ReferenceFrameHashCodeResolver(referenceFrames);
 for (RigidBodyBasics rigidBody : rootBody.subtreeIterable())
   rigidBodyHashMap.put(rigidBody.hashCode(), rigidBody);
}

代码示例来源:origin: us.ihmc/ihmc-avatar-interfaces

public WholeBodyTrajectoryToolboxCommandConverter(RigidBodyBasics rootBody)
{
 List<ReferenceFrame> referenceFrames = new ArrayList<>();
 for (JointBasics joint : rootBody.childrenSubtreeIterable())
 {
   referenceFrames.add(joint.getFrameAfterJoint());
   referenceFrames.add(joint.getFrameBeforeJoint());
 }
 for (RigidBodyBasics rigidBody : rootBody.subtreeIterable())
 {
   referenceFrames.add(rigidBody.getBodyFixedFrame());
 }
 referenceFrameHashCodeResolver = new ReferenceFrameHashCodeResolver(referenceFrames);
 for (RigidBodyBasics rigidBody : rootBody.subtreeIterable())
   rigidBodyHashMap.put(rigidBody.hashCode(), rigidBody);
}

代码示例来源:origin: us.ihmc/ihmc-avatar-interfaces

public KinematicsToolboxCommandConverter(RigidBodyBasics rootBody)
{
 List<ReferenceFrame> referenceFrames = new ArrayList<>();
 for (JointBasics joint : rootBody.childrenSubtreeIterable())
 {
   referenceFrames.add(joint.getFrameAfterJoint());
   referenceFrames.add(joint.getFrameBeforeJoint());
 }
 for (RigidBodyBasics rigidBody : rootBody.subtreeIterable())
 {
   referenceFrames.add(rigidBody.getBodyFixedFrame());
 }
 referenceFrameHashCodeResolver = new ReferenceFrameHashCodeResolver(referenceFrames);
 for (RigidBodyBasics rigidBody : rootBody.subtreeIterable())
   rigidBodyHashMap.put(rigidBody.hashCode(), rigidBody);
}

代码示例来源:origin: us.ihmc/ihmc-robot-data-logger

public void build(int registryID)
{
 this.registryID = registryID;
 if (rootBody != null)
 {
   for (JointBasics joint : rootBody.childrenSubtreeIterable())
   {
    JointHolder jointHolder = JointHolderFactory.getJointHolder(joint);
    jointHolders.add(jointHolder);
   }
   int numberOfJointStates = getNumberOfJointStates();
   if (CustomLogDataPublisherType.getTypeSize(0, numberOfJointStates) > DataProducerParticipant.getMaximumSynchronousPacketSize())
   {
    throw new RuntimeException("Exceeded maximum number of joint states (Approx. " + ((DataProducerParticipant.getMaximumSynchronousPacketSize() - CustomLogDataPublisherType.getTypeSize(0, 0)) / 8 - 1) + ")");
   }
 }
}

代码示例来源:origin: us.ihmc/ihmc-avatar-interfaces

return rootBody.getBodyFixedFrame();
for (JointBasics joint : rootBody.childrenSubtreeIterable())

相关文章