Changeset 389 for cpp/frams/model/similarity/SVD/matrix_tools.cpp

Timestamp:

05/24/15 21:03:46 (8 years ago)

Author:

Maciej Komosinski

Message:

Code formatting

File:

• cpp/frams/model/similarity/SVD/matrix_tools.cpp (modified) (2 diffs)

cpp/frams/model/similarity/SVD/matrix_tools.cpp

@@ -15 +15 @@
 double *Create(int nSize)
 {
-        double *matrix = (double *) malloc(nSize * sizeof (double));
-
-    for (int i = 0; i < nSize; i++)
-    {
-        matrix[i] = 0;
-    }
-
-    return matrix;
+        double *matrix = (double *)malloc(nSize * sizeof(double));
+
+        for (int i = 0; i < nSize; i++)
+        {
+                matrix[i] = 0;
+        }
+
+        return matrix;
 }
 
 double *Multiply(double *&a, double *&b, int nrow, int ncol, double ncol2, double *&toDel, int delSize)
 {
-    double *c = Create(nrow * ncol2);
-    int i = 0, j = 0, k = 0;
-
-    for (i = 0; i < nrow; i++)
-    {
-        for (j = 0; j < ncol2; j++)
-        {
-            for (k = 0; k < ncol; k++)
-                c[i * nrow + j] += a[i * nrow + k] * b[k * ncol + j];
-        }
-    }
-
-    if (delSize != 0)
-        free(toDel);
-    return c;
+        double *c = Create(nrow * ncol2);
+        int i = 0, j = 0, k = 0;
+
+        for (i = 0; i < nrow; i++)
+        {
+                for (j = 0; j < ncol2; j++)
+                {
+                        for (k = 0; k < ncol; k++)
+                                c[i * nrow + j] += a[i * nrow + k] * b[k * ncol + j];
+                }
+        }
+
+        if (delSize != 0)
+                free(toDel);
+        return c;
 }
 
 double *Power(double *&array, int nrow, int ncol, double pow, double *&toDel, int delSize)
 {
-    double *m_Power = Create(nrow * ncol);
-    if (pow == 2)
-    {
-        for (int i = 0; i < nrow; i++)
-        {
-            for (int j = 0; j < ncol; j++)
-            {
-                m_Power[i * nrow + j] = array[i * nrow + j] * array[i * nrow + j];
-            }
-
-        }
-    }
-    else
-    {
-        for (int i = 0; i < nrow; i++)
-        {
-            for (int j = 0; j < ncol; j++)
-            {
-                m_Power[i * nrow + j] = sqrt(array[i * nrow + j]);
-            }
-
-        }
-    }
-
-    if (delSize != 0)
-        free(toDel);
-
-    return m_Power;
+        double *m_Power = Create(nrow * ncol);
+        if (pow == 2)
+        {
+                for (int i = 0; i < nrow; i++)
+                {
+                        for (int j = 0; j < ncol; j++)
+                        {
+                                m_Power[i * nrow + j] = array[i * nrow + j] * array[i * nrow + j];
+                        }
+
+                }
+        }
+        else
+        {
+                for (int i = 0; i < nrow; i++)
+                {
+                        for (int j = 0; j < ncol; j++)
+                        {
+                                m_Power[i * nrow + j] = sqrt(array[i * nrow + j]);
+                        }
+
+                }
+        }
+
+        if (delSize != 0)
+                free(toDel);
+
+        return m_Power;
 }
 
 void Print(double *&mat, int nelems)
 {
-    for (int i = 0; i < nelems; i++)
-        printf("%6.2f ", mat[i]);
-    printf("\n");
+        for (int i = 0; i < nelems; i++)
+                printf("%6.2f ", mat[i]);
+        printf("\n");
 
 }
