本文整理汇总了C++中Skeleton::getPositions方法的典型用法代码示例。如果您正苦于以下问题:C++ Skeleton::getPositions方法的具体用法?C++ Skeleton::getPositions怎么用?C++ Skeleton::getPositions使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Skeleton
的用法示例。
在下文中一共展示了Skeleton::getPositions方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: Debug
void WorldConstructor::Debug()
{
return;
// Create a humanoid controller
//msHumanoid = new bioloidgp::robot::HumanoidController(robot, msWorld->getConstraintSolver());
DartLoader urdfLoader;
Skeleton* robot
= urdfLoader.parseSkeleton(
DATA_DIR"/urdf/BioloidGP/BioloidGP.URDF");
robot->enableSelfCollision();
msWorld->withdrawSkeleton(msHumanoid->robot());
msWorld->addSkeleton(robot);
msHumanoid->reset();
Skeleton* tmp = msHumanoid->robot();
msHumanoid->robot() = robot;
msHumanoid->setJointDamping(0.0);
msHumanoid->reset();
Eigen::VectorXd qOrig = tmp->getPositions();
Eigen::VectorXd q = msHumanoid->robot()->getPositions();
Eigen::VectorXd err = qOrig - q;
Eigen::VectorXd qDotOrig = tmp->getVelocities();
Eigen::VectorXd qDot = msHumanoid->robot()->getVelocities();
Eigen::VectorXd errDot = qDotOrig - qDot;
}