本文整理了Java中us.ihmc.mecano.multiBodySystem.interfaces.RigidBodyBasics.childrenSubtreeIterable
方法的一些代码示例,展示了RigidBodyBasics.childrenSubtreeIterable
的具体用法。这些代码示例主要来源于Github
/Stackoverflow
/Maven
等平台,是从一些精选项目中提取出来的代码,具有较强的参考意义,能在一定程度帮忙到你。RigidBodyBasics.childrenSubtreeIterable
方法的具体详情如下:
包路径:us.ihmc.mecano.multiBodySystem.interfaces.RigidBodyBasics
类名称: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())
内容来源于网络,如有侵权,请联系作者删除!