b311480e |
1 | // Copyright (c) 1997-1999 Matra Datavision |
2 | // Copyright (c) 1999-2012 OPEN CASCADE SAS |
3 | // |
4 | // The content of this file is subject to the Open CASCADE Technology Public |
5 | // License Version 6.5 (the "License"). You may not use the content of this file |
6 | // except in compliance with the License. Please obtain a copy of the License |
7 | // at http://www.opencascade.org and read it completely before using this file. |
8 | // |
9 | // The Initial Developer of the Original Code is Open CASCADE S.A.S., having its |
10 | // main offices at: 1, place des Freres Montgolfier, 78280 Guyancourt, France. |
11 | // |
12 | // The Original Code and all software distributed under the License is |
13 | // distributed on an "AS IS" basis, without warranty of any kind, and the |
14 | // Initial Developer hereby disclaims all such warranties, including without |
15 | // limitation, any warranties of merchantability, fitness for a particular |
16 | // purpose or non-infringement. Please see the License for the specific terms |
17 | // and conditions governing the rights and limitations under the License. |
18 | |
7fd59977 |
19 | //#ifndef DEB |
20 | #define No_Standard_RangeError |
21 | #define No_Standard_OutOfRange |
22 | #define No_Standard_DimensionError |
23 | //#endif |
24 | |
25 | #include <math_GaussLeastSquare.ixx> |
26 | #include <math_Recipes.hxx> |
27 | |
28 | #include <StdFail_NotDone.hxx> |
29 | #include <Standard_DimensionError.hxx> |
30 | |
31 | |
32 | math_GaussLeastSquare::math_GaussLeastSquare (const math_Matrix& A, |
33 | const Standard_Real MinPivot) : |
34 | LU(1, A.ColNumber(), |
35 | 1, A.ColNumber()), |
36 | A2(1, A.ColNumber(), |
37 | 1, A.RowNumber()), |
38 | Index(1, A.ColNumber()) { |
39 | A2 = A.Transposed(); |
40 | LU.Multiply(A2, A); |
41 | |
42 | Standard_Integer Error = LU_Decompose(LU, Index, D, MinPivot); |
43 | Done = (!Error) ? Standard_True : Standard_False; |
44 | |
45 | } |
46 | |
47 | void math_GaussLeastSquare::Solve(const math_Vector& B, math_Vector& X) const{ |
48 | StdFail_NotDone_Raise_if(!Done, " "); |
49 | Standard_DimensionError_Raise_if((B.Length() != A2.ColNumber()) || |
50 | (X.Length() != A2.RowNumber()), " "); |
51 | |
52 | X.Multiply(A2, B); |
53 | |
54 | LU_Solve(LU, Index, X); |
55 | |
56 | return; |
57 | } |
58 | |
59 | |
60 | void math_GaussLeastSquare::Dump(Standard_OStream& o) const { |
61 | |
62 | o <<"math_GaussLeastSquare "; |
63 | if (Done) { |
64 | o << " Status = Done \n"; |
65 | } |
66 | else { |
67 | o << "Status = not Done \n"; |
68 | } |
69 | } |
70 | |
71 | |