URL
https://opencores.org/ocsvn/openrisc/openrisc/trunk
Subversion Repositories openrisc
[/] [openrisc/] [trunk/] [gnu-old/] [gcc-4.2.2/] [gcc/] [lambda-mat.c] - Rev 816
Compare with Previous | Blame | View Log
/* Integer matrix math routines Copyright (C) 2003, 2004, 2005, 2007 Free Software Foundation, Inc. Contributed by Daniel Berlin <dberlin@dberlin.org>. This file is part of GCC. GCC is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 3, or (at your option) any later version. GCC is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with GCC; see the file COPYING3. If not see <http://www.gnu.org/licenses/>. */ #include "config.h" #include "system.h" #include "coretypes.h" #include "tm.h" #include "ggc.h" #include "tree.h" #include "lambda.h" static void lambda_matrix_get_column (lambda_matrix, int, int, lambda_vector); /* Allocate a matrix of M rows x N cols. */ lambda_matrix lambda_matrix_new (int m, int n) { lambda_matrix mat; int i; mat = ggc_alloc (m * sizeof (lambda_vector)); for (i = 0; i < m; i++) mat[i] = lambda_vector_new (n); return mat; } /* Copy the elements of M x N matrix MAT1 to MAT2. */ void lambda_matrix_copy (lambda_matrix mat1, lambda_matrix mat2, int m, int n) { int i; for (i = 0; i < m; i++) lambda_vector_copy (mat1[i], mat2[i], n); } /* Store the N x N identity matrix in MAT. */ void lambda_matrix_id (lambda_matrix mat, int size) { int i, j; for (i = 0; i < size; i++) for (j = 0; j < size; j++) mat[i][j] = (i == j) ? 1 : 0; } /* Return true if MAT is the identity matrix of SIZE */ bool lambda_matrix_id_p (lambda_matrix mat, int size) { int i, j; for (i = 0; i < size; i++) for (j = 0; j < size; j++) { if (i == j) { if (mat[i][j] != 1) return false; } else { if (mat[i][j] != 0) return false; } } return true; } /* Negate the elements of the M x N matrix MAT1 and store it in MAT2. */ void lambda_matrix_negate (lambda_matrix mat1, lambda_matrix mat2, int m, int n) { int i; for (i = 0; i < m; i++) lambda_vector_negate (mat1[i], mat2[i], n); } /* Take the transpose of matrix MAT1 and store it in MAT2. MAT1 is an M x N matrix, so MAT2 must be N x M. */ void lambda_matrix_transpose (lambda_matrix mat1, lambda_matrix mat2, int m, int n) { int i, j; for (i = 0; i < n; i++) for (j = 0; j < m; j++) mat2[i][j] = mat1[j][i]; } /* Add two M x N matrices together: MAT3 = MAT1+MAT2. */ void lambda_matrix_add (lambda_matrix mat1, lambda_matrix mat2, lambda_matrix mat3, int m, int n) { int i; for (i = 0; i < m; i++) lambda_vector_add (mat1[i], mat2[i], mat3[i], n); } /* MAT3 = CONST1 * MAT1 + CONST2 * MAT2. All matrices are M x N. */ void lambda_matrix_add_mc (lambda_matrix mat1, int const1, lambda_matrix mat2, int const2, lambda_matrix mat3, int m, int n) { int i; for (i = 0; i < m; i++) lambda_vector_add_mc (mat1[i], const1, mat2[i], const2, mat3[i], n); } /* Multiply two matrices: MAT3 = MAT1 * MAT2. MAT1 is an M x R matrix, and MAT2 is R x N. The resulting MAT2 must therefore be M x N. */ void lambda_matrix_mult (lambda_matrix mat1, lambda_matrix mat2, lambda_matrix mat3, int m, int r, int n) { int i, j, k; for (i = 0; i < m; i++) { for (j = 0; j < n; j++) { mat3[i][j] = 0; for (k = 0; k < r; k++) mat3[i][j] += mat1[i][k] * mat2[k][j]; } } } /* Get column COL from the matrix MAT and store it in VEC. MAT has N rows, so the length of VEC must be N. */ static void lambda_matrix_get_column (lambda_matrix mat, int n, int col, lambda_vector vec) { int i; for (i = 0; i < n; i++) vec[i] = mat[i][col]; } /* Delete rows r1 to r2 (not including r2). */ void lambda_matrix_delete_rows (lambda_matrix mat, int rows, int from, int to) { int i; int dist; dist = to - from; for (i = to; i < rows; i++) mat[i - dist] = mat[i]; for (i = rows - dist; i < rows; i++) mat[i] = NULL; } /* Swap rows R1 and R2 in matrix MAT. */ void lambda_matrix_row_exchange (lambda_matrix mat, int r1, int r2) { lambda_vector row; row = mat[r1]; mat[r1] = mat[r2]; mat[r2] = row; } /* Add a multiple of row R1 of matrix MAT with N columns to row R2: R2 = R2 + CONST1 * R1. */ void lambda_matrix_row_add (lambda_matrix mat, int n, int r1, int r2, int const1) { int i; if (const1 == 0) return; for (i = 0; i < n; i++) mat[r2][i] += const1 * mat[r1][i]; } /* Negate row R1 of matrix MAT which has N columns. */ void lambda_matrix_row_negate (lambda_matrix mat, int n, int r1) { lambda_vector_negate (mat[r1], mat[r1], n); } /* Multiply row R1 of matrix MAT with N columns by CONST1. */ void lambda_matrix_row_mc (lambda_matrix mat, int n, int r1, int const1) { int i; for (i = 0; i < n; i++) mat[r1][i] *= const1; } /* Exchange COL1 and COL2 in matrix MAT. M is the number of rows. */ void lambda_matrix_col_exchange (lambda_matrix mat, int m, int col1, int col2) { int i; int tmp; for (i = 0; i < m; i++) { tmp = mat[i][col1]; mat[i][col1] = mat[i][col2]; mat[i][col2] = tmp; } } /* Add a multiple of column C1 of matrix MAT with M rows to column C2: C2 = C2 + CONST1 * C1. */ void lambda_matrix_col_add (lambda_matrix mat, int m, int c1, int c2, int const1) { int i; if (const1 == 0) return; for (i = 0; i < m; i++) mat[i][c2] += const1 * mat[i][c1]; } /* Negate column C1 of matrix MAT which has M rows. */ void lambda_matrix_col_negate (lambda_matrix mat, int m, int c1) { int i; for (i = 0; i < m; i++) mat[i][c1] *= -1; } /* Multiply column C1 of matrix MAT with M rows by CONST1. */ void lambda_matrix_col_mc (lambda_matrix mat, int m, int c1, int const1) { int i; for (i = 0; i < m; i++) mat[i][c1] *= const1; } /* Compute the inverse of the N x N matrix MAT and store it in INV. We don't _really_ compute the inverse of MAT. Instead we compute det(MAT)*inv(MAT), and we return det(MAT) to the caller as the function result. This is necessary to preserve accuracy, because we are dealing with integer matrices here. The algorithm used here is a column based Gauss-Jordan elimination on MAT and the identity matrix in parallel. The inverse is the result of applying the same operations on the identity matrix that reduce MAT to the identity matrix. When MAT is a 2 x 2 matrix, we don't go through the whole process, because it is easily inverted by inspection and it is a very common case. */ static int lambda_matrix_inverse_hard (lambda_matrix, lambda_matrix, int); int lambda_matrix_inverse (lambda_matrix mat, lambda_matrix inv, int n) { if (n == 2) { int a, b, c, d, det; a = mat[0][0]; b = mat[1][0]; c = mat[0][1]; d = mat[1][1]; inv[0][0] = d; inv[0][1] = -c; inv[1][0] = -b; inv[1][1] = a; det = (a * d - b * c); if (det < 0) { det *= -1; inv[0][0] *= -1; inv[1][0] *= -1; inv[0][1] *= -1; inv[1][1] *= -1; } return det; } else return lambda_matrix_inverse_hard (mat, inv, n); } /* If MAT is not a special case, invert it the hard way. */ static int lambda_matrix_inverse_hard (lambda_matrix mat, lambda_matrix inv, int n) { lambda_vector row; lambda_matrix temp; int i, j; int determinant; temp = lambda_matrix_new (n, n); lambda_matrix_copy (mat, temp, n, n); lambda_matrix_id (inv, n); /* Reduce TEMP to a lower triangular form, applying the same operations on INV which starts as the identity matrix. N is the number of rows and columns. */ for (j = 0; j < n; j++) { row = temp[j]; /* Make every element in the current row positive. */ for (i = j; i < n; i++) if (row[i] < 0) { lambda_matrix_col_negate (temp, n, i); lambda_matrix_col_negate (inv, n, i); } /* Sweep the upper triangle. Stop when only the diagonal element in the current row is nonzero. */ while (lambda_vector_first_nz (row, n, j + 1) < n) { int min_col = lambda_vector_min_nz (row, n, j); lambda_matrix_col_exchange (temp, n, j, min_col); lambda_matrix_col_exchange (inv, n, j, min_col); for (i = j + 1; i < n; i++) { int factor; factor = -1 * row[i]; if (row[j] != 1) factor /= row[j]; lambda_matrix_col_add (temp, n, j, i, factor); lambda_matrix_col_add (inv, n, j, i, factor); } } } /* Reduce TEMP from a lower triangular to the identity matrix. Also compute the determinant, which now is simply the product of the elements on the diagonal of TEMP. If one of these elements is 0, the matrix has 0 as an eigenvalue so it is singular and hence not invertible. */ determinant = 1; for (j = n - 1; j >= 0; j--) { int diagonal; row = temp[j]; diagonal = row[j]; /* The matrix must not be singular. */ gcc_assert (diagonal); determinant = determinant * diagonal; /* If the diagonal is not 1, then multiply the each row by the diagonal so that the middle number is now 1, rather than a rational. */ if (diagonal != 1) { for (i = 0; i < j; i++) lambda_matrix_col_mc (inv, n, i, diagonal); for (i = j + 1; i < n; i++) lambda_matrix_col_mc (inv, n, i, diagonal); row[j] = diagonal = 1; } /* Sweep the lower triangle column wise. */ for (i = j - 1; i >= 0; i--) { if (row[i]) { int factor = -row[i]; lambda_matrix_col_add (temp, n, j, i, factor); lambda_matrix_col_add (inv, n, j, i, factor); } } } return determinant; } /* Decompose a N x N matrix MAT to a product of a lower triangular H and a unimodular U matrix such that MAT = H.U. N is the size of the rows of MAT. */ void lambda_matrix_hermite (lambda_matrix mat, int n, lambda_matrix H, lambda_matrix U) { lambda_vector row; int i, j, factor, minimum_col; lambda_matrix_copy (mat, H, n, n); lambda_matrix_id (U, n); for (j = 0; j < n; j++) { row = H[j]; /* Make every element of H[j][j..n] positive. */ for (i = j; i < n; i++) { if (row[i] < 0) { lambda_matrix_col_negate (H, n, i); lambda_vector_negate (U[i], U[i], n); } } /* Stop when only the diagonal element is nonzero. */ while (lambda_vector_first_nz (row, n, j + 1) < n) { minimum_col = lambda_vector_min_nz (row, n, j); lambda_matrix_col_exchange (H, n, j, minimum_col); lambda_matrix_row_exchange (U, j, minimum_col); for (i = j + 1; i < n; i++) { factor = row[i] / row[j]; lambda_matrix_col_add (H, n, j, i, -1 * factor); lambda_matrix_row_add (U, n, i, j, factor); } } } } /* Given an M x N integer matrix A, this function determines an M x M unimodular matrix U, and an M x N echelon matrix S such that "U.A = S". This decomposition is also known as "right Hermite". Ref: Algorithm 2.1 page 33 in "Loop Transformations for Restructuring Compilers" Utpal Banerjee. */ void lambda_matrix_right_hermite (lambda_matrix A, int m, int n, lambda_matrix S, lambda_matrix U) { int i, j, i0 = 0; lambda_matrix_copy (A, S, m, n); lambda_matrix_id (U, m); for (j = 0; j < n; j++) { if (lambda_vector_first_nz (S[j], m, i0) < m) { ++i0; for (i = m - 1; i >= i0; i--) { while (S[i][j] != 0) { int sigma, factor, a, b; a = S[i-1][j]; b = S[i][j]; sigma = (a * b < 0) ? -1: 1; a = abs (a); b = abs (b); factor = sigma * (a / b); lambda_matrix_row_add (S, n, i, i-1, -factor); lambda_matrix_row_exchange (S, i, i-1); lambda_matrix_row_add (U, m, i, i-1, -factor); lambda_matrix_row_exchange (U, i, i-1); } } } } } /* Given an M x N integer matrix A, this function determines an M x M unimodular matrix V, and an M x N echelon matrix S such that "A = V.S". This decomposition is also known as "left Hermite". Ref: Algorithm 2.2 page 36 in "Loop Transformations for Restructuring Compilers" Utpal Banerjee. */ void lambda_matrix_left_hermite (lambda_matrix A, int m, int n, lambda_matrix S, lambda_matrix V) { int i, j, i0 = 0; lambda_matrix_copy (A, S, m, n); lambda_matrix_id (V, m); for (j = 0; j < n; j++) { if (lambda_vector_first_nz (S[j], m, i0) < m) { ++i0; for (i = m - 1; i >= i0; i--) { while (S[i][j] != 0) { int sigma, factor, a, b; a = S[i-1][j]; b = S[i][j]; sigma = (a * b < 0) ? -1: 1; a = abs (a); b = abs (b); factor = sigma * (a / b); lambda_matrix_row_add (S, n, i, i-1, -factor); lambda_matrix_row_exchange (S, i, i-1); lambda_matrix_col_add (V, m, i-1, i, factor); lambda_matrix_col_exchange (V, m, i, i-1); } } } } } /* When it exists, return the first nonzero row in MAT after row STARTROW. Otherwise return rowsize. */ int lambda_matrix_first_nz_vec (lambda_matrix mat, int rowsize, int colsize, int startrow) { int j; bool found = false; for (j = startrow; (j < rowsize) && !found; j++) { if ((mat[j] != NULL) && (lambda_vector_first_nz (mat[j], colsize, startrow) < colsize)) found = true; } if (found) return j - 1; return rowsize; } /* Calculate the projection of E sub k to the null space of B. */ void lambda_matrix_project_to_null (lambda_matrix B, int rowsize, int colsize, int k, lambda_vector x) { lambda_matrix M1, M2, M3, I; int determinant; /* Compute c(I-B^T inv(B B^T) B) e sub k. */ /* M1 is the transpose of B. */ M1 = lambda_matrix_new (colsize, colsize); lambda_matrix_transpose (B, M1, rowsize, colsize); /* M2 = B * B^T */ M2 = lambda_matrix_new (colsize, colsize); lambda_matrix_mult (B, M1, M2, rowsize, colsize, rowsize); /* M3 = inv(M2) */ M3 = lambda_matrix_new (colsize, colsize); determinant = lambda_matrix_inverse (M2, M3, rowsize); /* M2 = B^T (inv(B B^T)) */ lambda_matrix_mult (M1, M3, M2, colsize, rowsize, rowsize); /* M1 = B^T (inv(B B^T)) B */ lambda_matrix_mult (M2, B, M1, colsize, rowsize, colsize); lambda_matrix_negate (M1, M1, colsize, colsize); I = lambda_matrix_new (colsize, colsize); lambda_matrix_id (I, colsize); lambda_matrix_add_mc (I, determinant, M1, 1, M2, colsize, colsize); lambda_matrix_get_column (M2, colsize, k - 1, x); } /* Multiply a vector VEC by a matrix MAT. MAT is an M*N matrix, and VEC is a vector with length N. The result is stored in DEST which must be a vector of length M. */ void lambda_matrix_vector_mult (lambda_matrix matrix, int m, int n, lambda_vector vec, lambda_vector dest) { int i, j; lambda_vector_clear (dest, m); for (i = 0; i < m; i++) for (j = 0; j < n; j++) dest[i] += matrix[i][j] * vec[j]; } /* Print out an M x N matrix MAT to OUTFILE. */ void print_lambda_matrix (FILE * outfile, lambda_matrix matrix, int m, int n) { int i; for (i = 0; i < m; i++) print_lambda_vector (outfile, matrix[i], n); fprintf (outfile, "\n"); }