mrq/reactphysics3d
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Commit

Browse Source 
git-svn-id: https://reactphysics3d.googlecode.com/svn/trunk@19 92aac97c-a6ce-11dd-a772-7fcde58d38e6
This commit is contained in:
chappuis.daniel 2009-02-04 11:11:28 +00:00
parent 9169a58abb
commit e5a19055c6
1 changed files with 26 additions and 12 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

30
sources/reactphysics3d/mathematics/Matrix.cpp
View File

@ -18,6 +18,7 @@
***************************************************************************/ ***************************************************************************/
// Libraries // Libraries
#include <cassert>
#include "Matrix.h" #include "Matrix.h"
// Namespaces // Namespaces
@ -31,6 +32,9 @@ Matrix::Matrix(int nbRow, int nbColumn) throw(std::invalid_argument)
// Create the two dimensional dynamic array // Create the two dimensional dynamic array
array = new double*[nbRow]; array = new double*[nbRow];
assert(array != 0); // Array pointer musn't be null
for(int i=0; i<nbRow; ++i) { for(int i=0; i<nbRow; ++i) {
array[i] = new double[nbColumn]; array[i] = new double[nbColumn];
} }
@ -52,8 +56,11 @@ Matrix::Matrix(int nbRow, int nbColumn) throw(std::invalid_argument)
Matrix::Matrix(const Matrix& matrix) Matrix::Matrix(const Matrix& matrix)
:nbRow(matrix.nbRow), nbColumn(matrix.nbColumn) { :nbRow(matrix.nbRow), nbColumn(matrix.nbColumn) {
// Create the two dimensioCompiling: ../sources/reactphysics3d/mathematics/Matrix3x3.cpp // Create the two dimensional dynamic array
array = new double*[nbRow]; array = new double*[nbRow];
assert(array != 0); // Array pointer musn't be null
for(int i=0; i<nbRow; ++i) { for(int i=0; i<nbRow; ++i) {
array[i] = new double[nbColumn]; array[i] = new double[nbColumn];
} }
@ -210,24 +217,31 @@ double Matrix::getDeterminant() const throw(MathematicsException) {
} }
// Return the trace of the matrix // Return the trace of the matrix
double Matrix::getTrace() const { double Matrix::getTrace() const throw(MathematicsException) {
// Check if the matrix is a square-matrix
if (nbRow == nbColumn) {
double sum = 0.0; double sum = 0.0;
// Compute the trace of the matrix // Compute the trace of the matrix
for(int i=0; i<nbRow; ++i) { for(int i=0; i<nbRow; ++i) {
for(int j=0; j<nbColumn; ++j) { sum = sum + array[i][i];
sum = sum + array[i][j];
}
} }
// Return the trace // Return the trace
return sum; return sum;
}
else {
// We throw an exception because the matrix is non-square
throw MathematicsException("MathematicsException : Impossible to compute the trace for a non-square matrix");
}
} }
// Static function that return a identity matrix of size nxn // Static function that return a identity matrix of size nxn
Matrix Matrix::identityMatrix(int dimension) throw(std::invalid_argument) { Matrix Matrix::identity(int dimension) throw(std::invalid_argument) {
// Argument verification // Argument verification
if (dimension>0) { if (dimension > 0) {
// Create a new matrix // Create a new matrix
Matrix identityMatrix(dimension,dimension); Matrix identityMatrix(dimension,dimension);
@ -248,7 +262,7 @@ Matrix Matrix::identityMatrix(int dimension) throw(std::invalid_argument) {
} }
else { else {
// Throw an exception // Throw an exception
throw std::invalid_argument("Exception : The argument of identityMatrix() has to be positive !"); throw std::invalid_argument("Exception : The argument of identity() has to be positive !");
} }
} }