C++ (Cpp) BodyNode::getWorldCOM示例

示例#1

文件： Skeleton.cpp 项目： Tarrasch/dart

 Vector3d Skeleton::getWorldCOM() {
     assert(mMass != 0);
     Vector3d com(0, 0, 0);
     const int nNodes = getNumNodes();
     for(int i = 0; i < nNodes; i++) {
         BodyNode* node = getNode(i);
         com += (node->getMass() * node->getWorldCOM());
     }
     return com / mMass;
 }

示例#2

文件： Skeleton.cpp 项目： hsu/dart

Eigen::Vector3d Skeleton::getWorldCOM()
{
    Eigen::Vector3d com(0, 0, 0);

    assert(mTotalMass != 0);
    const int nNodes = getNumBodyNodes();

    for(int i = 0; i < nNodes; i++)
    {
        BodyNode* bodyNode = getBodyNode(i);
        com += (bodyNode->getMass() * bodyNode->getWorldCOM());
    }

    return com / mTotalMass;
}