Function xVec3Normalize

src/SB/Core/x/xVec3.cpp:14–49

const xVec3 xVec3::m_UnitAxisY = { 0.0f, 1.0f, 0.0f };

F32 xVec3Normalize(xVec3* o, const xVec3* v)
{
    F32 x = v->x;
    F32 x2 = SQR(v->x);
    F32 y = v->y;
    F32 y2 = SQR(v->y);
    F32 z = v->z;
    F32 z2 = SQR(v->z);

    F32 len;
    F32 len2 = x2 + y2 + z2;

    if ((F32)iabs(len2 - 1.0f) <= 0.00001f)
    {
        o->x = x;
        o->y = y;
        o->z = z;
        len = 1.0f;
    }
    else if ((F32)iabs(len2) <= 0.00001f)
    {
        o->x = 0.0f;
        o->y = 1.0f;
        o->z = 0.0f;
        len = 0.0f;
    }
    else
    {
        len = xsqrt(len2);
        F32 inv_len = 1.0f / len;
        o->x = v->x * inv_len;
        o->y = v->y * inv_len;
        o->z = v->z * inv_len;
    }
    return len;
}

F32 xVec3NormalizeFast(xVec3* o, const xVec3* v)
{