0030675: Visualization - remove redundant proxy classes in hierarchy of PrsMgr_Presen...
[occt.git] / src / GeomLib / GeomLib_Interpolate.cxx
1 // Created on: 1996-08-30
2 // Created by: Xavier BENVENISTE
3 // Copyright (c) 1996-1999 Matra Datavision
4 // Copyright (c) 1999-2014 OPEN CASCADE SAS
5 //
6 // This file is part of Open CASCADE Technology software library.
7 //
8 // This library is free software; you can redistribute it and/or modify it under
9 // the terms of the GNU Lesser General Public License version 2.1 as published
10 // by the Free Software Foundation, with special exception defined in the file
11 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
12 // distribution for complete text of the license and disclaimer of any warranty.
13 //
14 // Alternatively, this file may be used under the terms of Open CASCADE
15 // commercial license or contractual agreement.
16
17
18 #include <BSplCLib.hxx>
19 #include <Geom_BSplineCurve.hxx>
20 #include <GeomLib_Interpolate.hxx>
21 #include <gp_Vec.hxx>
22 #include <PLib.hxx>
23 #include <Standard_ConstructionError.hxx>
24 #include <Standard_OutOfRange.hxx>
25 #include <StdFail_NotDone.hxx>
26 #include <TColgp_Array1OfPnt.hxx>
27 #include <TColgp_Array1OfVec.hxx>
28 #include <TColStd_Array1OfBoolean.hxx>
29 #include <TColStd_Array1OfInteger.hxx>
30 #include <TColStd_HArray1OfBoolean.hxx>
31 #include <TColStd_HArray1OfReal.hxx>
32
33 //=======================================================================
34 //function : GeomLib_Interpolate
35 //purpose  : 
36 //=======================================================================
37 GeomLib_Interpolate::GeomLib_Interpolate
38 (const Standard_Integer      Degree,
39  const Standard_Integer      NumPoints,
40  const TColgp_Array1OfPnt&   PointsArray,
41  const TColStd_Array1OfReal& ParametersArray) 
42                                          
43 {
44   Standard_Integer ii,
45   num_knots,
46   inversion_problem,
47   num_controls,
48   jj ;
49   
50   
51   if (NumPoints < Degree ||
52       PointsArray.Lower() != 1 ||
53       PointsArray.Upper() < NumPoints ||
54       ParametersArray.Lower() != 1 ||
55       ParametersArray.Upper() < NumPoints) {
56     myError = GeomLib_NotEnoughtPoints ;
57   }
58   else if (Degree < 3) {
59     myError = GeomLib_DegreeSmallerThan3 ;
60   }
61   else {
62     gp_Pnt null_point(0.0e0, 0.0e0, 0.0e0) ;
63     Standard_Integer  order  = Degree + 1,
64     half_order ;
65     if (order  % 2) {
66       order  -= 1 ;
67     }
68     half_order = order / 2 ;
69     num_knots = NumPoints + 2 *  order - 2  ;
70     num_controls = num_knots - order ;
71     TColStd_Array1OfReal       flat_knots(1,num_knots) ;
72     TColStd_Array1OfInteger    contacts  (1,num_controls) ;
73     TColStd_Array1OfInteger    multiplicities(1, NumPoints) ;
74     TColStd_Array1OfReal       parameters(1,num_controls) ;
75     TColgp_Array1OfPnt         poles(1,num_controls) ;
76     
77     for (ii = 1 ; ii <= NumPoints ; ii++) {
78       multiplicities(ii) = 1 ;
79     }
80     multiplicities(1)         = order ;
81     multiplicities(NumPoints) = order ;
82     for (ii = 1,
83          jj = num_controls + 1 ; ii <=  order ; ii++, jj++) {
84
85       flat_knots(ii) = ParametersArray(1) ;
86       flat_knots(jj) = ParametersArray(NumPoints) ;
87     }
88     jj = order + 1 ;
89     for (ii = 2 ; ii < NumPoints ; ii++) {
90       flat_knots(jj) = ParametersArray(ii) ;
91       jj+= 1 ;
92     }
93     for (ii = 1 ; ii <= num_controls ; ii++) {
94       contacts(ii) = 0 ;
95     }
96     jj = num_controls ;
97     for (ii = 1 ; ii <= half_order ; ii++) {
98       contacts(ii) = half_order + ii - 1 ;
99       parameters(ii) = ParametersArray(1) ;
100       poles(ii) = null_point ;   
101       contacts(jj) = half_order + ii - 1 ;
102       parameters(jj) = ParametersArray(NumPoints) ;
103       poles(jj) = null_point ;
104       jj -= 1 ;
105     }
106     jj = half_order + 1 ;
107     for (ii = 2 ; ii < NumPoints ; ii++) {
108       parameters(jj) = ParametersArray(ii) ;
109       poles(jj) = PointsArray(ii) ;
110       jj += 1 ;
111     }
112     contacts(1) = 0 ;
113     contacts(num_controls) = 0 ;
114     poles(1) = PointsArray(1)  ;
115     poles(num_controls) = PointsArray(NumPoints) ;
116     BSplCLib::Interpolate(order-1,
117                           flat_knots,
118                           parameters,
119                           contacts,
120                           poles,
121                           inversion_problem) ;
122     
123     if (!inversion_problem) {
124       myCurve =
125         new Geom_BSplineCurve(poles,
126                               ParametersArray,
127                               multiplicities,
128                               order-1) ;
129       myIsDone = Standard_True ;
130     } 
131     else {
132       myError = GeomLib_InversionProblem ;
133     }
134   }
135 }
136     
137
138
139 //=======================================================================
140 //function : Curve
141 //purpose  : 
142 //=======================================================================
143
144 Handle(Geom_BSplineCurve) GeomLib_Interpolate::Curve() const 
145 {
146   return myCurve ;
147 }
148