--- trunk/src/math/SquareMatrix3.hpp 2006/02/02 16:49:16 882 +++ trunk/src/math/SquareMatrix3.hpp 2006/02/02 17:14:15 883 @@ -316,6 +316,16 @@ namespace oopse { m /= det; return m; + } + + SquareMatrix3 transpose() const{ + SquareMatrix3 result; + + for (unsigned int i = 0; i < 3; i++) + for (unsigned int j = 0; j < 3; j++) + result(j, i) = this->data_[i][j]; + + return result; } /** * Extract the eigenvalues and eigenvectors from a 3x3 matrix.