1 // Created on: 1993-08-12
2 // Created by: Bruno DUMORTIER
3 // Copyright (c) 1993-1999 Matra Datavision
4 // Copyright (c) 1999-2014 OPEN CASCADE SAS
6 // This file is part of Open CASCADE Technology software library.
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.
14 // Alternatively, this file may be used under the terms of Open CASCADE
15 // commercial license or contractual agreement.
17 // PMN : Ajout de la commande smooth
18 // PMN : 11/07/97 Passage a GeomliteTest de bsmooth.
20 #include <Standard_Stream.hxx>
22 #include <GeomliteTest.hxx>
23 #include <DrawTrSurf.hxx>
25 #include <Draw_Appli.hxx>
26 #include <Draw_Interpretor.hxx>
27 #include <Precision.hxx>
28 #include <Draw_Marker3D.hxx>
29 #include <Draw_Marker2D.hxx>
30 #include <TColgp_HArray1OfPnt.hxx>
31 #include <TColgp_SequenceOfPnt.hxx>
32 #include <Geom_BSplineCurve.hxx>
33 #include <Geom_BezierCurve.hxx>
34 #include <TColgp_HArray1OfPnt2d.hxx>
35 #include <TColgp_SequenceOfPnt2d.hxx>
37 #include <Geom2d_BSplineCurve.hxx>
38 #include <Geom2d_BezierCurve.hxx>
39 #include <DrawTrSurf_BSplineCurve.hxx>
40 #include <DrawTrSurf_BezierCurve.hxx>
41 #include <DrawTrSurf_BSplineCurve2d.hxx>
42 #include <DrawTrSurf_BezierCurve2d.hxx>
43 #include <TColgp_HArray1OfPnt.hxx>
44 #include <TColgp_Array1OfPnt.hxx>
45 #include <TColgp_Array1OfPnt2d.hxx>
46 #include <TColgp_HArray1OfVec.hxx>
47 #include <TColgp_Array1OfVec.hxx>
48 #include <TColStd_Array1OfReal.hxx>
49 #include <TColStd_HArray1OfReal.hxx>
50 #include <TColStd_HArray1OfBoolean.hxx>
52 #include <AppParCurves_MultiBSpCurve.hxx>
53 #include <AppParCurves_MultiCurve.hxx>
54 #include <AppDef_MultiLine.hxx>
55 #include <AppDef_Variational.hxx>
56 #include <AppDef_Compute.hxx>
57 #include <AppParCurves_HArray1OfConstraintCouple.hxx>
58 #include <AppParCurves_ConstraintCouple.hxx>
59 #include <AppDef_HArray1OfMultiPointConstraint.hxx>
60 #include <AppDef_Array1OfMultiPointConstraint.hxx>
61 #include <math_Vector.hxx>
65 Standard_IMPORT Draw_Viewer dout;
68 //Draw_Color DrawTrSurf_CurveColor(const Draw_Color);
70 //=======================================================================
71 //function : NbConstraint
72 //=======================================================================
73 static Standard_Integer NbConstraint(const AppParCurves_Constraint C1,
74 const AppParCurves_Constraint C2)
76 Standard_Integer N =0;
78 case AppParCurves_PassPoint :
83 case AppParCurves_TangencyPoint :
88 case AppParCurves_CurvaturePoint :
98 case AppParCurves_PassPoint :
103 case AppParCurves_TangencyPoint :
108 case AppParCurves_CurvaturePoint :
118 //=======================================================================
119 //function : PointsByPick
120 //=======================================================================
121 static Standard_Integer PointsByPick
122 (Handle(AppDef_HArray1OfMultiPointConstraint)& MPC, Draw_Interpretor& di)
124 Standard_Integer id,XX,YY,b, i;
126 di << "Pick points "<< "\n";
127 dout.Select(id, XX, YY, b);
128 Standard_Real zoom = dout.Zoom(id);
129 if (b != 1) return 0;
130 if (id < 0) return 0;
134 //Standard_Boolean newcurve;
138 Handle(Draw_Marker3D) mark;
139 TColgp_SequenceOfPnt ThePoints;
140 P.SetCoord((Standard_Real)XX/zoom,(Standard_Real)YY/zoom, 0.0);
141 ThePoints.Append (P);
142 mark = new Draw_Marker3D(P, Draw_X, Draw_orange);
148 dout.Select(id,XX,YY,b, Standard_False);
151 P.SetCoord( (Standard_Real)XX/zoom,
152 (Standard_Real)YY/zoom, 0.0);
154 mark = new Draw_Marker3D(P, Draw_X, Draw_orange);
160 MPC = new (AppDef_HArray1OfMultiPointConstraint)(1, ThePoints.Length());
161 AppDef_MultiPointConstraint mpc(1,0);
162 MPC->ChangeArray1().Init(mpc);
163 for (i=1; i<=ThePoints.Length(); i++) {
164 AppDef_MultiPointConstraint mpc(1,0);
165 mpc.SetPoint(1, ThePoints.Value(i));
166 MPC->SetValue(i, mpc);
172 Handle(Draw_Marker2D) mark;
173 TColgp_SequenceOfPnt2d ThePoints;
174 P2d.SetCoord((Standard_Real)XX/zoom,(Standard_Real)YY/zoom);
175 ThePoints.Append(P2d);
176 mark = new Draw_Marker2D(P2d, Draw_X, Draw_orange);
182 dout.Select(id,XX,YY,b, Standard_False);
186 P2d.SetCoord( (Standard_Real)XX/zoom, (Standard_Real)YY/zoom );
187 ThePoints.Append (P2d);
188 mark = new Draw_Marker2D(P2d, Draw_X, Draw_orange);
194 MPC = new (AppDef_HArray1OfMultiPointConstraint)(1, ThePoints.Length());
195 for (i=1; i<=ThePoints.Length(); i++) {
196 AppDef_MultiPointConstraint mpc(0,1);
197 mpc.SetPoint2d(1, ThePoints.Value(i));
198 MPC->SetValue(i, mpc);
204 //=======================================================================
205 //function : PointsByFile
206 //=======================================================================
207 static void PointsByFile(Handle(AppDef_HArray1OfMultiPointConstraint)& MPC,
208 Handle(AppParCurves_HArray1OfConstraintCouple)& TABofCC,
210 Draw_Interpretor& di)
212 Standard_Integer nbp, i, nbc;
214 Standard_Real x, y, z;
220 if (!strcmp(dimen,"3d")) {
221 Handle(Draw_Marker3D) mark;
222 MPC = new (AppDef_HArray1OfMultiPointConstraint)(1, nbp);
224 for (i = 1; i <= nbp; i++) {
225 iFile >> x >> y >> z;
226 AppDef_MultiPointConstraint mpc(1,0);
227 mpc.SetPoint(1, gp_Pnt(x, y, z));
228 MPC->SetValue(i,mpc);
229 mark = new Draw_Marker3D(gp_Pnt(x, y, z), Draw_X, Draw_orange);
232 Standard_Boolean HasConstrainte = Standard_False;
234 if ( IsControl( (Standard_Character)c) ) {
235 if (iFile.get(c)) HasConstrainte = Standard_True;
237 else HasConstrainte = Standard_True;
240 if (HasConstrainte) {
241 Standard_Integer num, ordre;
243 if ((nbc < 1) || (nbc>nbp)) return; // Y a comme un probleme
244 AppParCurves_Constraint Constraint = AppParCurves_NoConstraint;
245 TABofCC = new AppParCurves_HArray1OfConstraintCouple(1, nbp);
246 for(i=1; i<=nbp; i++){
247 AppParCurves_ConstraintCouple ACC(i,Constraint);
248 TABofCC->SetValue(i,ACC);
250 for(i=1; i<=nbc; i++) {
251 iFile >> num >> ordre;
252 if ((num<1)||(num>nbp)) {
253 di << "Error on point Index in constrainte" << "\n";
256 Constraint = (AppParCurves_Constraint) (ordre+1);
257 TABofCC->ChangeValue(num).SetConstraint(Constraint);
258 if (Constraint >= AppParCurves_TangencyPoint) {
259 iFile >> x >> y >> z;
260 MPC->ChangeValue(num).SetTang(1, gp_Vec(x,y,z));
262 if (Constraint >= AppParCurves_CurvaturePoint) {
263 iFile >> x >> y >> z;
264 MPC->ChangeValue(num).SetCurv(1, gp_Vec(x,y,z));
270 else if (!strcmp(dimen,"2d")) {
271 Handle(Draw_Marker2D) mark;
272 MPC = new (AppDef_HArray1OfMultiPointConstraint)(1, nbp);
274 for (i = 1; i <= nbp; i++) {
276 AppDef_MultiPointConstraint mpc(0,1);
277 mpc.SetPoint2d(1, gp_Pnt2d(x, y));
278 MPC->SetValue(i, mpc);
279 mark = new Draw_Marker2D(gp_Pnt2d(x, y), Draw_X, Draw_orange);
283 Standard_Boolean HasConstrainte = Standard_False;
285 if ( IsControl( (Standard_Character)c) ) {
286 if (iFile.get(c)) HasConstrainte = Standard_True;
288 else HasConstrainte = Standard_True;
291 if (HasConstrainte) {
292 Standard_Integer num, ordre;
294 if ((nbc < 1) || (nbc>nbp)) return; // Y a comme un probleme
295 AppParCurves_Constraint Constraint = AppParCurves_NoConstraint;
296 TABofCC = new AppParCurves_HArray1OfConstraintCouple(1, nbp);
297 for(i=1; i<=nbp; i++){
298 AppParCurves_ConstraintCouple ACC(i,Constraint);
299 TABofCC->SetValue(i,ACC);
301 for(i=1; i<=nbc; i++) {
302 iFile >> num >> ordre;
303 if ((num<1)||(num>nbp)) {
304 di << "Error on point Index in constrainte" << "\n";
307 Constraint = (AppParCurves_Constraint) (ordre+1);
308 TABofCC->ChangeValue(num).SetConstraint(Constraint);
309 if (Constraint >= AppParCurves_TangencyPoint) {
311 MPC->ChangeValue(num).SetTang2d(1, gp_Vec2d(x,y));
313 if (Constraint >= AppParCurves_CurvaturePoint) {
315 MPC->ChangeValue(num).SetCurv2d(1, gp_Vec2d(x,y));
324 //==================================================================================
325 static Standard_Integer smoothing (Draw_Interpretor& di,Standard_Integer n, const char** a)
326 //==================================================================================
327 // Tolerance < 0 lissage "filtre"
328 // Tolerance > 0 lissage avec respect de l'erreur max
329 // Tolerance = 0 interpolation.
332 Standard_Real Tolerance=0;
334 AppParCurves_Constraint Constraint=AppParCurves_NoConstraint;
336 Handle(AppParCurves_HArray1OfConstraintCouple)TABofCC;
338 Handle(AppDef_HArray1OfMultiPointConstraint) Points;
339 Standard_Integer id = 0, DegMax = -1;
342 di <<"give a name to your curve !" << "\n";
346 di <<"give a tolerance to your curve !" << "\n";
350 Tolerance = Draw::Atof(a[2]);
351 if (Abs(Tolerance) < Precision::Confusion()*1.e-7) {
352 Constraint = AppParCurves_PassPoint;
355 Constraint = AppParCurves_NoConstraint;
357 // Designation Graphique ------------------------
358 id = PointsByPick(Points, di);
361 Standard_Integer ific = 3;
362 Tolerance = Draw::Atof(a[2]);
363 if (Abs(Tolerance) < Precision::Confusion()*1.e-7) {
364 Constraint = AppParCurves_PassPoint;
367 Constraint = AppParCurves_NoConstraint;
370 if (! strcmp(a[3],"-D")) {
371 DegMax = Draw::Atoi(a[4]);
376 // lecture du fichier.
377 // nbpoints, 2d ou 3d, puis valeurs.
378 const char* nomfic = a[ific];
379 ifstream iFile(nomfic, ios::in);
381 di << a[ific] <<"do not exist !" << "\n";
384 PointsByFile(Points, TABofCC, iFile, di);
387 // Designation Graphique
388 id = PointsByPick(Points, di);
392 AppDef_MultiLine AML(Points->Array1());
394 // Compute --------------
396 if (Points->Value(1).NbPoints()==0){
398 Handle(TColgp_HArray1OfPnt2d) ThePoints;
400 Standard_Integer NbPoints = Points->Length();
401 if (TABofCC.IsNull()) {
402 TABofCC = new AppParCurves_HArray1OfConstraintCouple(1, NbPoints);
403 for(i=1; i<=NbPoints; i++){
404 AppParCurves_ConstraintCouple ACC(i,Constraint);
405 TABofCC->SetValue(i,ACC);
409 AppDef_Variational Variation(AML,
414 if (DegMax < 3) Variation.SetContinuity(GeomAbs_C0);
415 else if (DegMax <5) Variation.SetContinuity(GeomAbs_C1);
416 Variation.SetMaxDegree(DegMax);
418 Variation.SetTolerance( Abs(Tolerance));
419 if (Tolerance>0) { Variation.SetWithMinMax(Standard_True);}
420 Variation.Approximate();
422 # ifdef GEOMLITETEST_DEB
423 //Variation.Dump(cout);
424 Standard_SStream aSStream;
425 Variation.Dump(aSStream);
429 AppParCurves_MultiBSpCurve AnMuC = Variation.Value();
431 TColgp_Array1OfPnt2d ThePoles (1, AnMuC.NbPoles() );
432 AnMuC.Curve(1, ThePoles);
433 Handle(Geom2d_BSplineCurve) Cvliss = new (Geom2d_BSplineCurve)
436 AnMuC. Multiplicities(),
439 Handle(DrawTrSurf_BSplineCurve2d)
440 DC = new DrawTrSurf_BSplineCurve2d(Cvliss);
443 if (id!=0) dout.RepaintView(id);
446 Standard_Integer NbPoints = Points->Length();
447 if (TABofCC.IsNull()) {
448 TABofCC = new AppParCurves_HArray1OfConstraintCouple(1, NbPoints);
449 for(i=1; i<=NbPoints; i++){
450 AppParCurves_ConstraintCouple ACC(i,Constraint);
451 TABofCC->SetValue(i,ACC);
455 AppDef_Variational Variation(AML,
460 if (DegMax < 3) Variation.SetContinuity(GeomAbs_C0);
461 else if (DegMax <5) Variation.SetContinuity(GeomAbs_C1);
462 Variation.SetMaxDegree(DegMax);
464 Variation.SetTolerance( Abs(Tolerance));
465 if (Tolerance>0) { Variation.SetWithMinMax(Standard_True);}
466 Variation.Approximate();
467 # ifdef GEOMLITETEST_DEB
468 //Variation.Dump(cout);
469 Standard_SStream aSStream;
470 Variation.Dump(aSStream);
474 AppParCurves_MultiBSpCurve AnMuC = Variation.Value();
476 TColgp_Array1OfPnt ThePoles (1, AnMuC.NbPoles() );
477 AnMuC.Curve(1, ThePoles);
478 Handle(Geom_BSplineCurve) Cvliss = new (Geom_BSplineCurve)
481 AnMuC. Multiplicities(),
484 Handle(DrawTrSurf_BSplineCurve)
485 DC = new DrawTrSurf_BSplineCurve(Cvliss);
488 if (id!=0) dout.RepaintView(id);
493 //=============================================================================
494 static Standard_Integer smoothingbybezier (Draw_Interpretor& di,
497 //============================================================================
499 Standard_Real Tolerance=0;
500 AppParCurves_Constraint Constraint = AppParCurves_NoConstraint;
501 Handle(AppParCurves_HArray1OfConstraintCouple)TABofCC;
502 Handle(AppDef_HArray1OfMultiPointConstraint) Points;
504 Standard_Integer id = 0;
505 Standard_Integer methode=0;
506 Standard_Integer Degree = 8;
509 di <<"give a name to your curve !" << "\n";
513 di <<"give a tolerance to your curve !" << "\n";
517 di <<"give a max degree!" << "\n";
522 di <<"give an option!" << "\n";
526 Tolerance = Draw::Atof(a[2]);
527 Degree = Draw::Atoi(a[3]);
528 if (! strcmp(a[4],"-GR")) {
531 else if (! strcmp(a[4],"-PR")) {
536 if (Abs(Tolerance) < Precision::Confusion()*1.e-7) {
537 Constraint = AppParCurves_PassPoint;
540 Constraint = AppParCurves_NoConstraint;
543 // Designation Graphique ------------------------
544 id = PointsByPick(Points, di);
546 // lecture du fichier.
547 // nbpoints, 2d ou 3d, puis valeurs.
548 const char* nomfic = a[5];
549 ifstream iFile(nomfic, ios::in);
551 di << a[6] <<"do not exist !" << "\n";
554 PointsByFile(Points, TABofCC, iFile, di);
558 AppDef_MultiLine AML(Points->Array1());
560 // Compute --------------
562 if (Points->Value(1).NbPoints()==0){
564 Handle(TColgp_HArray1OfPnt2d) ThePoints;
566 Standard_Integer NbPoints = Points->Length();
567 if (TABofCC.IsNull()) {
568 TABofCC = new AppParCurves_HArray1OfConstraintCouple(1, NbPoints);
569 for(i=1; i<=NbPoints; i++){
570 AppParCurves_ConstraintCouple ACC(i,Constraint);
571 TABofCC->SetValue(i,ACC);
574 AppParCurves_ConstraintCouple AC1(1, AppParCurves_PassPoint);
575 if (TABofCC->Value(1).Constraint()<AppParCurves_PassPoint)
576 TABofCC->SetValue(1, AC1);
578 AppParCurves_ConstraintCouple AC2(NbPoints, AppParCurves_PassPoint);
579 if (TABofCC->Value(NbPoints).Constraint()<AppParCurves_PassPoint)
580 TABofCC->SetValue(NbPoints, AC2);
584 Standard_Boolean mySquare = (methode == 2);
585 Standard_Integer degmin = 4;
586 Standard_Integer NbIteration = 5;
588 if (Degree < 4) degmin = Max(1, Degree -1);
589 degmin = Max(degmin, NbConstraint(TABofCC->Value(1).Constraint(),
590 TABofCC->Value(NbPoints).Constraint()) );
592 AppDef_Compute Appr(degmin, Degree,
593 Abs(Tolerance), Abs(Tolerance),
594 NbIteration, Standard_False,
595 Approx_ChordLength, mySquare);
597 Appr.SetConstraints(TABofCC->Value(1).Constraint(),
598 TABofCC->Value(NbPoints).Constraint());
602 if (! Appr.IsAllApproximated()) {
603 di << " No result" << "\n";
605 AppParCurves_MultiCurve AnMuC = Appr.Value();
606 ThePoints = new (TColgp_HArray1OfPnt2d) (1, AnMuC.NbPoles() );
607 AnMuC.Curve(1, ThePoints->ChangeArray1());
608 Standard_Real err, err2d;
609 Appr.Error(1, err, err2d);
610 di <<" Error2D is : " << err2d << "\n";
613 AppDef_Variational Varia(AML,
617 Varia.SetTolerance(Abs(Tolerance));
620 if (! Varia.IsDone()) {
621 di << " No result" << "\n";
624 AppParCurves_MultiBSpCurve AnMuC = Varia.Value();
625 di <<" Error2D is : " << Varia.MaxError() << "\n";
626 ThePoints = new (TColgp_HArray1OfPnt2d) (1, AnMuC.NbPoles() );
627 AnMuC.Curve(1, ThePoints->ChangeArray1());
630 Handle(Geom2d_BezierCurve) Cvliss =
631 new (Geom2d_BezierCurve)(ThePoints->Array1());
633 Handle(DrawTrSurf_BezierCurve2d) DC =
634 new (DrawTrSurf_BezierCurve2d) (Cvliss);
636 if (id!=0) dout.RepaintView(id);
640 Handle(TColgp_HArray1OfPnt) ThePoints;
641 Standard_Integer NbPoints = Points->Length();
642 if (TABofCC.IsNull()) {
643 TABofCC = new AppParCurves_HArray1OfConstraintCouple(1, NbPoints);
644 for(i=1; i<=NbPoints; i++){
645 AppParCurves_ConstraintCouple ACC(i,Constraint);
646 TABofCC->SetValue(i,ACC);
650 AppParCurves_ConstraintCouple AC1(1, AppParCurves_PassPoint);
651 if (TABofCC->Value(1).Constraint()<AppParCurves_PassPoint)
652 TABofCC->SetValue(1, AC1);
654 AppParCurves_ConstraintCouple AC2(NbPoints, AppParCurves_PassPoint);
655 if (TABofCC->Value(NbPoints).Constraint()<AppParCurves_PassPoint)
656 TABofCC->SetValue(NbPoints, AC2);
660 Standard_Boolean mySquare = (methode == 2);
661 Standard_Integer degmin = 4;
662 Standard_Integer NbIteration = 5;
663 if (Degree < 4) degmin = Max(1, Degree - 1);
664 degmin = Max(degmin, NbConstraint(TABofCC->Value(1).Constraint(),
665 TABofCC->Value(NbPoints).Constraint()) );
667 AppDef_Compute Appr(degmin, Degree,
668 Abs(Tolerance), Abs(Tolerance),
669 NbIteration, Standard_False,
670 Approx_ChordLength, mySquare);
672 Appr.SetConstraints(TABofCC->Value(1).Constraint(),
673 TABofCC->Value(NbPoints).Constraint());
677 if (! Appr.IsAllApproximated()) {
678 di << " No result" << "\n";
680 AppParCurves_MultiCurve AnMuC = Appr.Value();
681 ThePoints = new (TColgp_HArray1OfPnt) (1, AnMuC.NbPoles() );
682 AnMuC.Curve(1, ThePoints->ChangeArray1());
683 Standard_Real err, err2d;
684 Appr.Error(1, err, err2d);
685 di <<" Error3D is : " << err << "\n";
688 AppDef_Variational Varia(AML,
693 Varia.SetTolerance(Abs(Tolerance));
695 if (! Varia.IsDone()) {
696 di << " No result" << "\n";
699 AppParCurves_MultiBSpCurve AnMuC = Varia.Value();
700 di <<" Error3D is : " << Varia.MaxError() << "\n";
701 ThePoints = new (TColgp_HArray1OfPnt) (1, AnMuC.NbPoles() );
702 AnMuC.Curve(1, ThePoints->ChangeArray1());
705 Handle(Geom_BezierCurve) Cvliss =
706 new (Geom_BezierCurve)(ThePoints->Array1());
708 Handle(DrawTrSurf_BezierCurve)
709 DC = new DrawTrSurf_BezierCurve(Cvliss);
711 if (id!=0) dout.RepaintView(id);
716 //=======================================================================
717 //function : ConstraintCommands
719 //=======================================================================
722 void GeomliteTest::ApproxCommands(Draw_Interpretor& theCommands)
725 static Standard_Boolean loaded = Standard_False;
727 loaded = Standard_True;
729 DrawTrSurf::BasicCommands(theCommands);
732 // constrained constructs
733 g = "GEOMETRY Constraints";
736 theCommands.Add("bsmooth",
737 "bsmooth cname tol [-D degree] [fic]",
741 theCommands.Add("bzsmooth",
742 "bzsmooth cname tol degree option [fic]",
744 smoothingbybezier, g);