Function stMakeDirectionMtx

src/Sato/stMath.cpp:75–128

}

void stMakeDirectionMtx(TPos3f *dirMtx, const TVec3f &vec, char axis)
{
    TVec3f dir;
    TVec3f normal;

    if (axis == 'Z')
    {
        normal.set(0.0f, 1.0f, 0.0f);
    }
    else
    {
        normal.set(0.0f, 0.0f, 1.0f);
    }

    dir.cross(normal, vec);
    stVecNormalize(&dir);

    normal.cross(vec, dir);
    stVecNormalize(&normal);

    if (axis == 'Z')
    {
        dirMtx->mMtx[0][0] = dir.x;
        dirMtx->mMtx[1][0] = dir.y;
        dirMtx->mMtx[2][0] = dir.z;

        dirMtx->mMtx[0][1] = normal.x;
        dirMtx->mMtx[1][1] = normal.y;
        dirMtx->mMtx[2][1] = normal.z;

        dirMtx->mMtx[0][2] = vec.x;
        dirMtx->mMtx[1][2] = vec.y;
        dirMtx->mMtx[2][2] = vec.z;
    }
    else
    {
        dir.negate();
        dirMtx->mMtx[0][0] = dir.x;
        dirMtx->mMtx[1][0] = dir.y;
        dirMtx->mMtx[2][0] = dir.z;

        dirMtx->mMtx[0][1] = vec.x;
        dirMtx->mMtx[1][1] = vec.y;
        dirMtx->mMtx[2][1] = vec.z;

        dirMtx->mMtx[0][2] = normal.x;
        dirMtx->mMtx[1][2] = normal.y;
        dirMtx->mMtx[2][2] = normal.z;
    }

    dirMtx->mMtx[0][3] = 0.0f;
    dirMtx->mMtx[1][3] = 0.0f;
    dirMtx->mMtx[2][3] = 0.0f;
}

void stMakeRMtx(Mtx m, const TVec3f &vec1, const TVec3f &vec2, const TVec3f &vec3)
{