@@ -86 +86 @@
 double *Transpose(double *&A, int arow, int acol)
 {
-    double *result = Create(acol * arow);
-
-    for (int i = 0; i < acol; i++)
-        for (int j = 0; j < arow; j++)
-        {
-            result[i * arow + j] = A[j * acol + i];
-        }
-
-    return result;
+        double *result = Create(acol * arow);
+
+        for (int i = 0; i < acol; i++)
+                for (int j = 0; j < arow; j++)
+                {
+                result[i * arow + j] = A[j * acol + i];
+                }
+
+        return result;
 
 }
 
 /** Computes the SVD of the nSize x nSize distance matrix
-        @param vdEigenvalues [OUT] Vector of doubles. On return holds the eigenvalues of the 
-        decomposed distance matrix (or rather, to be strict, of the matrix of scalar products 
-        created from the matrix of distances). The vector is assumed to be empty before the function call and
-        all variance percentages are pushed at the end of it.
-        @param nSize size of the matrix of distances.
-        @param pDistances [IN] matrix of distances between parts.
-        @param Coordinates [OUT] array of three dimensional coordinates obtained from SVD of pDistances matrix.
- */
+                @param vdEigenvalues [OUT] Vector of doubles. On return holds the eigenvalues of the
+                decomposed distance matrix (or rather, to be strict, of the matrix of scalar products
+                created from the matrix of distances). The vector is assumed to be empty before the function call and
+                all variance percentages are pushed at the end of it.
+                @param nSize size of the matrix of distances.
+                @param pDistances [IN] matrix of distances between parts.
+                @param Coordinates [OUT] array of three dimensional coordinates obtained from SVD of pDistances matrix.
+                */
 void MatrixTools::SVD(std::vector<double> &vdEigenvalues, int nSize, double *pDistances, Pt3D *&Coordinates)
 {
-    // compute squares of elements of this array
-    // compute the matrix B that is the parameter of SVD
-    double *B = Create(nSize * nSize);
-    {
-        // use additional scope to delete temporary matrices
-        double *Ones, *Eye, *Z, *D;
-
-        D = Create(nSize * nSize);
-        D = Power(pDistances, nSize, nSize, 2.0, D, nSize);
-
-        Ones = Create(nSize * nSize);
-        for (int i = 0; i < nSize; i++)
-            for (int j = 0; j < nSize; j++)
-            {
-                Ones[i * nSize + j] = 1;
-            }
-
-        Eye = Create(nSize * nSize);
-        for (int i = 0; i < nSize; i++)
-        {
-            for (int j = 0; j < nSize; j++)
-            {
-                if (i == j)
-                {
-                    Eye[i * nSize + j] = 1;
-                }
-                else
-                {
-                    Eye[i * nSize + j] = 0;
-                }
-            }
-        }
-
-        Z = Create(nSize * nSize);
-        for (int i = 0; i < nSize; i++)
-        {
-            for (int j = 0; j < nSize; j++)
-            {
-                Z[i * nSize + j] = 1.0 / ((double) nSize) * Ones[i * nSize + j];
-            }
-        }
-
-        for (int i = 0; i < nSize; i++)
-        {
-            for (int j = 0; j < nSize; j++)
-            {
-                Z[i * nSize + j] = Eye[i * nSize + j] - Z[i * nSize + j];
-            }
-        }
-
-        for (int i = 0; i < nSize; i++)
-        {
-            for (int j = 0; j < nSize; j++)
-            {
-                B[i * nSize + j] = Z[i * nSize + j] * -0.5;
-            }
-        }
-
-        B = Multiply(B, D, nSize, nSize, nSize, B, nSize);
-        B = Multiply(B, Z, nSize, nSize, nSize, B, nSize);
-
-        free(Ones);
-        free(Eye);
-        free(Z);
-        free(D);
-    }
-
-    double *Eigenvalues = Create(nSize);
-    double *S = Create(nSize * nSize);
-
-    // call SVD function
-    double *Vt = Create(nSize * nSize);
-    size_t astep = nSize * sizeof (double);
-    Lapack::JacobiSVD(B, astep, Eigenvalues, Vt, astep, nSize, nSize, nSize);
-
-    double *W = Transpose(Vt, nSize, nSize);
-
-    free(B);
-    free(Vt);
-
-    for (int i = 0; i < nSize; i++)
-        for (int j = 0; j < nSize; j++)
-        {
-            if (i == j)
-                S[i * nSize + j] = Eigenvalues[i];
-            else
-                S[i * nSize + j] = 0;
-        }
-
-    // compute coordinates of points 
-    double *sqS, *dCoordinates;
-    sqS = Power(S, nSize, nSize, 0.5, S, nSize);
-    dCoordinates = Multiply(W, sqS, nSize, nSize, nSize, W, nSize);
-    free(sqS);
-
-    for (int i = 0; i < nSize; i++)
-    {
-        // set coordinate from the SVD solution
-        Coordinates[ i ].x = dCoordinates[i * nSize];
-        Coordinates[ i ].y = dCoordinates[i * nSize + 1 ];
-        if (nSize > 2)
-            Coordinates[ i ].z = dCoordinates[i * nSize + 2 ];
-        else
-            Coordinates[ i ].z = 0;
-    }
-
-    // store the eigenvalues in the output vector
-    for (int i = 0; i < nSize; i++)
-    {
-        double dElement = Eigenvalues[i];
-        vdEigenvalues.push_back(dElement);
-    }
-
-    free(Eigenvalues);
-    free(dCoordinates);
-}
+        // compute squares of elements of this array
+        // compute the matrix B that is the parameter of SVD
+        double *B = Create(nSize * nSize);
+        {
+                // use additional scope to delete temporary matrices
+                double *Ones, *Eye, *Z, *D;
+
+                D = Create(nSize * nSize);
+                D = Power(pDistances, nSize, nSize, 2.0, D, nSize);
+
+                Ones = Create(nSize * nSize);
+                for (int i = 0; i < nSize; i++)
+                        for (int j = 0; j < nSize; j++)
+                        {
+                        Ones[i * nSize + j] = 1;
+                        }
+
+                Eye = Create(nSize * nSize);
+                for (int i = 0; i < nSize; i++)
+                {
+                        for (int j = 0; j < nSize; j++)
+                        {
+                                if (i == j)
+                                {
+                                        Eye[i * nSize + j] = 1;
+                                }
+                                else
+                                {
+                                        Eye[i * nSize + j] = 0;
+                                }
+                        }
+                }
+
+                Z = Create(nSize * nSize);
+                for (int i = 0; i < nSize; i++)
+                {
+                        for (int j = 0; j < nSize; j++)
+                        {
+                                Z[i * nSize + j] = 1.0 / ((double)nSize) * Ones[i * nSize + j];
+                        }
+                }
+
+                for (int i = 0; i < nSize; i++)
+                {
+                        for (int j = 0; j < nSize; j++)
+                        {
+                                Z[i * nSize + j] = Eye[i * nSize + j] - Z[i * nSize + j];
+                        }
+                }
+
+                for (int i = 0; i < nSize; i++)
+                {
+                        for (int j = 0; j < nSize; j++)
+                        {
+                                B[i * nSize + j] = Z[i * nSize + j] * -0.5;
+                        }
+                }
+
+                B = Multiply(B, D, nSize, nSize, nSize, B, nSize);
+                B = Multiply(B, Z, nSize, nSize, nSize, B, nSize);
+
+                free(Ones);
+                free(Eye);
+                free(Z);
+                free(D);
+        }
+
+        double *Eigenvalues = Create(nSize);
+        double *S = Create(nSize * nSize);
+
+        // call SVD function
+        double *Vt = Create(nSize * nSize);
+        size_t astep = nSize * sizeof(double);
+        Lapack::JacobiSVD(B, astep, Eigenvalues, Vt, astep, nSize, nSize, nSize);
+
+        double *W = Transpose(Vt, nSize, nSize);
+
+        free(B);
+        free(Vt);
+
+        for (int i = 0; i < nSize; i++)
+                for (int j = 0; j < nSize; j++)
+                {
+                if (i == j)
+                        S[i * nSize + j] = Eigenvalues[i];
+                else
+                        S[i * nSize + j] = 0;
+                }
+
+        // compute coordinates of points 
+        double *sqS, *dCoordinates;
+        sqS = Power(S, nSize, nSize, 0.5, S, nSize);
+        dCoordinates = Multiply(W, sqS, nSize, nSize, nSize, W, nSize);
+        free(sqS);
+
+        for (int i = 0; i < nSize; i++)
+        {
+                // set coordinate from the SVD solution
+                Coordinates[i].x = dCoordinates[i * nSize];
+                Coordinates[i].y = dCoordinates[i * nSize + 1];
+                if (nSize > 2)
+                        Coordinates[i].z = dCoordinates[i * nSize + 2];
+                else
+                        Coordinates[i].z = 0;
+        }
+
+        // store the eigenvalues in the output vector
+        for (int i = 0; i < nSize; i++)
+        {
+                double dElement = Eigenvalues[i];
+                vdEigenvalues.push_back(dElement);
+        }
+
+        free(Eigenvalues);
+        free(dCoordinates);
+}