public static float normF(FMatrix2 M)
{
float scale = CommonOps_FDF2.elementMaxAbs(M);
if (scale == 0.0f)
{
return(0.0f);
}
float a1 = M.a1 / scale, a2 = M.a2 / scale;
float sum = a1 * a1 + a2 * a2;
return(scale * (float)Math.Sqrt(sum));
}
public static float normF(FMatrix2x2 M)
{
float scale = CommonOps_FDF2.elementMaxAbs(M);
if (scale == 0.0f)
{
return(0.0f);
}
float a11 = M.a11 / scale, a12 = M.a12 / scale;
float a21 = M.a21 / scale, a22 = M.a22 / scale;
float sum = 0;
sum += a11 * a11 + a12 * a12;
sum += a21 * a21 + a22 * a22;
return(scale * (float)Math.Sqrt(sum));
}
public static void normalizeF(FMatrix2 M)
{
float val = normF(M);
CommonOps_FDF2.divide(M, val);
}