Method SmoothElementsInertia

ogsr_engine/xrGame/PHShell.cpp:484–512

    TransformPosition(replace);
}
void CPHShell::SmoothElementsInertia(float k)
{
    dMass m_avrg;
    dReal krc = 1.f - k;
    dMassSetZero(&m_avrg);
    ELEMENT_I i;
    for (i = elements.begin(); elements.end() != i; ++i)
    {
        dMassAdd(&m_avrg, (*i)->getMassTensor());
    }
    int n = (int)elements.size();
    m_avrg.mass *= k / float(n);
    for (int j = 0; j < 4 * 3; ++j)
        m_avrg.I[j] *= k / float(n);

    for (i = elements.begin(); elements.end() != i; ++i)
    {
        dVector3 tmp;
        dMass* m = (*i)->getMassTensor();
        dVectorSet(tmp, m->c);

        m->mass *= krc;
        for (int j = 0; j < 4 * 3; ++j)
            m->I[j] *= krc;
        dMassAdd(m, &m_avrg);

        dVectorSet(m->c, tmp);
    }
}

void CPHShell::setEquelInertiaForEls(const dMass& M)
{