b311480e |
1 | // Created on: 1994-08-18 |
2 | // Created by: Laurent PAINNOT |
3 | // Copyright (c) 1994-1999 Matra Datavision |
973c2be1 |
4 | // Copyright (c) 1999-2014 OPEN CASCADE SAS |
b311480e |
5 | // |
973c2be1 |
6 | // This file is part of Open CASCADE Technology software library. |
b311480e |
7 | // |
d5f74e42 |
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 |
973c2be1 |
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. |
7fd59977 |
13 | // |
973c2be1 |
14 | // Alternatively, this file may be used under the terms of Open CASCADE |
15 | // commercial license or contractual agreement. |
b311480e |
16 | |
17 | // 8-Aug-95 : xab : interpolation uses BSplCLib::Interpolate |
7fd59977 |
18 | |
7fd59977 |
19 | #include <BSplCLib.hxx> |
42cf5bc1 |
20 | #include <Geom2d_BSplineCurve.hxx> |
21 | #include <Geom2dAPI_Interpolate.hxx> |
7fd59977 |
22 | #include <gp_Vec2d.hxx> |
42cf5bc1 |
23 | #include <PLib.hxx> |
24 | #include <Standard_ConstructionError.hxx> |
25 | #include <StdFail_NotDone.hxx> |
7fd59977 |
26 | #include <TColgp_Array1OfPnt2d.hxx> |
7fd59977 |
27 | #include <TColStd_Array1OfBoolean.hxx> |
28 | #include <TColStd_Array1OfInteger.hxx> |
29 | #include <TColStd_HArray1OfBoolean.hxx> |
42cf5bc1 |
30 | #include <TColStd_HArray1OfReal.hxx> |
7fd59977 |
31 | |
32 | //======================================================================= |
33 | //function : CheckPoints |
34 | //purpose : |
35 | //======================================================================= |
7fd59977 |
36 | static Standard_Boolean CheckPoints(const TColgp_Array1OfPnt2d& PointArray, |
37 | const Standard_Real Tolerance) |
38 | { |
39 | Standard_Integer ii ; |
40 | Standard_Real tolerance_squared = Tolerance * Tolerance, |
41 | distance_squared ; |
42 | Standard_Boolean result = Standard_True ; |
43 | for (ii = PointArray.Lower() ; result && ii < PointArray.Upper() ; ii++) { |
44 | distance_squared = |
45 | PointArray.Value(ii).SquareDistance(PointArray.Value(ii+1)) ; |
46 | result = (distance_squared >= tolerance_squared) ; |
47 | } |
48 | return result ; |
49 | |
50 | } |
51 | //======================================================================= |
52 | //function : CheckTangents |
53 | //purpose : |
54 | //======================================================================= |
55 | static Standard_Boolean CheckTangents( |
56 | const TColgp_Array1OfVec2d& Tangents, |
57 | const TColStd_Array1OfBoolean& TangentFlags, |
58 | const Standard_Real Tolerance) |
59 | { |
60 | Standard_Integer ii, |
61 | index ; |
62 | Standard_Real tolerance_squared = Tolerance * Tolerance, |
63 | distance_squared ; |
64 | Standard_Boolean result = Standard_True ; |
65 | index = TangentFlags.Lower() ; |
66 | for (ii = Tangents.Lower(); result && ii <= Tangents.Upper() ; ii++) { |
67 | if(TangentFlags.Value(index)) { |
68 | distance_squared = |
69 | Tangents.Value(ii).SquareMagnitude() ; |
70 | result = (distance_squared >= tolerance_squared) ; |
71 | } |
72 | index += 1 ; |
73 | } |
74 | return result ; |
75 | |
76 | } |
77 | //======================================================================= |
78 | //function : CheckParameters |
79 | //purpose : |
80 | //======================================================================= |
81 | static Standard_Boolean CheckParameters(const |
82 | TColStd_Array1OfReal& Parameters) |
83 | { |
84 | Standard_Integer ii ; |
85 | Standard_Real distance ; |
86 | Standard_Boolean result = Standard_True ; |
87 | for (ii = Parameters.Lower() ; result && ii < Parameters.Upper() ; ii++) { |
88 | distance = |
89 | Parameters.Value(ii+1) - Parameters.Value(ii) ; |
90 | result = (distance >= RealSmall()) ; |
91 | } |
92 | return result ; |
93 | } |
94 | //======================================================================= |
95 | //function : BuildParameters |
96 | //purpose : |
97 | //======================================================================= |
98 | static void BuildParameters(const Standard_Boolean PeriodicFlag, |
99 | const TColgp_Array1OfPnt2d& PointsArray, |
857ffd5e |
100 | Handle(TColStd_HArray1OfReal)& ParametersPtr) |
7fd59977 |
101 | { |
102 | Standard_Integer ii, |
103 | index ; |
104 | Standard_Real distance ; |
105 | Standard_Integer |
106 | num_parameters = PointsArray.Length() ; |
107 | if (PeriodicFlag) { |
108 | num_parameters += 1 ; |
109 | } |
110 | ParametersPtr = |
111 | new TColStd_HArray1OfReal(1, |
112 | num_parameters) ; |
113 | ParametersPtr->SetValue(1,0.0e0) ; |
114 | index = 2 ; |
115 | for (ii = PointsArray.Lower() ; ii < PointsArray.Upper() ; ii++) { |
116 | distance = |
117 | PointsArray.Value(ii).Distance(PointsArray.Value(ii+1)) ; |
118 | ParametersPtr->SetValue(index, |
119 | ParametersPtr->Value(ii) + distance) ; |
120 | index += 1 ; |
121 | } |
122 | if (PeriodicFlag) { |
123 | distance = |
124 | PointsArray.Value(PointsArray.Upper()). |
125 | Distance(PointsArray.Value(PointsArray.Lower())) ; |
126 | ParametersPtr->SetValue(index, |
127 | ParametersPtr->Value(ii) + distance) ; |
128 | } |
129 | } |
130 | //======================================================================= |
131 | //function : BuildPeriodicTangents |
132 | //purpose : |
133 | //======================================================================= |
134 | |
135 | static void BuildPeriodicTangent( |
136 | const TColgp_Array1OfPnt2d& PointsArray, |
137 | TColgp_Array1OfVec2d& TangentsArray, |
138 | TColStd_Array1OfBoolean& TangentFlags, |
139 | const TColStd_Array1OfReal& ParametersArray) |
140 | { |
141 | Standard_Integer |
142 | ii, |
143 | degree ; |
144 | Standard_Real *point_array, |
145 | *parameter_array, |
146 | eval_result[2][2] ; |
147 | |
148 | gp_Vec2d a_vector ; |
149 | |
150 | if (PointsArray.Length() < 3) { |
9775fa61 |
151 | throw Standard_ConstructionError(); |
7fd59977 |
152 | } |
153 | |
154 | if (!TangentFlags.Value(1)) { |
155 | degree = 3 ; |
156 | if (PointsArray.Length() == 3) { |
157 | degree = 2 ; |
158 | } |
159 | point_array = (Standard_Real *) &PointsArray.Value(PointsArray.Lower()) ; |
160 | parameter_array = |
161 | (Standard_Real *) &ParametersArray.Value(1) ; |
162 | TangentFlags.SetValue(1,Standard_True) ; |
163 | PLib::EvalLagrange(ParametersArray.Value(1), |
164 | 1, |
165 | degree, |
166 | 2, |
167 | point_array[0], |
168 | parameter_array[0], |
169 | eval_result[0][0]) ; |
170 | for (ii = 1 ; ii <= 2 ; ii++) { |
171 | a_vector.SetCoord(ii,eval_result[1][ii-1]) ; |
172 | } |
173 | TangentsArray.SetValue(1,a_vector) ; |
174 | } |
175 | } |
176 | //======================================================================= |
177 | //function : BuildTangents |
178 | //purpose : |
179 | //======================================================================= |
180 | |
181 | static void BuildTangents(const TColgp_Array1OfPnt2d& PointsArray, |
182 | TColgp_Array1OfVec2d& TangentsArray, |
183 | TColStd_Array1OfBoolean& TangentFlags, |
184 | const TColStd_Array1OfReal& ParametersArray) |
185 | { |
186 | Standard_Integer ii, |
187 | degree ; |
188 | Standard_Real *point_array, |
189 | *parameter_array, |
190 | |
191 | eval_result[2][2] ; |
192 | gp_Vec2d a_vector ; |
193 | |
194 | degree = 3 ; |
195 | |
196 | if ( PointsArray.Length() < 3) { |
9775fa61 |
197 | throw Standard_ConstructionError(); |
7fd59977 |
198 | } |
199 | if (PointsArray.Length() == 3) { |
200 | degree = 2 ; |
201 | } |
202 | if (!TangentFlags.Value(1)) { |
203 | point_array = (Standard_Real *) &PointsArray.Value(PointsArray.Lower()) ; |
204 | parameter_array = |
205 | (Standard_Real *) &ParametersArray.Value(1) ; |
206 | TangentFlags.SetValue(1,Standard_True) ; |
207 | PLib::EvalLagrange(ParametersArray.Value(1), |
208 | 1, |
209 | degree, |
210 | 2, |
211 | point_array[0], |
212 | parameter_array[0], |
213 | eval_result[0][0]) ; |
214 | for (ii = 1 ; ii <= 2 ; ii++) { |
215 | a_vector.SetCoord(ii,eval_result[1][ii-1]) ; |
216 | } |
217 | TangentsArray.SetValue(1,a_vector) ; |
218 | } |
219 | if (! TangentFlags.Value(TangentFlags.Upper())) { |
220 | point_array = |
221 | (Standard_Real *) &PointsArray.Value(PointsArray.Upper() - degree) ; |
222 | TangentFlags.SetValue(TangentFlags.Upper(),Standard_True) ; |
223 | parameter_array = |
224 | (Standard_Real *)&ParametersArray.Value(ParametersArray.Upper() - degree) ; |
225 | PLib::EvalLagrange(ParametersArray.Value(ParametersArray.Upper()), |
226 | 1, |
227 | degree, |
228 | 2, |
229 | point_array[0], |
230 | parameter_array[0], |
231 | eval_result[0][0]) ; |
232 | for (ii = 1 ; ii <= 2 ; ii++) { |
233 | a_vector.SetCoord(ii,eval_result[1][ii-1]) ; |
234 | } |
235 | TangentsArray.SetValue(TangentsArray.Upper(),a_vector) ; |
236 | } |
237 | } |
238 | //======================================================================= |
239 | //function : BuildTangents |
240 | //purpose : scale the given tangent so that they have the length of |
241 | // the size of the derivative of the lagrange interpolation |
242 | // |
243 | //======================================================================= |
244 | static void ScaleTangents(const TColgp_Array1OfPnt2d& PointsArray, |
245 | TColgp_Array1OfVec2d& TangentsArray, |
246 | const TColStd_Array1OfBoolean& TangentFlags, |
247 | const TColStd_Array1OfReal& ParametersArray) |
248 | { |
249 | Standard_Integer ii, |
250 | jj, |
251 | degree=0, |
252 | index, |
253 | num_points ; |
254 | |
255 | Standard_Real *point_array, |
256 | *parameter_array, |
257 | value[2], |
258 | ratio, |
259 | eval_result[2][2] ; |
260 | |
261 | gp_Vec2d a_vector ; |
262 | |
263 | num_points = PointsArray.Length() ; |
264 | if (num_points == 2) { |
265 | degree = 1 ; |
266 | } |
267 | else if (num_points >= 3) { |
268 | degree = 2 ; |
269 | } |
270 | |
271 | index = PointsArray.Lower() ; |
272 | for (ii = TangentFlags.Lower() ; ii <= TangentFlags.Upper() ; ii++) { |
273 | if (TangentFlags.Value(ii)) { |
274 | point_array = |
275 | (Standard_Real *) &PointsArray.Value(index) ; |
276 | parameter_array = |
277 | (Standard_Real *) &ParametersArray.Value(index) ; |
278 | PLib::EvalLagrange(ParametersArray.Value(ii), |
279 | 1, |
280 | degree, |
281 | 2, |
282 | point_array[0], |
283 | parameter_array[0], |
284 | eval_result[0][0]) ; |
285 | value[0] = |
286 | value[1] = 0.0e0 ; |
287 | for (jj = 1 ; jj <= 2 ; jj++) { |
288 | value[0] += Abs(TangentsArray.Value(ii).Coord(jj)) ; |
289 | value[1] += Abs(eval_result[1][jj-1]) ; |
290 | } |
291 | ratio = value[1] / value[0] ; |
292 | for (jj = 1 ; jj <= 2 ; jj++) { |
293 | a_vector.SetCoord(jj, ratio * |
294 | TangentsArray.Value(ii).Coord(jj)) ; |
295 | } |
296 | TangentsArray.SetValue(ii, a_vector) ; |
297 | if (ii != TangentFlags.Lower()) { |
298 | index += 1 ; |
299 | } |
300 | if (index > PointsArray.Upper() - degree) { |
301 | index = PointsArray.Upper() - degree ; |
302 | } |
303 | |
304 | } |
305 | } |
306 | } |
307 | |
308 | //======================================================================= |
309 | //function : Geom2dAPI_Interpolate |
310 | //purpose : |
311 | //======================================================================= |
312 | |
313 | Geom2dAPI_Interpolate::Geom2dAPI_Interpolate |
857ffd5e |
314 | (const Handle(TColgp_HArray1OfPnt2d)& PointsPtr, |
7fd59977 |
315 | const Standard_Boolean PeriodicFlag, |
316 | const Standard_Real Tolerance) : |
317 | myTolerance(Tolerance), |
318 | myPoints(PointsPtr), |
319 | myIsDone(Standard_False), |
320 | myPeriodic(PeriodicFlag), |
321 | myTangentRequest(Standard_False) |
322 | |
323 | { |
324 | Standard_Integer ii ; |
325 | Standard_Boolean result = |
326 | CheckPoints(PointsPtr->Array1(), |
327 | Tolerance) ; |
328 | myTangents = |
329 | new TColgp_HArray1OfVec2d(myPoints->Lower(), |
330 | myPoints->Upper()) ; |
331 | myTangentFlags = |
332 | new TColStd_HArray1OfBoolean(myPoints->Lower(), |
333 | myPoints->Upper()) ; |
334 | |
335 | if (!result) { |
9775fa61 |
336 | throw Standard_ConstructionError(); |
7fd59977 |
337 | } |
338 | BuildParameters(PeriodicFlag, |
339 | PointsPtr->Array1(), |
340 | myParameters) ; |
341 | |
342 | for (ii = myPoints->Lower() ; ii <= myPoints->Upper() ; ii++) { |
343 | myTangentFlags->SetValue(ii,Standard_False) ; |
344 | } |
345 | |
346 | |
347 | |
348 | } |
349 | |
350 | //======================================================================= |
351 | //function : Geom2dAPI_Interpolate |
352 | //purpose : |
353 | //======================================================================= |
354 | |
355 | Geom2dAPI_Interpolate::Geom2dAPI_Interpolate |
857ffd5e |
356 | (const Handle(TColgp_HArray1OfPnt2d)& PointsPtr, |
357 | const Handle(TColStd_HArray1OfReal)& ParametersPtr, |
7fd59977 |
358 | const Standard_Boolean PeriodicFlag, |
359 | const Standard_Real Tolerance) : |
360 | myTolerance(Tolerance), |
361 | myPoints(PointsPtr), |
362 | myIsDone(Standard_False), |
363 | myParameters(ParametersPtr), |
364 | myPeriodic(PeriodicFlag), |
365 | myTangentRequest(Standard_False) |
366 | { |
367 | Standard_Integer ii ; |
368 | |
369 | |
370 | Standard_Boolean result = |
371 | CheckPoints(PointsPtr->Array1(), |
372 | Tolerance) ; |
373 | |
374 | if (PeriodicFlag) { |
375 | if ((PointsPtr->Length()) + 1 != ParametersPtr->Length()) { |
9775fa61 |
376 | throw Standard_ConstructionError(); |
7fd59977 |
377 | } |
378 | } |
379 | myTangents = |
380 | new TColgp_HArray1OfVec2d(myPoints->Lower(), |
381 | myPoints->Upper()) ; |
382 | myTangentFlags = |
383 | new TColStd_HArray1OfBoolean(myPoints->Lower(), |
384 | myPoints->Upper()) ; |
385 | |
386 | if (!result) { |
9775fa61 |
387 | throw Standard_ConstructionError(); |
7fd59977 |
388 | } |
389 | |
390 | result = |
391 | CheckParameters(ParametersPtr->Array1()) ; |
392 | if (!result) { |
9775fa61 |
393 | throw Standard_ConstructionError(); |
7fd59977 |
394 | } |
395 | |
396 | for (ii = myPoints->Lower() ; ii <= myPoints->Upper() ; ii++) { |
397 | myTangentFlags->SetValue(ii,Standard_False) ; |
398 | } |
399 | |
400 | } |
401 | //======================================================================= |
402 | //function : Load |
403 | //purpose : |
404 | //======================================================================= |
405 | |
406 | void Geom2dAPI_Interpolate::Load( |
407 | const TColgp_Array1OfVec2d& Tangents, |
353e6fa0 |
408 | const Handle(TColStd_HArray1OfBoolean)& TangentFlagsPtr, |
409 | const Standard_Boolean Scale) |
7fd59977 |
410 | |
411 | { |
412 | Standard_Boolean result ; |
413 | Standard_Integer ii ; |
414 | myTangentRequest = Standard_True ; |
415 | myTangentFlags = TangentFlagsPtr ; |
416 | if (Tangents.Length() != myPoints->Length() || |
417 | TangentFlagsPtr->Length() != myPoints->Length()) { |
9775fa61 |
418 | throw Standard_ConstructionError(); |
7fd59977 |
419 | } |
420 | result = |
421 | CheckTangents(Tangents, |
422 | TangentFlagsPtr->Array1(), |
423 | myTolerance) ; |
424 | if (result) { |
425 | myTangents = |
426 | new TColgp_HArray1OfVec2d(Tangents.Lower(),Tangents.Upper()) ; |
427 | for (ii = Tangents.Lower() ; ii <= Tangents.Upper() ; ii++ ) { |
428 | myTangents->SetValue(ii,Tangents.Value(ii)) ; |
429 | } |
353e6fa0 |
430 | if (Scale) { |
431 | ScaleTangents(myPoints->Array1(), |
432 | myTangents->ChangeArray1(), |
433 | TangentFlagsPtr->Array1(), |
434 | myParameters->Array1()) ; |
435 | } |
7fd59977 |
436 | } |
437 | else { |
9775fa61 |
438 | throw Standard_ConstructionError(); |
7fd59977 |
439 | } |
440 | |
441 | |
442 | } |
443 | |
444 | //======================================================================= |
445 | //function : Load |
446 | //purpose : |
447 | //======================================================================= |
448 | |
449 | void Geom2dAPI_Interpolate::Load(const gp_Vec2d& InitialTangent, |
353e6fa0 |
450 | const gp_Vec2d& FinalTangent, |
451 | const Standard_Boolean Scale) |
7fd59977 |
452 | { |
453 | Standard_Boolean result ; |
454 | myTangentRequest = Standard_True ; |
455 | myTangentFlags->SetValue(1,Standard_True) ; |
456 | myTangentFlags->SetValue(myPoints->Length(),Standard_True) ; |
457 | myTangents->SetValue(1,InitialTangent) ; |
458 | myTangents->SetValue(myPoints->Length(),FinalTangent); |
459 | result = |
460 | CheckTangents(myTangents->Array1(), |
461 | myTangentFlags->Array1(), |
462 | myTolerance) ; |
463 | if (!result) { |
9775fa61 |
464 | throw Standard_ConstructionError(); |
7fd59977 |
465 | } |
353e6fa0 |
466 | if (Scale) { |
467 | ScaleTangents(myPoints->Array1(), |
468 | myTangents->ChangeArray1(), |
469 | myTangentFlags->Array1(), |
470 | myParameters->Array1()) ; |
471 | } |
7fd59977 |
472 | |
473 | } |
474 | //======================================================================= |
475 | //function : Perform |
476 | //purpose : |
477 | //======================================================================= |
478 | |
479 | void Geom2dAPI_Interpolate::Perform() |
480 | { |
481 | if (myPeriodic) { |
482 | PerformPeriodic() ; |
483 | } |
484 | else { |
485 | PerformNonPeriodic() ; |
486 | } |
487 | } |
488 | //======================================================================= |
489 | //function : PerformPeriodic |
490 | //purpose : |
491 | //======================================================================= |
492 | |
493 | void Geom2dAPI_Interpolate::PerformPeriodic() |
494 | { |
495 | Standard_Integer degree, |
496 | ii, |
497 | jj, |
498 | index, |
499 | index1, |
500 | // index2, |
501 | mult_index, |
502 | half_order, |
503 | inversion_problem, |
504 | num_points, |
505 | num_distinct_knots, |
506 | num_poles ; |
507 | |
508 | Standard_Real period ; |
509 | |
510 | gp_Pnt2d a_point ; |
511 | |
512 | num_points = myPoints->Length() ; |
513 | period = myParameters->Value(myParameters->Upper()) - |
514 | myParameters->Value(myParameters->Lower()) ; |
515 | num_poles = num_points + 1 ; |
516 | if (num_points == 2 && !myTangentRequest) { |
517 | // |
518 | // build a periodic curve of degree 1 |
519 | // |
520 | |
521 | degree = 1 ; |
522 | TColStd_Array1OfInteger deg1_mults(1,num_poles) ; |
523 | for (ii = 1 ; ii <= num_poles ; ii++) { |
524 | deg1_mults.SetValue(ii,1) ; |
525 | } |
526 | |
527 | myCurve = |
528 | new Geom2d_BSplineCurve(myPoints->Array1(), |
529 | myParameters->Array1(), |
530 | deg1_mults, |
531 | degree, |
532 | myPeriodic) ; |
533 | myIsDone = Standard_True ; |
534 | |
535 | } |
536 | else { |
537 | num_distinct_knots = num_points + 1 ; |
538 | half_order = 2 ; |
539 | degree = 3 ; |
540 | num_poles += 2 ; |
541 | if (myTangentRequest) |
542 | for (ii = myTangentFlags->Lower() + 1 ; |
543 | ii <= myTangentFlags->Upper() ; ii++) { |
544 | if (myTangentFlags->Value(ii)) { |
545 | num_poles += 1 ; |
546 | } |
547 | } |
548 | |
549 | TColStd_Array1OfReal parameters(1,num_poles) ; |
550 | TColStd_Array1OfReal flatknots(1,num_poles + degree + 1) ; |
551 | TColStd_Array1OfInteger mults(1,num_distinct_knots) ; |
552 | TColStd_Array1OfInteger contact_order_array(1, num_poles) ; |
553 | TColgp_Array1OfPnt2d poles(1,num_poles) ; |
554 | |
555 | for (ii = 1 ; ii <= half_order ; ii++) { |
556 | flatknots.SetValue(ii,myParameters->Value(myParameters->Upper() -1) - |
557 | period) ; |
558 | flatknots.SetValue(ii + half_order,myParameters-> |
559 | Value(myParameters->Lower())) ; |
560 | flatknots.SetValue(num_poles + ii, |
561 | myParameters->Value(myParameters->Upper())) ; |
562 | flatknots.SetValue(num_poles + half_order + ii, |
563 | myParameters->Value(half_order) + period) ; |
564 | } |
565 | for (ii = 1 ; ii <= num_poles ; ii++) { |
566 | contact_order_array.SetValue(ii,0) ; |
567 | } |
568 | for (ii = 2 ; ii < num_distinct_knots ; ii++) { |
569 | mults.SetValue(ii,1) ; |
570 | } |
571 | mults.SetValue(1,half_order) ; |
572 | mults.SetValue(num_distinct_knots ,half_order) ; |
573 | if (num_points >= 3) { |
574 | |
575 | // |
576 | // only enter here if there are more than 3 points otherwise |
577 | // it means we have already the tangent |
578 | // |
579 | BuildPeriodicTangent(myPoints->Array1(), |
580 | myTangents->ChangeArray1(), |
581 | myTangentFlags->ChangeArray1(), |
582 | myParameters->Array1()) ; |
583 | } |
584 | contact_order_array.SetValue(2,1) ; |
585 | parameters.SetValue(1,myParameters->Value(1)) ; |
586 | parameters.SetValue(2,myParameters->Value(1)) ; |
587 | poles.SetValue(1,myPoints->Value(1)) ; |
588 | for (jj = 1 ; jj <= 2 ; jj++) { |
589 | a_point.SetCoord(jj,myTangents->Value(1).Coord(jj)) ; |
590 | } |
591 | poles.SetValue(2,a_point) ; |
592 | |
593 | mult_index = 2 ; |
594 | index = 3 ; |
595 | index1 = degree + 2 ; |
596 | if (myTangentRequest) { |
597 | for (ii = myTangentFlags->Lower() + 1 ; |
598 | ii <= myTangentFlags->Upper() ; ii++) { |
599 | parameters.SetValue(index,myParameters->Value(ii)) ; |
600 | flatknots.SetValue(index1,myParameters->Value(ii)) ; |
601 | poles.SetValue(index,myPoints->Value(ii)) ; |
602 | index += 1 ; |
603 | index1 += 1 ; |
604 | if (myTangentFlags->Value(ii)) { |
605 | mults.SetValue(mult_index,mults.Value(mult_index) + 1) ; |
606 | contact_order_array(index) = 1 ; |
607 | |
608 | parameters.SetValue(index, |
609 | myParameters->Value(ii)) ; |
610 | flatknots.SetValue(index1,myParameters->Value(ii)) ; |
611 | for (jj = 1 ; jj <= 2 ; jj++) { |
612 | a_point.SetCoord(jj,myTangents->Value(ii).Coord(jj)) ; |
613 | } |
614 | poles.SetValue(index,a_point) ; |
615 | index += 1 ; |
616 | index1 += 1 ; |
617 | } |
618 | mult_index += 1 ; |
619 | } |
620 | } |
621 | else { |
622 | index = degree + 1 ; |
623 | index1 = 2 ; |
624 | for(ii = myParameters->Lower() ; ii <= myParameters->Upper() ; ii++) { |
625 | parameters.SetValue(index1, |
626 | myParameters->Value(ii)) ; |
627 | flatknots.SetValue(index, |
628 | myParameters->Value(ii)) ; |
629 | index += 1 ; |
630 | index1 += 1 ; |
631 | } |
632 | index = 3 ; |
633 | for (ii = myPoints->Lower() + 1 ; ii <= myPoints->Upper() ; ii++) { |
634 | // |
635 | // copy all the given points since the last one will be initialized |
636 | // below by the first point in the array myPoints |
637 | // |
638 | poles.SetValue(index, |
639 | myPoints->Value(ii)) ; |
640 | index += 1 ; |
641 | } |
642 | |
643 | } |
644 | contact_order_array.SetValue(num_poles - 1, 1) ; |
645 | parameters.SetValue(num_poles-1, |
646 | myParameters->Value(myParameters->Upper())) ; |
647 | // |
648 | // for the periodic curve ONLY the tangent of the first point |
649 | // will be used since the curve should close itself at the first |
650 | // point See BuildPeriodicTangent |
651 | // |
652 | for (jj = 1 ; jj <= 2 ; jj++) { |
653 | a_point.SetCoord(jj,myTangents->Value(1).Coord(jj)) ; |
654 | } |
655 | poles.SetValue(num_poles-1,a_point) ; |
656 | |
657 | parameters.SetValue(num_poles, |
658 | myParameters->Value(myParameters->Upper())) ; |
659 | |
660 | poles.SetValue(num_poles, |
661 | myPoints->Value(1)) ; |
662 | |
663 | |
664 | BSplCLib::Interpolate(degree, |
665 | flatknots, |
666 | parameters, |
667 | contact_order_array, |
668 | poles, |
669 | inversion_problem) ; |
670 | if (!inversion_problem) { |
671 | TColgp_Array1OfPnt2d newpoles(poles.Value(1), |
672 | 1, |
673 | num_poles - 2) ; |
674 | myCurve = |
675 | new Geom2d_BSplineCurve(newpoles, |
676 | myParameters->Array1(), |
677 | mults, |
678 | degree, |
679 | myPeriodic) ; |
680 | myIsDone = Standard_True ; |
681 | } |
682 | } |
683 | } |
684 | |
685 | |
686 | //======================================================================= |
687 | //function : PerformNonPeriodic |
688 | //purpose : |
689 | //======================================================================= |
690 | |
691 | void Geom2dAPI_Interpolate::PerformNonPeriodic() |
692 | { |
693 | Standard_Integer degree, |
694 | ii, |
695 | jj, |
696 | index, |
697 | index1, |
698 | index2, |
699 | index3, |
700 | mult_index, |
701 | inversion_problem, |
702 | num_points, |
703 | num_distinct_knots, |
704 | num_poles ; |
705 | |
706 | gp_Pnt2d a_point ; |
707 | |
708 | num_points = |
709 | num_distinct_knots = |
710 | num_poles = myPoints->Length() ; |
711 | if (num_poles == 2 && !myTangentRequest) { |
712 | degree = 1 ; |
713 | } |
714 | else if (num_poles == 3 && !myTangentRequest) { |
715 | degree = 2 ; |
716 | num_distinct_knots = 2 ; |
717 | } |
718 | else { |
719 | degree = 3 ; |
720 | num_poles += 2 ; |
721 | if (myTangentRequest) |
722 | for (ii = myTangentFlags->Lower() + 1 ; |
723 | ii < myTangentFlags->Upper() ; ii++) { |
724 | if (myTangentFlags->Value(ii)) { |
725 | num_poles += 1 ; |
726 | } |
727 | } |
728 | } |
729 | |
730 | |
731 | TColStd_Array1OfReal parameters(1,num_poles) ; |
732 | TColStd_Array1OfReal flatknots(1,num_poles + degree + 1) ; |
733 | TColStd_Array1OfInteger mults(1,num_distinct_knots) ; |
734 | TColStd_Array1OfReal knots(1,num_distinct_knots) ; |
735 | TColStd_Array1OfInteger contact_order_array(1, num_poles) ; |
736 | TColgp_Array1OfPnt2d poles(1,num_poles) ; |
737 | |
738 | for (ii = 1 ; ii <= degree + 1 ; ii++) { |
739 | flatknots.SetValue(ii,myParameters->Value(1)) ; |
740 | flatknots.SetValue(ii + num_poles, |
741 | myParameters->Value(num_points)) ; |
742 | } |
743 | for (ii = 1 ; ii <= num_poles ; ii++) { |
744 | contact_order_array.SetValue(ii,0) ; |
745 | } |
746 | for (ii = 2 ; ii < num_distinct_knots ; ii++) { |
747 | mults.SetValue(ii,1) ; |
748 | } |
749 | mults.SetValue(1,degree + 1) ; |
750 | mults.SetValue(num_distinct_knots ,degree + 1) ; |
751 | |
752 | switch (degree) { |
753 | case 1: |
754 | for (ii = 1 ; ii <= num_poles ; ii++) { |
755 | poles.SetValue(ii ,myPoints->Value(ii)) ; |
756 | } |
757 | myCurve = |
758 | new Geom2d_BSplineCurve(poles, |
759 | myParameters->Array1(), |
760 | mults, |
761 | degree) ; |
762 | myIsDone = Standard_True ; |
763 | break ; |
764 | case 2: |
765 | knots.SetValue(1,myParameters->Value(1)) ; |
766 | knots.SetValue(2,myParameters->Value(3)) ; |
767 | for (ii = 1 ; ii <= num_poles ; ii++) { |
768 | poles.SetValue(ii,myPoints->Value(ii)) ; |
769 | |
770 | } |
771 | BSplCLib::Interpolate(degree, |
772 | flatknots, |
773 | myParameters->Array1(), |
774 | contact_order_array, |
775 | poles, |
776 | inversion_problem) ; |
777 | if (!inversion_problem) { |
778 | myCurve = |
779 | new Geom2d_BSplineCurve(poles, |
780 | knots, |
781 | mults, |
782 | degree) ; |
783 | myIsDone = Standard_True ; |
784 | } |
785 | break ; |
786 | case 3: |
787 | // |
788 | // check if the boundary conditions are set |
789 | // |
790 | if (num_points >= 3) { |
791 | // |
792 | // cannot build the tangents with degree 3 with only 2 points |
793 | // if those where not given in advance |
794 | // |
795 | BuildTangents(myPoints->Array1(), |
796 | myTangents->ChangeArray1(), |
797 | myTangentFlags->ChangeArray1(), |
798 | myParameters->Array1()) ; |
799 | } |
800 | contact_order_array.SetValue(2,1) ; |
801 | parameters.SetValue(1,myParameters->Value(1)) ; |
802 | parameters.SetValue(2,myParameters->Value(1)) ; |
803 | poles.SetValue(1,myPoints->Value(1)) ; |
804 | for (jj = 1 ; jj <= 2 ; jj++) { |
805 | a_point.SetCoord(jj,myTangents->Value(1).Coord(jj)) ; |
806 | |
807 | } |
808 | poles.SetValue(2,a_point) ; |
809 | mult_index = 2 ; |
810 | index = 3 ; |
811 | index1 = 2 ; |
812 | index2 = myPoints->Lower() + 1 ; |
813 | index3 = degree + 2 ; |
814 | if (myTangentRequest) { |
815 | for (ii = myParameters->Lower() + 1 ; |
816 | ii < myParameters->Upper() ; ii++) { |
817 | parameters.SetValue(index,myParameters->Value(ii)) ; |
818 | poles.SetValue(index,myPoints->Value(index2)) ; |
819 | flatknots.SetValue(index3,myParameters->Value(ii)) ; |
820 | index += 1 ; |
821 | index3 += 1 ; |
822 | if (myTangentFlags->Value(index1)) { |
823 | // |
824 | // set the multiplicities, the order of the contact, the |
825 | // the flatknots, |
826 | // |
827 | mults.SetValue(mult_index,mults.Value(mult_index) + 1) ; |
828 | contact_order_array(index) = 1 ; |
829 | flatknots.SetValue(index3, myParameters->Value(ii)) ; |
830 | parameters.SetValue(index, |
831 | myParameters->Value(ii)) ; |
832 | for (jj = 1 ; jj <= 2 ; jj++) { |
833 | a_point.SetCoord(jj,myTangents->Value(ii).Coord(jj)) ; |
834 | } |
835 | poles.SetValue(index,a_point) ; |
836 | index += 1 ; |
837 | index3 += 1 ; |
838 | } |
839 | mult_index += 1 ; |
840 | index1 += 1 ; |
841 | index2 += 1 ; |
842 | |
843 | } |
844 | } |
845 | else { |
846 | index1 = 2 ; |
847 | for(ii = myParameters->Lower() ; ii <= myParameters->Upper() ; ii++) { |
848 | parameters.SetValue(index1, |
849 | myParameters->Value(ii)) ; |
850 | index1 += 1 ; |
851 | } |
852 | index = 3 ; |
853 | for (ii = myPoints->Lower() + 1 ; ii <= myPoints->Upper() - 1 ; ii++) { |
854 | poles.SetValue(index, |
855 | myPoints->Value(ii)) ; |
856 | index += 1 ; |
857 | } |
858 | |
859 | |
860 | index = degree + 1 ; |
861 | for(ii = myParameters->Lower() ; ii <= myParameters->Upper() ; ii++) { |
862 | flatknots.SetValue(index, |
863 | myParameters->Value(ii)) ; |
864 | index += 1 ; |
865 | } |
866 | } |
867 | for (jj = 1 ; jj <= 2 ; jj++) { |
868 | a_point.SetCoord(jj, |
869 | myTangents->Value(num_points).Coord(jj)) ; |
870 | } |
871 | poles.SetValue(num_poles-1 ,a_point) ; |
872 | |
873 | contact_order_array.SetValue(num_poles - 1,1) ; |
874 | parameters.SetValue(num_poles, |
875 | myParameters->Value(myParameters->Upper())) ; |
876 | parameters.SetValue(num_poles -1, |
877 | myParameters->Value(myParameters->Upper())) ; |
878 | |
879 | poles.SetValue(num_poles, |
880 | myPoints->Value(num_points)) ; |
881 | |
882 | BSplCLib::Interpolate(degree, |
883 | flatknots, |
884 | parameters, |
885 | contact_order_array, |
886 | poles, |
887 | inversion_problem) ; |
888 | if (!inversion_problem) { |
889 | myCurve = |
890 | new Geom2d_BSplineCurve(poles, |
891 | myParameters->Array1(), |
892 | mults, |
893 | degree) ; |
894 | myIsDone = Standard_True ; |
895 | } |
896 | break ; |
897 | |
898 | } |
899 | } |
900 | //======================================================================= |
857ffd5e |
901 | //function : Handle(Geom2d_BSplineCurve)& |
7fd59977 |
902 | //purpose : |
903 | //======================================================================= |
904 | |
905 | const Handle(Geom2d_BSplineCurve)& Geom2dAPI_Interpolate::Curve() const |
906 | { |
907 | if ( !myIsDone) |
9775fa61 |
908 | throw StdFail_NotDone(" "); |
7fd59977 |
909 | return myCurve; |
910 | } |
911 | |
912 | |
913 | |
914 | //======================================================================= |
915 | //function : Geom2d_BSplineCurve |
916 | //purpose : |
917 | //======================================================================= |
918 | |
919 | Geom2dAPI_Interpolate::operator Handle(Geom2d_BSplineCurve)() const |
920 | { |
921 | return myCurve; |
922 | } |
923 | |
924 | |
925 | //======================================================================= |
926 | //function : IsDone |
927 | //purpose : |
928 | //======================================================================= |
929 | |
930 | Standard_Boolean Geom2dAPI_Interpolate::IsDone() const |
931 | { |
932 | return myIsDone; |
933 | } |