Exemple #1
0
        internal void AddSMatrix(double[,] mf, double[,] p)
        {
            // Pole*mf=Pole*p => Pole*(mf*p')=Pole

            double[,] mr = PGeom.MatrixMulInv(mf, p);
            foreach (double[,] m in SMatrices)
            {
                if (PGeom.MatrixEqual(m, mr))
                {
                    return;
                }
            }
            SMatrices.Add(mr);
        }