本文整理汇总了C++中Tree::GetPosition方法的典型用法代码示例。如果您正苦于以下问题:C++ Tree::GetPosition方法的具体用法?C++ Tree::GetPosition怎么用?C++ Tree::GetPosition使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Tree
的用法示例。
在下文中一共展示了Tree::GetPosition方法的3个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: IsReachable
bool World::IsReachable(const Robot& robot, const Tree& tree, const Obstacle& obstacle) const
{
Vector3 treePos = tree.GetPosition(); int room = ( tree.GetPosition()(1) > 0 ) ? 1 : - 1;
const matrices::Matrix4& transform( robot.ToRobotCoordinates());
numeric p1robPos = matrices::matrix4TimesVect3( transform, obstacle.GetP1())(1) + 0.05 * room;
numeric p3robPos = matrices::matrix4TimesVect3( transform, obstacle.GetP3())(1) + 0.05 * room;
if(! (p1robPos * room >= 0 || p3robPos * room >= 0))
{
return false;
}
//assert(pImpl_->instantiated_);
return pImpl_->intersection_.Intersect(robot, tree, obstacle);
}
示例2:
FilterDistance::FilterDistance(NUMBER treshold, const Tree& tree, const Vector3& target)
: Filter_ABC()
, treshold_(treshold)
, target_(target)
, treePos_(tree.GetPosition())
{
// NOTHING
}
示例3:
Sample::Sample(Tree& tree)
{
Joint * j = tree.GetRoot();
while(j)
{
angles_.push_back(j->GetTheta());
position_ = j->GetS();
j = j->pChild_;
}
position_ -= tree.GetPosition();
jacobianProd_ = tree.GetJacobian()->GetJacobianProduct();
jacobianProdInverse_ = tree.GetJacobian()->GetJacobianProductInverse();
}