public static float normF(FMatrix4 M)
{
float scale = CommonOps_FDF4.elementMaxAbs(M);
if (scale == 0.0f)
{
return(0.0f);
}
float a1 = M.a1 / scale, a2 = M.a2 / scale, a3 = M.a3 / scale, a4 = M.a4 / scale;
float sum = a1 * a1 + a2 * a2 + a3 * a3 + a4 * a4;
return(scale * (float)Math.Sqrt(sum));
}
public static float normF(FMatrix4x4 M)
{
float scale = CommonOps_FDF4.elementMaxAbs(M);
if (scale == 0.0f)
{
return(0.0f);
}
float a11 = M.a11 / scale, a12 = M.a12 / scale, a13 = M.a13 / scale, a14 = M.a14 / scale;
float a21 = M.a21 / scale, a22 = M.a22 / scale, a23 = M.a23 / scale, a24 = M.a24 / scale;
float a31 = M.a31 / scale, a32 = M.a32 / scale, a33 = M.a33 / scale, a34 = M.a34 / scale;
float a41 = M.a41 / scale, a42 = M.a42 / scale, a43 = M.a43 / scale, a44 = M.a44 / scale;
float sum = 0;
sum += a11 * a11 + a12 * a12 + a13 * a13 + a14 * a14;
sum += a21 * a21 + a22 * a22 + a23 * a23 + a24 * a24;
sum += a31 * a31 + a32 * a32 + a33 * a33 + a34 * a34;
sum += a41 * a41 + a42 * a42 + a43 * a43 + a44 * a44;
return(scale * (float)Math.Sqrt(sum));
}
public static void normalizeF(FMatrix4 M)
{
float val = normF(M);
CommonOps_FDF4.divide(M, val);
}
