00001 /*---------------------------------------------------------------------------*\ 00002 ========= | 00003 \\ / F ield | OpenFOAM: The Open Source CFD Toolbox 00004 \\ / O peration | 00005 \\ / A nd | Copyright (C) 1991-2010 OpenCFD Ltd. 00006 \\/ M anipulation | 00007 ------------------------------------------------------------------------------- 00008 License 00009 This file is part of OpenFOAM. 00010 00011 OpenFOAM is free software: you can redistribute it and/or modify it 00012 under the terms of the GNU General Public License as published by 00013 the Free Software Foundation, either version 3 of the License, or 00014 (at your option) any later version. 00015 00016 OpenFOAM is distributed in the hope that it will be useful, but WITHOUT 00017 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 00018 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License 00019 for more details. 00020 00021 You should have received a copy of the GNU General Public License 00022 along with OpenFOAM. If not, see <http://www.gnu.org/licenses/>. 00023 00024 \*---------------------------------------------------------------------------*/ 00025 00026 #include "DiagonalMatrix.H" 00027 00028 // * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * // 00029 00030 template<class Type> 00031 template<class Form> 00032 Foam::DiagonalMatrix<Type>::DiagonalMatrix(const Matrix<Form, Type>& a) 00033 : 00034 List<Type>(min(a.n(), a.m())) 00035 { 00036 forAll(*this, i) 00037 { 00038 this->operator[](i) = a[i][i]; 00039 } 00040 } 00041 00042 00043 template<class Type> 00044 Foam::DiagonalMatrix<Type>::DiagonalMatrix(const label size) 00045 : 00046 List<Type>(size) 00047 {} 00048 00049 00050 template<class Type> 00051 Foam::DiagonalMatrix<Type>::DiagonalMatrix(const label size, const Type& val) 00052 : 00053 List<Type>(size, val) 00054 {} 00055 00056 00057 template<class Type> 00058 Foam::DiagonalMatrix<Type>& Foam::DiagonalMatrix<Type>::invert() 00059 { 00060 forAll(*this, i) 00061 { 00062 Type x = this->operator[](i); 00063 if (mag(x) < VSMALL) 00064 { 00065 this->operator[](i) = Type(0); 00066 } 00067 else 00068 { 00069 this->operator[](i) = Type(1)/x; 00070 } 00071 } 00072 00073 return this; 00074 } 00075 00076 00077 template<class Type> 00078 Foam::DiagonalMatrix<Type> Foam::inv(const DiagonalMatrix<Type>& A) 00079 { 00080 DiagonalMatrix<Type> Ainv = A; 00081 00082 forAll(A, i) 00083 { 00084 Type x = A[i]; 00085 if (mag(x) < VSMALL) 00086 { 00087 Ainv[i] = Type(0); 00088 } 00089 else 00090 { 00091 Ainv[i] = Type(1)/x; 00092 } 00093 } 00094 00095 return Ainv; 00096 } 00097 00098 00099 // ************************ vim: set sw=4 sts=4 et: ************************ //