Method NormalizeAndUpdateRoot

GTE/Applications/TrackObject.cpp:128–147

}

void TrackObject::NormalizeAndUpdateRoot(Matrix4x4<float>& rotate)
{
    // Renormalize to avoid accumulated rounding errors that can cause the
    // rotation matrix to degenerate.
    Vector4<float> v[3] =
    {
        rotate.GetCol(0),
        rotate.GetCol(1),
        rotate.GetCol(2)
    };

    Orthonormalize<4, float>(3, v);

    rotate.SetCol(0, v[0]);
    rotate.SetCol(1, v[1]);
    rotate.SetCol(2, v[2]);

    mRoot->localTransform.SetRotation(rotate);
    mRoot->Update();
}