src/BRepLib/BRepLib.cxx

   1 // Created on: 1993-12-15
   2 // Created by: Remi LEQUETTE
   3 // Copyright (c) 1993-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 //pmn 26/09/97 Add parameters of approximation in BuildCurve3d
  18 //  Modified by skv - Thu Jun  3 12:39:19 2004 OCC5898
  19
  20 #include <BRepLib.ixx>
  21 #include <BRepAdaptor_Surface.hxx>
  22 #include <BRepAdaptor_HSurface.hxx>
  23 #include <BRepAdaptor_HCurve2d.hxx>
  24 #include <BRep_Tool.hxx>
  25 #include <BRep_Builder.hxx>
  26 #include <Geom_Surface.hxx>
  27 #include <Geom_RectangularTrimmedSurface.hxx>
  28 #include <Geom_Plane.hxx>
  29 #include <Geom_Curve.hxx>
  30 #include <Geom_BSplineCurve.hxx>
  31 #include <Geom_TrimmedCurve.hxx>
  32 #include <Geom2d_Curve.hxx>
  33 #include <Geom2d_TrimmedCurve.hxx>
  34 #include <Geom2d_BSplineCurve.hxx>
  35 #include <GeomLib.hxx>
  36 #include <TopExp_Explorer.hxx>
  37 #include <TopoDS.hxx>
  38 #include <TopoDS_Edge.hxx>
  39 #include <TopoDS_Face.hxx>
  40 #include <TopoDS_Vertex.hxx>
  41 #include <TopTools_MapOfShape.hxx>
  42 #include <TopTools_IndexedDataMapOfShapeListOfShape.hxx>
  43 #include <TopTools_ListIteratorOfListOfShape.hxx>
  44 #include <TopExp.hxx>
  45 #include <gp.hxx>
  46 #include <gp_Ax2.hxx>
  47 #include <gp_Pln.hxx>
  48 #include <Standard_Real.hxx>
  49 #include <Precision.hxx>
  50 #include <BRep_GCurve.hxx>
  51 #include <BRep_TEdge.hxx>
  52 #include <BRep_TFace.hxx>
  53 #include <AppParCurves_MultiCurve.hxx>
  54 #include <AppParCurves_MultiBSpCurve.hxx>
  55 #include <BRep_ListOfCurveRepresentation.hxx>
  56 #include <BRep_CurveRepresentation.hxx>
  57 #include <BRep_ListIteratorOfListOfCurveRepresentation.hxx>
  58 #include <BRep_TVertex.hxx>
  59 #include <AdvApprox_ApproxAFunction.hxx>
  60 #include <Approx_SameParameter.hxx>
  61 #include <TColgp_Array1OfPnt.hxx>
  62 #include <TColgp_Array1OfPnt2d.hxx>
  63 #include <TColStd_Array1OfReal.hxx>
  64 #include <TColStd_MapOfTransient.hxx>
  65 #include <GeomAdaptor_Curve.hxx>
  66 #include <GeomAdaptor_HCurve.hxx>
  67 #include <GeomAdaptor_Surface.hxx>
  68 #include <GeomAdaptor_HSurface.hxx>
  69 #include <Geom2dAdaptor_Curve.hxx>
  70 #include <Geom2dAdaptor_HCurve.hxx>
  71 #include <Geom2dAdaptor.hxx>
  72 #include <Geom2dConvert.hxx>
  73 #include <GCPnts_QuasiUniformDeflection.hxx>
  74 #include <BSplCLib.hxx>
  75 #include <ElSLib.hxx>
  76 #include <Adaptor3d_CurveOnSurface.hxx>
  77 #include <Extrema_LocateExtPC.hxx>
  78 #include <ProjLib_ProjectedCurve.hxx>
  79 #include <BRepClass3d_SolidClassifier.hxx>
  80 #include <Bnd_Box.hxx>
  81 #include <BRepBndLib.hxx>
  82 #include <Approx_CurvilinearParameter.hxx>
  83 #include <Geom_BSplineSurface.hxx>
  84
  85 #include <Poly_Triangulation.hxx>
  86 #include <TShort_HArray1OfShortReal.hxx>
  87 #include <GeomLProp_SLProps.hxx>
  88 #include <Poly_PolygonOnTriangulation.hxx>
  89
  90 // TODO - not thread-safe static variables
  91 static Standard_Real thePrecision = Precision::Confusion();
  92 static Handle(Geom_Plane) thePlane;
  93
  94 //=======================================================================
  95 //function : Precision
  96 //purpose  :
  97 //=======================================================================
  98
  99 void BRepLib::Precision(const Standard_Real P)
 100 {
 101   thePrecision = P;
 102 }
 103
 104 //=======================================================================
 105 //function : Precision
 106 //purpose  :
 107 //=======================================================================
 108
 109 Standard_Real  BRepLib::Precision()
 110 {
 111   return thePrecision;
 112 }
 113
 114 //=======================================================================
 115 //function : Plane
 116 //purpose  :
 117 //=======================================================================
 118
 119 void  BRepLib::Plane(const Handle(Geom_Plane)& P)
 120 {
 121   thePlane = P;
 122 }
 123
 124
 125 //=======================================================================
 126 //function : Plane
 127 //purpose  :
 128 //=======================================================================
 129
 130 const Handle(Geom_Plane)&  BRepLib::Plane()
 131 {
 132   if (thePlane.IsNull()) thePlane = new Geom_Plane(gp::XOY());
 133   return thePlane;
 134 }
 135 //=======================================================================
 136 //function : CheckSameRange
 137 //purpose  :
 138 //=======================================================================
 139
 140 Standard_Boolean  BRepLib::CheckSameRange(const TopoDS_Edge& AnEdge,
 141   const Standard_Real Tolerance)
 142 {
 143   Standard_Boolean  IsSameRange = Standard_True,
 144     first_time_in = Standard_True ;
 145
 146   BRep_ListIteratorOfListOfCurveRepresentation an_Iterator
 147     ((*((Handle(BRep_TEdge)*)&AnEdge.TShape()))->ChangeCurves());
 148
 149   Standard_Real first, last;
 150   Standard_Real current_first =0., current_last =0. ;
 151   Handle(BRep_GCurve) geometric_representation_ptr ;
 152
 153   while (IsSameRange && an_Iterator.More()) {
 154     geometric_representation_ptr =
 155       Handle(BRep_GCurve)::DownCast(an_Iterator.Value());
 156     if (!geometric_representation_ptr.IsNull()) {
 157
 158       first = geometric_representation_ptr->First();
 159       last =  geometric_representation_ptr->Last();
 160       if (first_time_in ) {
 161         current_first = first ;
 162         current_last = last   ;
 163         first_time_in = Standard_False ;
 164       }
 165       else {
 166         IsSameRange = (Abs(current_first - first) <= Tolerance)
 167           && (Abs(current_last -last) <= Tolerance ) ;
 168       }
 169     }
 170     an_Iterator.Next() ;
 171   }
 172   return IsSameRange ;
 173 }
 174
 175 //=======================================================================
 176 //function : SameRange
 177 //purpose  :
 178 //=======================================================================
 179
 180 void BRepLib::SameRange(const TopoDS_Edge& AnEdge,
 181   const Standard_Real Tolerance)
 182 {
 183   BRep_ListIteratorOfListOfCurveRepresentation an_Iterator
 184     ((*((Handle(BRep_TEdge)*)&AnEdge.TShape()))->ChangeCurves());
 185
 186   Handle(Geom2d_Curve) Curve2dPtr, Curve2dPtr2, NewCurve2dPtr, NewCurve2dPtr2;
 187   TopLoc_Location LocalLoc ;
 188
 189   Standard_Boolean first_time_in = Standard_True,
 190     has_curve,
 191     has_closed_curve ;
 192   Handle(BRep_GCurve) geometric_representation_ptr ;
 193   Standard_Real first,
 194     current_first,
 195     last,
 196     current_last ;
 197
 198   const Handle(Geom_Curve) C = BRep_Tool::Curve(AnEdge,
 199     LocalLoc,
 200     current_first,
 201     current_last);
 202   if (!C.IsNull()) {
 203     first_time_in = Standard_False ;
 204   }
 205
 206   while (an_Iterator.More()) {
 207     geometric_representation_ptr =
 208       Handle(BRep_GCurve)::DownCast(an_Iterator.Value());
 209     if (! geometric_representation_ptr.IsNull()) {
 210       has_closed_curve =
 211         has_curve = Standard_False ;
 212       first = geometric_representation_ptr->First();
 213       last =  geometric_representation_ptr->Last();
 214       if (geometric_representation_ptr->IsCurveOnSurface()) {
 215         Curve2dPtr = geometric_representation_ptr->PCurve() ;
 216         has_curve = Standard_True ;
 217       }
 218       if (geometric_representation_ptr->IsCurveOnClosedSurface()) {
 219         Curve2dPtr2 = geometric_representation_ptr->PCurve2() ;
 220         has_closed_curve = Standard_True ;
 221       }
 222       if (has_curve || has_closed_curve) {
 223         if (first_time_in) {
 224           current_first = first ;
 225           current_last = last ;
 226           first_time_in = Standard_False ;
 227         }
 228
 229         if (Abs(first - current_first) > Precision::Confusion() ||
 230           Abs(last - current_last) > Precision::Confusion() )
 231         {
 232           if (has_curve)
 233           {
 234             GeomLib::SameRange(Tolerance,
 235               Curve2dPtr,
 236               geometric_representation_ptr->First(),
 237               geometric_representation_ptr->Last(),
 238               current_first,
 239               current_last,
 240               NewCurve2dPtr);
 241             geometric_representation_ptr->PCurve(NewCurve2dPtr) ;
 242           }
 243           if (has_closed_curve)
 244           {
 245             GeomLib::SameRange(Tolerance,
 246               Curve2dPtr2,
 247               geometric_representation_ptr->First(),
 248               geometric_representation_ptr->Last(),
 249               current_first,
 250               current_last,
 251               NewCurve2dPtr2);
 252             geometric_representation_ptr->PCurve2(NewCurve2dPtr2) ;
 253           }
 254         }
 255       }
 256     }
 257     an_Iterator.Next() ;
 258   }
 259   BRep_Builder B;
 260   B.Range(TopoDS::Edge(AnEdge),
 261     current_first,
 262     current_last) ;
 263
 264   B.SameRange(AnEdge,
 265     Standard_True) ;
 266 }
 267
 268 //=======================================================================
 269 //function : EvaluateMaxSegment
 270 //purpose  : return MaxSegment to pass in approximation, if MaxSegment==0 provided
 271 //=======================================================================
 272
 273 static Standard_Integer evaluateMaxSegment(const Standard_Integer aMaxSegment,
 274   const Adaptor3d_CurveOnSurface& aCurveOnSurface)
 275 {
 276   if (aMaxSegment != 0) return aMaxSegment;
 277
 278   Handle(Adaptor3d_HSurface) aSurf   = aCurveOnSurface.GetSurface();
 279   Handle(Adaptor2d_HCurve2d) aCurv2d = aCurveOnSurface.GetCurve();
 280
 281   Standard_Real aNbSKnots = 0, aNbC2dKnots = 0;
 282
 283   if (aSurf->GetType() == GeomAbs_BSplineSurface) {
 284     Handle(Geom_BSplineSurface) aBSpline = aSurf->BSpline();
 285     aNbSKnots = Max(aBSpline->NbUKnots(), aBSpline->NbVKnots());
 286   }
 287   if (aCurv2d->GetType() == GeomAbs_BSplineCurve) {
 288     aNbC2dKnots = aCurv2d->NbKnots();
 289   }
 290   Standard_Integer aReturn = (Standard_Integer) (  30 + Max(aNbSKnots, aNbC2dKnots) ) ;
 291   return aReturn;
 292 }
 293
 294 //=======================================================================
 295 //function : BuildCurve3d
 296 //purpose  :
 297 //=======================================================================
 298
 299 Standard_Boolean  BRepLib::BuildCurve3d(const TopoDS_Edge& AnEdge,
 300   const Standard_Real Tolerance,
 301   const GeomAbs_Shape Continuity,
 302   const Standard_Integer MaxDegree,
 303   const Standard_Integer MaxSegment)
 304 {
 305   Standard_Integer //ErrorCode,
 306     //                   ReturnCode = 0,
 307     ii,
 308     //                   num_knots,
 309     jj;
 310
 311   TopLoc_Location LocalLoc,L[2],LC;
 312   Standard_Real f,l,fc,lc, first[2], last[2],
 313     tolerance,
 314     max_deviation,
 315     average_deviation ;
 316   Handle(Geom2d_Curve) Curve2dPtr, Curve2dArray[2]  ;
 317   Handle(Geom_Surface) SurfacePtr, SurfaceArray[2]  ;
 318
 319   Standard_Integer not_done ;
 320   // if the edge has a 3d curve returns true
 321
 322
 323   const Handle(Geom_Curve) C = BRep_Tool::Curve(AnEdge,LocalLoc,f,l);
 324   if (!C.IsNull())
 325     return Standard_True;
 326   //
 327   // this should not exists but UpdateEdge makes funny things
 328   // if the edge is not same range
 329   //
 330   if (! CheckSameRange(AnEdge,
 331     Precision::Confusion())) {
 332       SameRange(AnEdge,
 333         Tolerance) ;
 334   }
 335
 336
 337
 338   // search a curve on a plane
 339   Handle(Geom_Surface) S;
 340   Handle(Geom2d_Curve) PC;
 341   Standard_Integer i = 0;
 342   Handle(Geom_Plane) P;
 343   not_done = 1 ;
 344
 345   while (not_done) {
 346     i++;
 347     BRep_Tool::CurveOnSurface(AnEdge,PC,S,LocalLoc,f,l,i);
 348     Handle(Geom_RectangularTrimmedSurface) RT =
 349       Handle(Geom_RectangularTrimmedSurface)::DownCast(S);
 350     if ( RT.IsNull()) {
 351       P = Handle(Geom_Plane)::DownCast(S);
 352     }
 353     else {
 354       P = Handle(Geom_Plane)::DownCast(RT->BasisSurface());
 355     }
 356     not_done = ! (S.IsNull() || !P.IsNull()) ;
 357   }
 358   if (! P.IsNull()) {
 359     // compute the 3d curve
 360     gp_Ax2 axes = P->Position().Ax2();
 361     Handle(Geom_Curve) C3d = GeomLib::To3d(axes,PC);
 362     if (C3d.IsNull())
 363       return Standard_False;
 364     // update the edge
 365     Standard_Real First, Last;
 366
 367     BRep_Builder B;
 368     B.UpdateEdge(AnEdge,C3d,LocalLoc,0.0e0);
 369     BRep_Tool::Range(AnEdge, S, LC, First, Last);
 370     B.Range(AnEdge, First, Last); //Do not forget 3D range.(PRO6412)
 371   }
 372   else {
 373     //
 374     // compute the 3d curve using existing surface
 375     //
 376     fc = f ;
 377     lc = l ;
 378     if (!BRep_Tool::Degenerated(AnEdge)) {
 379       jj = 0 ;
 380       for (ii = 0 ; ii < 3 ; ii++ ) {
 381         BRep_Tool::CurveOnSurface(TopoDS::Edge(AnEdge),
 382           Curve2dPtr,
 383           SurfacePtr,
 384           LocalLoc,
 385           fc,
 386           lc,
 387           ii) ;
 388
 389         if (!Curve2dPtr.IsNull() && jj < 2){
 390           Curve2dArray[jj] = Curve2dPtr ;
 391           SurfaceArray[jj] = SurfacePtr ;
 392           L[jj] = LocalLoc ;
 393           first[jj] = fc ;
 394           last[jj] = lc ;
 395           jj += 1 ;
 396         }
 397       }
 398       f = first[0] ;
 399       l = last[0] ;
 400       Curve2dPtr = Curve2dArray[0] ;
 401       SurfacePtr = SurfaceArray[0] ;
 402
 403       Geom2dAdaptor_Curve     AnAdaptor3dCurve2d (Curve2dPtr, f, l) ;
 404       GeomAdaptor_Surface     AnAdaptor3dSurface (SurfacePtr) ;
 405       Handle(Geom2dAdaptor_HCurve) AnAdaptor3dCurve2dPtr =
 406         new Geom2dAdaptor_HCurve(AnAdaptor3dCurve2d) ;
 407       Handle(GeomAdaptor_HSurface) AnAdaptor3dSurfacePtr =
 408         new GeomAdaptor_HSurface (AnAdaptor3dSurface) ;
 409       Adaptor3d_CurveOnSurface  CurveOnSurface( AnAdaptor3dCurve2dPtr,
 410         AnAdaptor3dSurfacePtr) ;
 411
 412       Handle(Geom_Curve) NewCurvePtr ;
 413
 414       GeomLib::BuildCurve3d(Tolerance,
 415         CurveOnSurface,
 416         f,
 417         l,
 418         NewCurvePtr,
 419         max_deviation,
 420         average_deviation,
 421         Continuity,
 422         MaxDegree,
 423         evaluateMaxSegment(MaxSegment,CurveOnSurface)) ;
 424       BRep_Builder B;
 425       tolerance = BRep_Tool::Tolerance(AnEdge) ;
 426       //Patch
 427       //max_deviation = Max(tolerance, max_deviation) ;
 428       max_deviation = Max( tolerance, Tolerance );
 429       if (NewCurvePtr.IsNull())
 430         return Standard_False;
 431       B.UpdateEdge(TopoDS::Edge(AnEdge),
 432         NewCurvePtr,
 433         L[0],
 434         max_deviation) ;
 435       if (jj == 1 ) {
 436         //
 437         // if there is only one curve on surface attached to the edge
 438         // than it can be qualified sameparameter
 439         //
 440         B.SameParameter(TopoDS::Edge(AnEdge),
 441           Standard_True) ;
 442       }
 443     }
 444     else {
 445       return Standard_False ;
 446     }
 447
 448   }
 449   return Standard_True;
 450 }
 451 //=======================================================================
 452 //function : BuildCurves3d
 453 //purpose  :
 454 //=======================================================================
 455
 456 Standard_Boolean  BRepLib::BuildCurves3d(const TopoDS_Shape& S)
 457
 458 {
 459   return BRepLib::BuildCurves3d(S,
 460     1.0e-5) ;
 461 }
 462
 463 //=======================================================================
 464 //function : BuildCurves3d
 465 //purpose  :
 466 //=======================================================================
 467
 468 Standard_Boolean  BRepLib::BuildCurves3d(const TopoDS_Shape& S,
 469   const Standard_Real Tolerance,
 470   const GeomAbs_Shape Continuity,
 471   const Standard_Integer MaxDegree,
 472   const Standard_Integer MaxSegment)
 473 {
 474   Standard_Boolean boolean_value,
 475     ok = Standard_True;
 476   TopTools_MapOfShape a_counter ;
 477   TopExp_Explorer ex(S,TopAbs_EDGE);
 478
 479   while (ex.More()) {
 480     if (a_counter.Add(ex.Current())) {
 481       boolean_value =
 482         BuildCurve3d(TopoDS::Edge(ex.Current()),
 483         Tolerance, Continuity,
 484         MaxDegree, MaxSegment);
 485       ok = ok && boolean_value ;
 486     }
 487     ex.Next();
 488   }
 489   return ok;
 490 }
 491 //=======================================================================
 492 //function : UpdateEdgeTolerance
 493 //purpose  :
 494 //=======================================================================
 495
 496 Standard_Boolean  BRepLib::UpdateEdgeTol(const TopoDS_Edge& AnEdge,
 497   const Standard_Real MinToleranceRequested,
 498   const Standard_Real MaxToleranceToCheck)
 499 {
 500
 501   Standard_Integer curve_on_surface_index,
 502     curve_index,
 503     not_done,
 504     has_closed_curve,
 505     has_curve,
 506     jj,
 507     ii,
 508     geom_reference_curve_flag = 0,
 509     max_sampling_points = 90,
 510     min_sampling_points = 30 ;
 511
 512   Standard_Real factor = 100.0e0,
 513     //     sampling_array[2],
 514     safe_factor = 1.4e0,
 515     current_last,
 516     current_first,
 517     max_distance,
 518     coded_edge_tolerance,
 519     edge_tolerance = 0.0e0 ;
 520   Handle(TColStd_HArray1OfReal) parameters_ptr ;
 521   Handle(BRep_GCurve) geometric_representation_ptr ;
 522
 523   if (BRep_Tool::Degenerated(AnEdge)) return Standard_False ;
 524   coded_edge_tolerance = BRep_Tool::Tolerance(AnEdge) ;
 525   if (coded_edge_tolerance > MaxToleranceToCheck) return Standard_False ;
 526
 527   const Handle(BRep_TEdge)& TE = *((Handle(BRep_TEdge)*)&AnEdge.TShape());
 528   BRep_ListOfCurveRepresentation& list_curve_rep = TE->ChangeCurves() ;
 529   BRep_ListIteratorOfListOfCurveRepresentation an_iterator(list_curve_rep),
 530     second_iterator(list_curve_rep) ;
 531   Handle(Geom2d_Curve) curve2d_ptr, new_curve2d_ptr;
 532   Handle(Geom_Surface) surface_ptr ;
 533   TopLoc_Location local_location ;
 534   GCPnts_QuasiUniformDeflection  a_sampler ;
 535   GeomAdaptor_Curve  geom_reference_curve ;
 536   Adaptor3d_CurveOnSurface  curve_on_surface_reference ;
 537   Handle(Geom_Curve) C = BRep_Tool::Curve(AnEdge,
 538     local_location,
 539     current_first,
 540     current_last);
 541   curve_on_surface_index = -1 ;
 542   if (!C.IsNull()) {
 543     if (! local_location.IsIdentity()) {
 544       C = Handle(Geom_Curve)::
 545         DownCast(C-> Transformed(local_location.Transformation()) ) ;
 546     }
 547     geom_reference_curve.Load(C) ;
 548     geom_reference_curve_flag = 1 ;
 549     a_sampler.Initialize(geom_reference_curve,
 550       MinToleranceRequested * factor,
 551       current_first,
 552       current_last) ;
 553   }
 554   else {
 555     not_done = 1 ;
 556     curve_on_surface_index = 0 ;
 557
 558     while (not_done && an_iterator.More()) {
 559       geometric_representation_ptr =
 560         Handle(BRep_GCurve)::DownCast(second_iterator.Value());
 561       if (!geometric_representation_ptr.IsNull()
 562         && geometric_representation_ptr->IsCurveOnSurface()) {
 563           curve2d_ptr = geometric_representation_ptr->PCurve() ;
 564           local_location = geometric_representation_ptr->Location() ;
 565           current_first = geometric_representation_ptr->First();
 566           //first = geometric_representation_ptr->First();
 567           current_last =  geometric_representation_ptr->Last();
 568           // must be inverted
 569           //
 570           if (! local_location.IsIdentity() ) {
 571             surface_ptr = Handle(Geom_Surface)::
 572               DownCast( geometric_representation_ptr->Surface()->
 573               Transformed(local_location.Transformation()) ) ;
 574           }
 575           else {
 576             surface_ptr =
 577               geometric_representation_ptr->Surface() ;
 578           }
 579           not_done = 0 ;
 580       }
 581       curve_on_surface_index += 1 ;
 582     }
 583     Geom2dAdaptor_Curve     AnAdaptor3dCurve2d (curve2d_ptr) ;
 584     GeomAdaptor_Surface     AnAdaptor3dSurface (surface_ptr) ;
 585     Handle(Geom2dAdaptor_HCurve) AnAdaptor3dCurve2dPtr =
 586       new Geom2dAdaptor_HCurve(AnAdaptor3dCurve2d) ;
 587     Handle(GeomAdaptor_HSurface) AnAdaptor3dSurfacePtr =
 588       new GeomAdaptor_HSurface (AnAdaptor3dSurface) ;
 589     curve_on_surface_reference.Load( AnAdaptor3dCurve2dPtr) ;
 590     curve_on_surface_reference.Load( AnAdaptor3dSurfacePtr) ;
 591     a_sampler.Initialize(curve_on_surface_reference,
 592       MinToleranceRequested * factor,
 593       current_first,
 594       current_last) ;
 595   }
 596   TColStd_Array1OfReal   sampling_parameters(1,a_sampler.NbPoints()) ;
 597   for (ii = 1 ; ii <= a_sampler.NbPoints() ; ii++) {
 598     sampling_parameters(ii) = a_sampler.Parameter(ii) ;
 599   }
 600   if (a_sampler.NbPoints() < min_sampling_points) {
 601     GeomLib::DensifyArray1OfReal(min_sampling_points,
 602       sampling_parameters,
 603       parameters_ptr) ;
 604   }
 605   else if (a_sampler.NbPoints() > max_sampling_points) {
 606     GeomLib::RemovePointsFromArray(max_sampling_points,
 607       sampling_parameters,
 608       parameters_ptr) ;
 609   }
 610   else {
 611     jj = 1 ;
 612     parameters_ptr =
 613       new TColStd_HArray1OfReal(1,sampling_parameters.Length()) ;
 614     for (ii = sampling_parameters.Lower() ; ii <= sampling_parameters.Upper() ; ii++) {
 615       parameters_ptr->ChangeArray1()(jj) =
 616         sampling_parameters(ii) ;
 617       jj +=1 ;
 618     }
 619   }
 620
 621   curve_index = 0 ;
 622
 623   while (second_iterator.More()) {
 624     geometric_representation_ptr =
 625       Handle(BRep_GCurve)::DownCast(second_iterator.Value());
 626     if (! geometric_representation_ptr.IsNull() &&
 627       curve_index != curve_on_surface_index) {
 628         has_closed_curve =
 629           has_curve = Standard_False ;
 630         //      first = geometric_representation_ptr->First();
 631         //      last =  geometric_representation_ptr->Last();
 632         local_location = geometric_representation_ptr->Location() ;
 633         if (geometric_representation_ptr->IsCurveOnSurface()) {
 634           curve2d_ptr = geometric_representation_ptr->PCurve() ;
 635           has_curve = Standard_True ;
 636         }
 637         if (geometric_representation_ptr->IsCurveOnClosedSurface()) {
 638           curve2d_ptr = geometric_representation_ptr->PCurve2() ;
 639           has_closed_curve = Standard_True ;
 640         }
 641
 642         if (has_curve ||
 643           has_closed_curve) {
 644             if (! local_location.IsIdentity() ) {
 645               surface_ptr = Handle(Geom_Surface)::
 646                 DownCast( geometric_representation_ptr->Surface()->
 647                 Transformed(local_location.Transformation()) ) ;
 648             }
 649             else {
 650               surface_ptr =
 651                 geometric_representation_ptr->Surface() ;
 652             }
 653             Geom2dAdaptor_Curve     an_adaptor_curve2d (curve2d_ptr) ;
 654             GeomAdaptor_Surface     an_adaptor_surface(surface_ptr) ;
 655             Handle(Geom2dAdaptor_HCurve) an_adaptor_curve2d_ptr =
 656               new Geom2dAdaptor_HCurve(an_adaptor_curve2d) ;
 657             Handle(GeomAdaptor_HSurface) an_adaptor_surface_ptr =
 658               new GeomAdaptor_HSurface (an_adaptor_surface) ;
 659             Adaptor3d_CurveOnSurface a_curve_on_surface(an_adaptor_curve2d_ptr,
 660               an_adaptor_surface_ptr) ;
 661
 662             if (BRep_Tool::SameParameter(AnEdge)) {
 663
 664               GeomLib::EvalMaxParametricDistance(a_curve_on_surface,
 665                 geom_reference_curve,
 666                 MinToleranceRequested,
 667                 parameters_ptr->Array1(),
 668                 max_distance) ;
 669             }
 670             else if (geom_reference_curve_flag) {
 671               GeomLib::EvalMaxDistanceAlongParameter(a_curve_on_surface,
 672                 geom_reference_curve,
 673                 MinToleranceRequested,
 674                 parameters_ptr->Array1(),
 675                 max_distance) ;
 676             }
 677             else {
 678
 679               GeomLib::EvalMaxDistanceAlongParameter(a_curve_on_surface,
 680                 curve_on_surface_reference,
 681                 MinToleranceRequested,
 682                 parameters_ptr->Array1(),
 683                 max_distance) ;
 684             }
 685             max_distance *= safe_factor ;
 686             edge_tolerance = Max(max_distance, edge_tolerance) ;
 687         }
 688
 689
 690     }
 691     curve_index += 1 ;
 692     second_iterator.Next() ;
 693   }
 694
 695   TE->Tolerance(edge_tolerance);
 696   return Standard_True ;
 697
 698 }
 699 //=======================================================================
 700 //function : UpdateEdgeTolerance
 701 //purpose  :
 702 //=======================================================================
 703
 704 Standard_Boolean BRepLib::UpdateEdgeTolerance(const TopoDS_Shape& S,
 705   const Standard_Real MinToleranceRequested,
 706   const Standard_Real MaxToleranceToCheck)
 707 {
 708   TopExp_Explorer ex(S,TopAbs_EDGE);
 709   TopTools_MapOfShape  a_counter ;
 710
 711   Standard_Boolean     return_status = Standard_False,
 712     local_flag ;
 713
 714   while (ex.More()) {
 715     if (a_counter.Add(ex.Current())) {
 716       local_flag =
 717         BRepLib::UpdateEdgeTol(TopoDS::Edge(ex.Current()),
 718         MinToleranceRequested,
 719         MaxToleranceToCheck) ;
 720       if (local_flag && ! return_status) {
 721         return_status = Standard_True ;
 722       }
 723     }
 724     ex.Next();
 725   }
 726   return return_status ;
 727 }
 728
 729 //=======================================================================
 730 //function : SetEdgeTol
 731 //purpose  :
 732 //=======================================================================
 733
 734 static void SetEdgeTol(const TopoDS_Edge& E,
 735   const TopoDS_Face& F)
 736 {
 737   TopLoc_Location L;
 738   const Handle(Geom_Surface)& S = BRep_Tool::Surface(F,L);
 739   TopLoc_Location l = L.Predivided(E.Location());
 740
 741   const Handle(BRep_TEdge)& TE = *((Handle(BRep_TEdge)*)&E.TShape());
 742   BRep_ListIteratorOfListOfCurveRepresentation itcr(TE->ChangeCurves());
 743
 744   while (itcr.More()) {
 745     const Handle(BRep_CurveRepresentation)& cr = itcr.Value();
 746     if(cr->IsCurveOnSurface(S,l)) return;
 747     itcr.Next();
 748   }
 749
 750   Handle(Geom_Plane) GP;
 751   Handle(Geom_RectangularTrimmedSurface) GRTS;
 752   GRTS = Handle(Geom_RectangularTrimmedSurface)::DownCast(S);
 753   if(!GRTS.IsNull())
 754     GP = Handle(Geom_Plane)::DownCast(GRTS->BasisSurface());
 755   else
 756     GP = Handle(Geom_Plane)::DownCast(S);
 757
 758   Handle(GeomAdaptor_HCurve) HC = new GeomAdaptor_HCurve();
 759   Handle(GeomAdaptor_HSurface) HS = new GeomAdaptor_HSurface();
 760
 761   TopLoc_Location LC;
 762   Standard_Real First, Last;
 763   GeomAdaptor_Curve& GAC = HC->ChangeCurve();
 764   GAC.Load(BRep_Tool::Curve(E,LC,First,Last));
 765   LC = L.Predivided(LC);
 766
 767   if (!LC.IsIdentity()) {
 768     GP = Handle(Geom_Plane)::DownCast(
 769       GP->Transformed(LC.Transformation()));
 770   }
 771   GeomAdaptor_Surface& GAS = HS->ChangeSurface();
 772   GAS.Load(GP);
 773
 774   ProjLib_ProjectedCurve Proj(HS,HC);
 775   Handle(Geom2d_Curve) pc = Geom2dAdaptor::MakeCurve(Proj);
 776
 777   gp_Pln pln = GAS.Plane();
 778   Standard_Real d2 = 0.;
 779   Standard_Integer nn = 23;
 780   Standard_Real unsurnn = 1./nn;
 781   for(Standard_Integer i = 0; i <= nn; i++){
 782     Standard_Real t = unsurnn*i;
 783     Standard_Real u = First*(1.-t) + Last*t;
 784     gp_Pnt Pc3d = HC->Value(u);
 785     gp_Pnt2d p2d = pc->Value(u);
 786     gp_Pnt Pcons = ElSLib::Value(p2d.X(),p2d.Y(),pln);
 787     Standard_Real eps = Max(Pc3d.XYZ().SquareModulus(), Pcons.XYZ().SquareModulus());
 788     eps = Epsilon(eps);
 789     Standard_Real temp = Pc3d.SquareDistance(Pcons);
 790     if(temp <= eps)
 791     {
 792       temp = 0.;
 793     }
 794     if(temp > d2) d2 = temp;
 795   }
 796   d2 = 1.5*sqrt(d2);
 797   TE->UpdateTolerance(d2);
 798 }
 799
 800 //=======================================================================
 801 //function : SameParameter
 802 //purpose  :
 803 //=======================================================================
 804 void  BRepLib::SameParameter(const TopoDS_Shape& S,
 805   const Standard_Real Tolerance,
 806   const Standard_Boolean forced)
 807 {
 808   TopExp_Explorer ex(S,TopAbs_EDGE);
 809   TopTools_MapOfShape  Done;
 810   BRep_Builder brB;
 811
 812   while (ex.More()) {
 813     if (Done.Add(ex.Current())) {
 814       if (forced) {
 815         brB.SameRange(TopoDS::Edge(ex.Current()), Standard_False);
 816         brB.SameParameter(TopoDS::Edge(ex.Current()), Standard_False);
 817       }
 818       BRepLib::SameParameter(TopoDS::Edge(ex.Current()),Tolerance);
 819     }
 820     ex.Next();
 821   }
 822
 823   Done.Clear();
 824   BRepAdaptor_Surface BS;
 825   for(ex.Init(S,TopAbs_FACE); ex.More(); ex.Next()){
 826     const TopoDS_Face& curface = TopoDS::Face(ex.Current());
 827     if(!Done.Add(curface)) continue;
 828     BS.Initialize(curface);
 829     if(BS.GetType() != GeomAbs_Plane) continue;
 830     TopExp_Explorer ex2;
 831     for(ex2.Init(curface,TopAbs_EDGE); ex2.More(); ex2.Next()){
 832       const TopoDS_Edge& E = TopoDS::Edge(ex2.Current());
 833       SetEdgeTol(E,curface);
 834     }
 835   }
 836   BRepLib::UpdateTolerances(S);
 837 }
 838
 839 //================================================================
 840 //function : SameParameter
 841 //WARNING  : New spec DUB LBO 9/9/97.
 842 //  Recode in the edge the best tolerance found,
 843 //  for vertex extremities it is required to find something else
 844 //================================================================
 845 static Standard_Boolean EvalTol(const Handle(Geom2d_Curve)& pc,
 846   const Handle(Geom_Surface)& s,
 847   const GeomAdaptor_Curve&    gac,
 848   const Standard_Real         tol,
 849   Standard_Real&              tolbail)
 850 {
 851   Standard_Integer ok = 0;
 852   Standard_Real f = gac.FirstParameter();
 853   Standard_Real l = gac.LastParameter();
 854   Extrema_LocateExtPC Projector;
 855   Projector.Initialize(gac,f,l,tol);
 856   Standard_Real u,v;
 857   gp_Pnt p;
 858   tolbail = tol;
 859   for(Standard_Integer i = 1; i <= 5; i++){
 860     Standard_Real t = i/6.;
 861     t = (1.-t) * f + t * l;
 862     pc->Value(t).Coord(u,v);
 863     p = s->Value(u,v);
 864     Projector.Perform(p,t);
 865     if (Projector.IsDone()) {
 866       Standard_Real dist2 = Projector.SquareDistance();
 867       if(dist2 > tolbail * tolbail) tolbail = sqrt (dist2);
 868       ok++;
 869     }
 870   }
 871   return (ok > 2);
 872 }
 873
 874 static Standard_Real ComputeTol(const Handle(Adaptor3d_HCurve)& c3d,
 875   const Handle(Adaptor2d_HCurve2d)& c2d,
 876   const Handle(Adaptor3d_HSurface)& surf,
 877   const Standard_Integer        nbp)
 878
 879 {
 880
 881   TColStd_Array1OfReal dist(1,nbp+10);
 882   dist.Init(-1.);
 883
 884   Adaptor3d_CurveOnSurface  cons(c2d,surf);
 885   Standard_Real d2 = 0.;
 886   Standard_Real first = c3d->FirstParameter();
 887   Standard_Real last  = c3d->LastParameter();
 888   Standard_Integer i = 0;
 889   for(i = 0; i <= nbp; i++){
 890     const Standard_Real t = IntToReal(i)/IntToReal(nbp);
 891     const Standard_Real u = first*(1.-t) + last*t;
 892     gp_Pnt Pc3d = c3d->Value(u);
 893     gp_Pnt Pcons = cons.Value(u);
 894     if (Precision::IsInfinite(Pcons.X()) ||
 895       Precision::IsInfinite(Pcons.Y()) ||
 896       Precision::IsInfinite(Pcons.Z())) {
 897         d2=Precision::Infinite();
 898         break;
 899     }
 900     Standard_Real temp = Pc3d.SquareDistance(Pcons);
 901
 902
 903     dist(i+1) = temp;
 904
 905
 906     if(temp > d2) d2 = temp;
 907   }
 908
 909
 910   Standard_Boolean ana = Standard_False;
 911   Standard_Real D2 = 0;
 912   Standard_Integer N1 = 0;
 913   Standard_Integer N2 = 0;
 914   Standard_Integer N3 = 0;
 915
 916   for( i = 1; i<= nbp+10; i++)
 917     if( dist(i) > 0 ) {
 918       if( dist(i) < 1.0 ) N1++;
 919       else N2++;
 920     }
 921
 922     if( N1 > N2 && N2 != 0 ) N3 = 100*N2/(N1+N2);
 923     if( N3 < 10 && N3 != 0 ) {
 924       ana = Standard_True;
 925       for( i = 1; i<= nbp+10; i++)
 926         if( dist(i) > 0 && dist(i) < 1.0 )
 927           if( dist(i) > D2 ) D2 = dist(i);
 928     }
 929
 930     //d2 = 1.5*sqrt(d2);
 931     d2 = (!ana) ? 1.5*sqrt(d2) : 1.5*sqrt(D2);
 932     if(d2<1.e-7) d2 = 1.e-7;
 933
 934     return d2;
 935 }
 936
 937 void BRepLib::SameParameter(const TopoDS_Edge&  AnEdge,
 938   const Standard_Real Tolerance)
 939 {
 940   if (BRep_Tool::SameParameter(AnEdge)) return;
 941
 942   const Standard_Integer NCONTROL = 22;
 943
 944   Handle(GeomAdaptor_HCurve) HC = new GeomAdaptor_HCurve();
 945   Handle(Geom2dAdaptor_HCurve) HC2d = new Geom2dAdaptor_HCurve();
 946   Handle(GeomAdaptor_HSurface) HS = new GeomAdaptor_HSurface();
 947   GeomAdaptor_Curve& GAC = HC->ChangeCurve();
 948   Geom2dAdaptor_Curve& GAC2d = HC2d->ChangeCurve2d();
 949   GeomAdaptor_Surface& GAS = HS->ChangeSurface();
 950   Standard_Real f3d =0.,l3d =0.;
 951   TopLoc_Location L3d;
 952   Handle(Geom_Curve) C3d;
 953
 954   const Handle(BRep_TEdge)& TE = *((Handle(BRep_TEdge)*) &AnEdge.TShape());
 955   BRep_ListOfCurveRepresentation& CList = TE->ChangeCurves();
 956   BRep_ListIteratorOfListOfCurveRepresentation It(CList);
 957
 958   Standard_Boolean NotDone = Standard_True;
 959
 960   while (NotDone && It.More()) {
 961     Handle(BRep_GCurve) GCurve = Handle(BRep_GCurve)::DownCast(It.Value());
 962     if (!GCurve.IsNull() && GCurve->IsCurve3D()) {
 963       C3d = GCurve->Curve3D() ;
 964       f3d = GCurve->First();
 965       l3d = GCurve->Last();
 966       L3d = GCurve->Location() ;
 967       NotDone = Standard_False;
 968     }
 969     It.Next() ;
 970   }
 971
 972   if(C3d.IsNull()) return;
 973
 974   // modified by NIZHNY-OCC486  Tue Aug 27 17:15:13 2002 :
 975   Standard_Boolean m_TrimmedPeriodical = Standard_False;
 976   Handle(Standard_Type) TheType = C3d->DynamicType();
 977   if( TheType == STANDARD_TYPE(Geom_TrimmedCurve))
 978   {
 979     const Handle(Geom_Curve)& gtC = (*((Handle(Geom_TrimmedCurve)*)&C3d))->BasisCurve();
 980     m_TrimmedPeriodical = gtC->IsPeriodic();
 981   }
 982   // modified by NIZHNY-OCC486  Tue Aug 27 17:15:17 2002 .
 983
 984   BRep_Builder B;
 985   if(!C3d->IsPeriodic()) {
 986     Standard_Real Udeb = C3d->FirstParameter();
 987     Standard_Real Ufin = C3d->LastParameter();
 988     // modified by NIZHNY-OCC486  Tue Aug 27 17:17:14 2002 :
 989     //if (Udeb > f3d) f3d = Udeb;
 990     //if (l3d > Ufin) l3d = Ufin;
 991     if(!m_TrimmedPeriodical)
 992     {
 993       if (Udeb > f3d) f3d = Udeb;
 994       if (l3d > Ufin) l3d = Ufin;
 995     }
 996     // modified by NIZHNY-OCC486  Tue Aug 27 17:17:55 2002 .
 997   }
 998   if(!L3d.IsIdentity()){
 999     C3d = Handle(Geom_Curve)::DownCast(C3d->Transformed(L3d.Transformation()));
1000   }
1001   GAC.Load(C3d,f3d,l3d);
1002
1003   Standard_Boolean IsSameP = 1;
1004   Standard_Real maxdist = 0.;
1005
1006   //  Modified by skv - Thu Jun  3 12:39:19 2004 OCC5898 Begin
1007   Standard_Real anEdgeTol = BRep_Tool::Tolerance(AnEdge);
1008   //  Modified by skv - Thu Jun  3 12:39:20 2004 OCC5898 End
1009   Standard_Boolean SameRange = BRep_Tool::SameRange(AnEdge);
1010   Standard_Boolean YaPCu = Standard_False;
1011   It.Initialize(CList);
1012
1013   while (It.More()) {
1014     Standard_Boolean isANA = Standard_False;
1015     Standard_Boolean isBSP = Standard_False;
1016     Handle(BRep_GCurve) GCurve = Handle(BRep_GCurve)::DownCast(It.Value());
1017     Handle(Geom2d_Curve) PC[2];
1018     Handle(Geom_Surface) S;
1019     if (!GCurve.IsNull() && GCurve->IsCurveOnSurface()) {
1020       YaPCu = Standard_True;
1021       PC[0] = GCurve->PCurve();
1022       TopLoc_Location PCLoc = GCurve->Location();
1023       S = GCurve->Surface();
1024       if (!PCLoc.IsIdentity() ) {
1025         S = Handle(Geom_Surface)::DownCast(S->Transformed(PCLoc.Transformation()));
1026       }
1027
1028       GAS.Load(S);
1029       if (GCurve->IsCurveOnClosedSurface()) {
1030         PC[1] = GCurve->PCurve2();
1031       }
1032
1033       // Eval tol2d to compute SameRange
1034       Standard_Real UResol = Max(GAS.UResolution(Tolerance), Precision::PConfusion());
1035       Standard_Real VResol = Max(GAS.VResolution(Tolerance), Precision::PConfusion());
1036       Standard_Real Tol2d  = Min(UResol, VResol);
1037       for(Standard_Integer i = 0; i < 2; i++){
1038         Handle(Geom2d_Curve) curPC = PC[i];
1039         Standard_Boolean updatepc = 0;
1040         if(curPC.IsNull()) break;
1041         if(!SameRange){
1042           GeomLib::SameRange(Tol2d,
1043             PC[i],GCurve->First(),GCurve->Last(),
1044             f3d,l3d,curPC);
1045
1046           updatepc = (curPC != PC[i]);
1047
1048         }
1049         Standard_Boolean goodpc = 1;
1050         GAC2d.Load(curPC,f3d,l3d);
1051
1052         Standard_Real error = ComputeTol(HC, HC2d, HS, NCONTROL);
1053
1054         if(GAC2d.GetType() == GeomAbs_BSplineCurve &&
1055           GAC2d.Continuity() == GeomAbs_C0) {
1056             Handle(Geom2d_BSplineCurve) bs2d = GAC2d.BSpline();
1057             Handle(Geom2d_BSplineCurve) bs2dsov = bs2d;
1058             Standard_Real fC0 = bs2d->FirstParameter(), lC0 = bs2d->LastParameter();
1059             Standard_Boolean repar = Standard_True;
1060             gp_Pnt2d OriginPoint;
1061             bs2d->D0(fC0, OriginPoint);
1062             Geom2dConvert::C0BSplineToC1BSplineCurve(bs2d, Tol2d);
1063             isBSP = Standard_True;
1064
1065             if(bs2d->IsPeriodic()) { // -------- IFV, Jan 2000
1066               gp_Pnt2d NewOriginPoint;
1067               bs2d->D0(bs2d->FirstParameter(), NewOriginPoint);
1068               if(Abs(OriginPoint.X() - NewOriginPoint.X()) > Precision::PConfusion() ||
1069                 Abs(OriginPoint.Y() - NewOriginPoint.Y()) > Precision::PConfusion()    ) {
1070
1071                   TColStd_Array1OfReal Knotbs2d (1, bs2d->NbKnots());
1072                   bs2d->Knots(Knotbs2d);
1073
1074                   for(Standard_Integer Index = 1; Index <= bs2d->NbKnots(); Index++) {
1075                     bs2d->D0(Knotbs2d(Index), NewOriginPoint);
1076                     if(Abs(OriginPoint.X() - NewOriginPoint.X()) > Precision::PConfusion() ||
1077                       Abs(OriginPoint.Y() - NewOriginPoint.Y()) > Precision::PConfusion()    ) continue;
1078
1079                     bs2d->SetOrigin(Index);
1080                     break;
1081                   }
1082               }
1083             }
1084
1085             if(bs2d->Continuity() == GeomAbs_C0) {
1086               Standard_Real tolbail;
1087               if(EvalTol(curPC,S,GAC,Tolerance,tolbail)){
1088                 bs2d = bs2dsov;
1089                 Standard_Real UResbail = GAS.UResolution(tolbail);
1090                 Standard_Real VResbail = GAS.VResolution(tolbail);
1091                 Standard_Real Tol2dbail  = Min(UResbail,VResbail);
1092                 bs2d->D0(bs2d->FirstParameter(), OriginPoint);
1093
1094                 Standard_Integer nbp = bs2d->NbPoles();
1095                 TColgp_Array1OfPnt2d poles(1,nbp);
1096                 bs2d->Poles(poles);
1097                 gp_Pnt2d p = poles(1), p1;
1098                 Standard_Real d = Precision::Infinite();
1099                 for(Standard_Integer ip = 2; ip <= nbp; ip++) {
1100                   p1 = poles(ip);
1101                   d = Min(d,p.SquareDistance(p1));
1102                   p = p1;
1103                 }
1104                 d = sqrt(d)*.1;
1105
1106                 Tol2dbail = Max(Min(Tol2dbail,d),Tol2d);
1107
1108                 Geom2dConvert::C0BSplineToC1BSplineCurve(bs2d,Tol2dbail);
1109
1110                 if(bs2d->IsPeriodic()) { // -------- IFV, Jan 2000
1111                   gp_Pnt2d NewOriginPoint;
1112                   bs2d->D0(bs2d->FirstParameter(), NewOriginPoint);
1113                   if(Abs(OriginPoint.X() - NewOriginPoint.X()) > Precision::PConfusion() ||
1114                     Abs(OriginPoint.Y() - NewOriginPoint.Y()) > Precision::PConfusion()    ) {
1115
1116                       TColStd_Array1OfReal Knotbs2d (1, bs2d->NbKnots());
1117                       bs2d->Knots(Knotbs2d);
1118
1119                       for(Standard_Integer Index = 1; Index <= bs2d->NbKnots(); Index++) {
1120                         bs2d->D0(Knotbs2d(Index), NewOriginPoint);
1121                         if(Abs(OriginPoint.X() - NewOriginPoint.X()) > Precision::PConfusion() ||
1122                           Abs(OriginPoint.Y() - NewOriginPoint.Y()) > Precision::PConfusion()    ) continue;
1123
1124                         bs2d->SetOrigin(Index);
1125                         break;
1126                       }
1127                   }
1128                 }
1129
1130
1131                 if(bs2d->Continuity() == GeomAbs_C0) {
1132                   goodpc = 1;
1133                   bs2d = bs2dsov;
1134                   repar = Standard_False;
1135                 }
1136               }
1137               else goodpc = 0;
1138             }
1139
1140             if(goodpc){
1141               if(repar) {
1142                 Standard_Integer NbKnots = bs2d->NbKnots();
1143                 TColStd_Array1OfReal Knots(1,NbKnots);
1144                 bs2d->Knots(Knots);
1145                 //          BSplCLib::Reparametrize(f3d,l3d,Knots);
1146                 BSplCLib::Reparametrize(fC0,lC0,Knots);
1147                 bs2d->SetKnots(Knots);
1148                 GAC2d.Load(bs2d,f3d,l3d);
1149                 curPC = bs2d;
1150                 Standard_Boolean updatepcsov = updatepc;
1151                 updatepc = Standard_True;
1152
1153                 Standard_Real error1 = ComputeTol(HC, HC2d, HS, NCONTROL);
1154                 if(error1 > error) {
1155                   bs2d = bs2dsov;
1156                   GAC2d.Load(bs2d,f3d,l3d);
1157                   curPC = bs2d;
1158                   updatepc = updatepcsov;
1159                   isANA = Standard_True;
1160                 }
1161                 else {
1162                   error = error1;
1163                 }
1164               }
1165
1166               //check, if new BSpline "good" or not --------- IFV, Jan of 2000
1167               GeomAbs_Shape cont = bs2d->Continuity();
1168               Standard_Boolean IsBad = Standard_False;
1169
1170               if(cont > GeomAbs_C0 && error > Max(1.e-3,Tolerance)) {
1171                 Standard_Integer NbKnots = bs2d->NbKnots();
1172                 TColStd_Array1OfReal Knots(1,NbKnots);
1173                 bs2d->Knots(Knots);
1174                 Standard_Real critratio = 10.;
1175                 Standard_Real dtprev = Knots(2) - Knots(1), dtratio = 1.;
1176                 Standard_Real dtmin = dtprev;
1177                 Standard_Real dtcur;
1178                 for(Standard_Integer j = 2; j < NbKnots; j++) {
1179                   dtcur = Knots(j+1) - Knots(j);
1180                   dtmin = Min(dtmin, dtcur);
1181
1182                   if(IsBad) continue;
1183
1184                   if(dtcur > dtprev) dtratio = dtcur/dtprev;
1185                   else dtratio = dtprev/dtcur;
1186                   if(dtratio > critratio) {IsBad = Standard_True;}
1187                   dtprev = dtcur;
1188
1189                 }
1190                 if(IsBad) {
1191                   // To avoid failures in Approx_CurvilinearParameter
1192                   bs2d->Resolution(Max(1.e-3,Tolerance), dtcur);
1193                   if(dtmin < dtcur) IsBad = Standard_False;
1194                 }
1195               }
1196
1197
1198               if(IsBad ) { //if BSpline "bad", try to reparametrize it
1199                 // by its curve length
1200
1201                 //            GeomAbs_Shape cont = bs2d->Continuity();
1202                 if(cont > GeomAbs_C2) cont = GeomAbs_C2;
1203                 Standard_Integer maxdeg = bs2d->Degree();
1204                 if(maxdeg == 1) maxdeg = 14;
1205                 Approx_CurvilinearParameter AppCurPar(HC2d, HS, Max(1.e-3,Tolerance),
1206                   cont, maxdeg, 10);
1207                 if(AppCurPar.IsDone() || AppCurPar.HasResult()) {
1208                   bs2d = AppCurPar.Curve2d1();
1209                   GAC2d.Load(bs2d,f3d,l3d);
1210                   curPC = bs2d;
1211
1212                   if(Abs(bs2d->FirstParameter() - fC0) > Tol2d ||
1213                     Abs(bs2d->LastParameter() - lC0) > Tol2d    ) {
1214                       Standard_Integer NbKnots = bs2d->NbKnots();
1215                       TColStd_Array1OfReal Knots(1,NbKnots);
1216                       bs2d->Knots(Knots);
1217                       //                  BSplCLib::Reparametrize(f3d,l3d,Knots);
1218                       BSplCLib::Reparametrize(fC0,lC0,Knots);
1219                       bs2d->SetKnots(Knots);
1220                       GAC2d.Load(bs2d,f3d,l3d);
1221                       curPC = bs2d;
1222
1223                   }
1224                 }
1225               }
1226
1227
1228             }
1229         }
1230
1231
1232         if(goodpc){
1233           //      Approx_SameParameter SameP(HC,HC2d,HS,Tolerance);
1234           Standard_Real aTol = (isANA && isBSP) ? 1.e-7 : Tolerance;
1235           Approx_SameParameter SameP(HC,HC2d,HS,aTol);
1236
1237           if (SameP.IsSameParameter()) {
1238             maxdist = Max(maxdist,SameP.TolReached());
1239             if(updatepc){
1240               if (i == 0) GCurve->PCurve(curPC);
1241               else GCurve->PCurve2(curPC);
1242             }
1243           }
1244           else if (SameP.IsDone()) {
1245             Standard_Real tolreached = SameP.TolReached();
1246             if(tolreached < error) {
1247               curPC = SameP.Curve2d();
1248               updatepc = Standard_True;
1249               maxdist = Max(maxdist,tolreached);
1250             }
1251             else {
1252               maxdist = Max(maxdist, error);
1253             }
1254             if(updatepc){
1255               if (i == 0) GCurve->PCurve(curPC);
1256               else GCurve->PCurve2(curPC);
1257             }
1258           }
1259           else IsSameP = 0;
1260
1261         }
1262         else IsSameP = 0;
1263
1264         //  Modified by skv - Thu Jun  3 12:39:19 2004 OCC5898 Begin
1265         if (!IsSameP) {
1266           if (anEdgeTol > error) {
1267             maxdist = Max(maxdist, anEdgeTol);
1268             IsSameP = Standard_True;
1269           }
1270         }
1271         //  Modified by skv - Thu Jun  3 12:39:20 2004 OCC5898 End
1272       }
1273     }
1274     It.Next() ;
1275   }
1276   B.Range(AnEdge,f3d,l3d);
1277   B.SameRange(AnEdge,Standard_True);
1278   if ( IsSameP) {
1279     // Reduce eventually the tolerance of the edge, as
1280     // all its representations are processed (except for some associated
1281     // to planes and not stored in the edge !)
1282     // The same cannot be done with vertices that cannot be enlarged
1283     // or left as is.
1284     if (YaPCu) {
1285       // Avoid setting too small tolerances.
1286       maxdist = Max(maxdist,Precision::Confusion());
1287       TopoDS_Vertex V1,V2;
1288       TopExp::Vertices(AnEdge,V1,V2);
1289       if (!V1.IsNull())
1290         B.UpdateVertex(V1,maxdist);
1291       if (!V2.IsNull())
1292         B.UpdateVertex(V2,maxdist);
1293       TE->Modified(Standard_True);
1294       TE->Tolerance(maxdist);
1295     }
1296     B.SameParameter(AnEdge,Standard_True);
1297   }
1298 }
1299
1300 //=======================================================================
1301 //function : UpdateTolerances
1302 //purpose  :
1303 //=======================================================================
1304 void  BRepLib::UpdateTolerances(const TopoDS_Shape& aShape,
1305   const Standard_Boolean verifyTolerance)
1306 {
1307
1308   // Harmonize tolerances
1309   // with rule Tolerance(VERTEX)>=Tolerance(EDGE)>=Tolerance(FACE)
1310   BRep_Builder B;
1311   Standard_Real tol=0;
1312   if (verifyTolerance) {
1313     // Set tolerance to its minimum value
1314     Handle(Geom_Surface) S;
1315     TopLoc_Location l;
1316     TopExp_Explorer ex;
1317     Bnd_Box aB;
1318     Standard_Real aXmin, aYmin, aZmin, aXmax, aYmax, aZmax, dMax;
1319     for (ex.Init(aShape, TopAbs_FACE); ex.More(); ex.Next()) {
1320       const TopoDS_Face& curf=TopoDS::Face(ex.Current());
1321       S = BRep_Tool::Surface(curf, l);
1322       if (!S.IsNull()) {
1323         aB.SetVoid();
1324         BRepBndLib::Add(curf,aB);
1325         if (S->DynamicType() == STANDARD_TYPE(Geom_RectangularTrimmedSurface)) {
1326           S = (*((Handle(Geom_RectangularTrimmedSurface)*)&S))->BasisSurface();
1327         }
1328         GeomAdaptor_Surface AS(S);
1329         switch (AS.GetType()) {
1330         case GeomAbs_Plane:
1331         case GeomAbs_Cylinder:
1332         case GeomAbs_Cone:
1333           {
1334             tol=Precision::Confusion();
1335             break;
1336           }
1337         case GeomAbs_Sphere:
1338         case GeomAbs_Torus:
1339           {
1340             tol=Precision::Confusion()*2;
1341             break;
1342           }
1343         default:
1344           tol=Precision::Confusion()*4;
1345         }
1346         if (!aB.IsWhole()) {
1347           aB.Get(aXmin, aYmin, aZmin, aXmax, aYmax, aZmax);
1348           dMax=1.;
1349           if (!aB.IsOpenXmin() && !aB.IsOpenXmax()) dMax=aXmax-aXmin;
1350           if (!aB.IsOpenYmin() && !aB.IsOpenYmax()) aYmin=aYmax-aYmin;
1351           if (!aB.IsOpenZmin() && !aB.IsOpenZmax()) aZmin=aZmax-aZmin;
1352           if (aYmin>dMax) dMax=aYmin;
1353           if (aZmin>dMax) dMax=aZmin;
1354           tol=tol*dMax;
1355           // Do not process tolerances > 1.
1356           if (tol>1.) tol=0.99;
1357         }
1358         const Handle(BRep_TFace)& Tf = *((Handle(BRep_TFace)*)&curf.TShape());
1359         Tf->Tolerance(tol);
1360       }
1361     }
1362   }
1363
1364   //Process edges
1365   TopTools_IndexedDataMapOfShapeListOfShape parents;
1366   TopExp::MapShapesAndAncestors(aShape, TopAbs_EDGE, TopAbs_FACE, parents);
1367   TopTools_ListIteratorOfListOfShape lConx;
1368   Standard_Integer iCur;
1369   for (iCur=1; iCur<=parents.Extent(); iCur++) {
1370     tol=0;
1371     for (lConx.Initialize(parents(iCur)); lConx.More(); lConx.Next()) {
1372       tol=Max(tol, BRep_Tool::Tolerance(TopoDS::Face(lConx.Value())));
1373     }
1374     // Update can only increase tolerance, so if the edge has a greater
1375     //  tolerance than its faces it is not concerned
1376     B.UpdateEdge(TopoDS::Edge(parents.FindKey(iCur)), tol);
1377   }
1378
1379   //Vertices are processed
1380   parents.Clear();
1381   TopExp::MapShapesAndAncestors(aShape, TopAbs_VERTEX, TopAbs_EDGE, parents);
1382   TColStd_MapOfTransient Initialized;
1383   TopTools_MapOfShape Done;
1384   Standard_Integer nbV = parents.Extent();
1385   for (iCur=1; iCur<=nbV; iCur++) {
1386     tol=0;
1387     Done.Clear();
1388     const TopoDS_Vertex& V = TopoDS::Vertex(parents.FindKey(iCur));
1389     Bnd_Box box;
1390     box.Add(BRep_Tool::Pnt(V));
1391     gp_Pnt p3d;
1392     for (lConx.Initialize(parents(iCur)); lConx.More(); lConx.Next()) {
1393       const TopoDS_Edge& E = TopoDS::Edge(lConx.Value());
1394       if(!Done.Add(E)) continue;
1395       tol=Max(tol, BRep_Tool::Tolerance(E));
1396       if(!BRep_Tool::SameRange(E)) continue;
1397       Standard_Real par = BRep_Tool::Parameter(V,E);
1398       Handle(BRep_TEdge)& TE = *((Handle(BRep_TEdge)*)&E.TShape());
1399       BRep_ListIteratorOfListOfCurveRepresentation itcr(TE->Curves());
1400       const TopLoc_Location& Eloc = E.Location();
1401       while (itcr.More()) {
1402         // For each CurveRepresentation, check the provided parameter
1403         const Handle(BRep_CurveRepresentation)& cr = itcr.Value();
1404         const TopLoc_Location& loc = cr->Location();
1405         TopLoc_Location L = (Eloc * loc);
1406         if (cr->IsCurve3D()) {
1407           const Handle(Geom_Curve)& C = cr->Curve3D();
1408           if (!C.IsNull()) { // edge non degenerated
1409             p3d = C->Value(par);
1410             p3d.Transform(L.Transformation());
1411             box.Add(p3d);
1412           }
1413         }
1414         else if (cr->IsCurveOnSurface()) {
1415           const Handle(Geom_Surface)& Su = cr->Surface();
1416           const Handle(Geom2d_Curve)& PC = cr->PCurve();
1417           Handle(Geom2d_Curve) PC2;
1418           if (cr->IsCurveOnClosedSurface()) {
1419             PC2 = cr->PCurve2();
1420           }
1421           gp_Pnt2d p2d = PC->Value(par);
1422           p3d = Su->Value(p2d.X(),p2d.Y());
1423           p3d.Transform(L.Transformation());
1424           box.Add(p3d);
1425           if (!PC2.IsNull()) {
1426             p2d = PC2->Value(par);
1427             p3d = Su->Value(p2d.X(),p2d.Y());
1428             p3d.Transform(L.Transformation());
1429             box.Add(p3d);
1430           }
1431         }
1432         itcr.Next();
1433       }
1434     }
1435     Standard_Real aXmin, aYmin, aZmin, aXmax, aYmax, aZmax;
1436     box.Get(aXmin, aYmin, aZmin, aXmax, aYmax, aZmax);
1437     aXmax -= aXmin; aYmax -= aYmin; aZmax -= aZmin;
1438     tol = Max(tol,sqrt(aXmax*aXmax+aYmax*aYmax+aZmax*aZmax));
1439     tol += 2.*Epsilon(tol);
1440     if (verifyTolerance) {
1441       // ASet minimum value of the tolerance
1442       // Attention to sharing of the vertex by other shapes
1443       const Handle(BRep_TVertex)& TV = *((Handle(BRep_TVertex)*)&V.TShape());
1444       if (Initialized.Add(TV))
1445         TV->Tolerance(tol);
1446       else
1447         B.UpdateVertex(V, tol);
1448     }
1449     else {
1450       // Update can only increase tolerance, so if the edge has a greater
1451       //  tolerance than its faces it is not concerned
1452       B.UpdateVertex(V, tol);
1453     }
1454   }
1455 }
1456
1457 //=======================================================================
1458 //function : OrientClosedSolid
1459 //purpose  :
1460 //=======================================================================
1461 Standard_Boolean BRepLib::OrientClosedSolid(TopoDS_Solid& solid)
1462 {
1463   // Set material inside the solid
1464   BRepClass3d_SolidClassifier where(solid);
1465   where.PerformInfinitePoint(Precision::Confusion());
1466   if (where.State()==TopAbs_IN) {
1467     solid.Reverse();
1468   }
1469   else if (where.State()==TopAbs_ON || where.State()==TopAbs_UNKNOWN)
1470     return Standard_False;
1471
1472   return Standard_True;
1473 }
1474
1475 //=======================================================================
1476 //function : tgtfaces
1477 //purpose  : check the angle at the border between two squares.
1478 //           Two shares should have a shared front edge.
1479 //=======================================================================
1480
1481 static Standard_Boolean tgtfaces(const TopoDS_Edge& Ed,
1482   const TopoDS_Face& F1,
1483   const TopoDS_Face& F2,
1484   const Standard_Real ta,
1485   const Standard_Boolean couture)
1486 {
1487   // Check if pcurves exist on both faces of edge
1488   Standard_Real aFirst,aLast;
1489   Handle(Geom2d_Curve) aCurve;
1490   aCurve = BRep_Tool::CurveOnSurface(Ed,F1,aFirst,aLast);
1491   if(aCurve.IsNull())
1492     return Standard_False;
1493   aCurve = BRep_Tool::CurveOnSurface(Ed,F2,aFirst,aLast);
1494   if(aCurve.IsNull())
1495     return Standard_False;
1496
1497   Standard_Real u;
1498   TopoDS_Edge E = Ed;
1499   BRepAdaptor_Surface aBAS1(F1,Standard_False);
1500   BRepAdaptor_Surface aBAS2(F2,Standard_False);
1501   Handle(BRepAdaptor_HSurface) HS1 = new BRepAdaptor_HSurface(aBAS1);
1502   Handle(BRepAdaptor_HSurface) HS2;
1503   if(couture) HS2 = HS1;
1504   else HS2 = new BRepAdaptor_HSurface(aBAS2);
1505
1506   E.Orientation(TopAbs_FORWARD);
1507   Handle(BRepAdaptor_HCurve2d) HC2d1 = new BRepAdaptor_HCurve2d();
1508   HC2d1->ChangeCurve2d().Initialize(E,F1);
1509   if(couture) E.Orientation(TopAbs_REVERSED);
1510   Handle(BRepAdaptor_HCurve2d) HC2d2 = new BRepAdaptor_HCurve2d();
1511   HC2d2->ChangeCurve2d().Initialize(E,F2);
1512   Adaptor3d_CurveOnSurface C1(HC2d1,HS1);
1513   Adaptor3d_CurveOnSurface C2(HC2d2,HS2);
1514
1515   Standard_Boolean rev1 = (F1.Orientation() == TopAbs_REVERSED);
1516   Standard_Boolean rev2 = (F2.Orientation() == TopAbs_REVERSED);
1517   Standard_Real f,l,eps, angmax = -M_PI;
1518   Standard_Real ang =0.;
1519   BRep_Tool::Range(E,f,l);
1520   Extrema_LocateExtPC ext;
1521   Standard_Boolean IsInitialized = Standard_False;
1522
1523   eps = (l - f)/100.;
1524   f += eps; // to avoid calculations on
1525   l -= eps; // points of pointed squares.
1526   gp_Pnt2d p;
1527   gp_Pnt pp1,pp2;//,PP;
1528   gp_Vec du,dv;
1529   gp_Vec d1,d2;
1530   Standard_Real uu, vv, norm;
1531
1532   Standard_Integer i;
1533   Standard_Boolean Nok;
1534   for(i = 0; (i<= 20) && (angmax<=ta) ; i++){
1535     // First suppose that this is sameParameter
1536     Nok = Standard_True;
1537     u = f + (l-f)*i/20;
1538     HC2d1->D0(u,p);
1539     HS1->D1(p.X(),p.Y(),pp1,du,dv);
1540     d1 = (du.Crossed(dv));
1541     norm = d1.Magnitude();
1542     if (norm > 1.e-12) d1 /= norm;
1543     else Nok=Standard_False;
1544     if(rev1) d1.Reverse();
1545
1546     HC2d2->D0(u,p);
1547     HS2->D1(p.X(), p.Y(), pp2, du, dv);
1548     d2 = (du.Crossed(dv));
1549     norm = d2.Magnitude();
1550     if (norm> 1.e-12) d2 /= norm;
1551     else Nok=Standard_False;
1552     if(rev2) d2.Reverse();
1553     if (Nok) ang = d1.Angle(d2);
1554
1555     if (Nok &&(ang > ta)) { // Refine by projection
1556       if (! IsInitialized ) {
1557         ext.Initialize(C2,f,l,Precision::PConfusion());
1558         IsInitialized = Standard_True;
1559       }
1560       ext.Perform(pp1,u);
1561       if(ext.IsDone() && ext.IsMin()){
1562         Extrema_POnCurv poc = ext.Point();
1563         Standard_Real v = poc.Parameter();
1564
1565         HC2d2->D0(v,p);
1566         p.Coord(uu,vv);
1567         HS2->D1(p.X(), p.Y(), pp2, du, dv);
1568         d2 = (du.Crossed(dv));
1569         norm = d2.Magnitude();
1570         if (norm> 1.e-12) d2 /= norm;
1571         else Nok = Standard_False;
1572         if(rev2) d2.Reverse();
1573         if (Nok) ang = d1.Angle(d2);
1574       }
1575     }
1576     if(ang >= angmax) angmax = ang;
1577   }
1578
1579   return (angmax<=ta);
1580
1581 }
1582
1583
1584 //=======================================================================
1585 // function : EncodeRegularity
1586 // purpose  : code the regularities on all edges of the shape, boundary of
1587 //            two faces that do not have it.
1588 //=======================================================================
1589
1590 void BRepLib::EncodeRegularity(const TopoDS_Shape& S,
1591   const Standard_Real TolAng)
1592 {
1593   BRep_Builder B;
1594   TopTools_IndexedDataMapOfShapeListOfShape M;
1595   TopExp::MapShapesAndAncestors(S,TopAbs_EDGE,TopAbs_FACE,M);
1596   TopTools_ListIteratorOfListOfShape It;
1597   TopExp_Explorer Ex;
1598   TopoDS_Face F1,F2;
1599   Standard_Boolean found, couture;
1600   for(Standard_Integer i = 1; i <= M.Extent(); i++){
1601     TopoDS_Edge E = TopoDS::Edge(M.FindKey(i));
1602     found = Standard_False; couture = Standard_False;
1603     F1.Nullify();
1604     for(It.Initialize(M.FindFromIndex(i));It.More() && !found;It.Next()){
1605       if(F1.IsNull()) { F1 = TopoDS::Face(It.Value()); }
1606       else {
1607         if(!F1.IsSame(TopoDS::Face(It.Value()))){
1608           found = Standard_True;
1609           F2 = TopoDS::Face(It.Value());
1610         }
1611       }
1612     }
1613     if (!found && !F1.IsNull()){//is it a sewing edge?
1614       TopAbs_Orientation orE = E.Orientation();
1615       TopoDS_Edge curE;
1616       for(Ex.Init(F1,TopAbs_EDGE);Ex.More() && !found;Ex.Next()){
1617         curE= TopoDS::Edge(Ex.Current());
1618         if(E.IsSame(curE) && orE != curE.Orientation()) {
1619           found = Standard_True;
1620           couture = Standard_True;
1621           F2 = F1;
1622         }
1623       }
1624     }
1625     if(found){
1626       if(BRep_Tool::Continuity(E,F1,F2)<=GeomAbs_C0){
1627
1628         try {
1629           if(tgtfaces(E, F1, F2, TolAng, couture)){
1630             B.Continuity(E,F1,F2,GeomAbs_G1);
1631           }
1632         }
1633         catch(Standard_Failure)
1634         {
1635         }
1636       }
1637     }
1638   }
1639 }
1640
1641 //=======================================================================
1642 // function : EncodeRegularity
1643 // purpose  : code the regularity between 2 faces on an edge
1644 //=======================================================================
1645
1646 void BRepLib::EncodeRegularity(TopoDS_Edge& E,
1647   const TopoDS_Face& F1,
1648   const TopoDS_Face& F2,
1649   const Standard_Real TolAng)
1650 {
1651   BRep_Builder B;
1652   if(BRep_Tool::Continuity(E,F1,F2)<=GeomAbs_C0){
1653     try {
1654       if( tgtfaces(E, F1, F2, TolAng, F1.IsEqual(F2))) {
1655         B.Continuity(E,F1,F2,GeomAbs_G1);
1656       }
1657     }
1658     catch(Standard_Failure)
1659     {
1660     }
1661   }
1662 }
1663
1664 //=======================================================================
1665 // function : EnsureNormalConsistency
1666 // purpose  : Corrects the normals in Poly_Triangulation of faces.
1667 //              Returns TRUE if any correction is done.
1668 //=======================================================================
1669 Standard_Boolean BRepLib::
1670             EnsureNormalConsistency(const TopoDS_Shape& theShape,
1671                                     const Standard_Real theAngTol,
1672                                     const Standard_Boolean theForceComputeNormals)
1673 {
1674   const Standard_Real aThresDot = cos(theAngTol);
1675
1676   Standard_Boolean aRetVal = Standard_False, isNormalsFound = Standard_False;
1677
1678   // compute normals if they are absent
1679   TopExp_Explorer anExpFace(theShape,TopAbs_FACE);
1680   for (; anExpFace.More(); anExpFace.Next())
1681   {
1682     const TopoDS_Face& aFace = TopoDS::Face(anExpFace.Current());
1683     const Handle(Geom_Surface) aSurf = BRep_Tool::Surface(aFace);
1684     if(aSurf.IsNull())
1685       continue;
1686     TopLoc_Location aLoc;
1687     const Handle(Poly_Triangulation)& aPT = BRep_Tool::Triangulation(aFace, aLoc);
1688     if(aPT.IsNull())
1689       continue;
1690     if (!theForceComputeNormals && aPT->HasNormals())
1691     {
1692       isNormalsFound = Standard_True;
1693       continue;
1694     }
1695
1696     GeomLProp_SLProps aSLP(aSurf, 2, Precision::Confusion());
1697     const Standard_Integer anArrDim = 3*aPT->NbNodes();
1698     Handle(TShort_HArray1OfShortReal) aNormArr = new TShort_HArray1OfShortReal(1, anArrDim);
1699     Standard_Integer anNormInd = aNormArr->Lower();
1700     for(Standard_Integer i = aPT->UVNodes().Lower(); i <= aPT->UVNodes().Upper(); i++)
1701     {
1702       const gp_Pnt2d &aP2d = aPT->UVNodes().Value(i);
1703       aSLP.SetParameters(aP2d.X(), aP2d.Y());
1704
1705       gp_XYZ aNorm(0.,0.,0.);
1706       if(!aSLP.IsNormalDefined())
1707       {
1708 #ifdef OCCT_DEBUG
1709         cout << "BRepLib::EnsureNormalConsistency(): Cannot find normal!" << endl;
1710 #endif
1711       }
1712       else
1713       {
1714         aNorm = aSLP.Normal().XYZ();
1715         if (aFace.Orientation() == TopAbs_REVERSED)
1716           aNorm.Reverse();
1717       }
1718       aNormArr->ChangeValue(anNormInd++) = static_cast<Standard_ShortReal>(aNorm.X());
1719       aNormArr->ChangeValue(anNormInd++) = static_cast<Standard_ShortReal>(aNorm.Y());
1720       aNormArr->ChangeValue(anNormInd++) = static_cast<Standard_ShortReal>(aNorm.Z());
1721     }
1722
1723     aRetVal = Standard_True;
1724     isNormalsFound = Standard_True;
1725     aPT->SetNormals(aNormArr);
1726   }
1727
1728   if(!isNormalsFound)
1729   {
1730     return aRetVal;
1731   }
1732
1733   // loop by edges
1734   TopTools_IndexedDataMapOfShapeListOfShape aMapEF;
1735   TopExp::MapShapesAndAncestors(theShape,TopAbs_EDGE,TopAbs_FACE,aMapEF);
1736   for(Standard_Integer anInd = 1; anInd <= aMapEF.Extent(); anInd++)
1737   {
1738     const TopoDS_Edge& anEdg = TopoDS::Edge(aMapEF.FindKey(anInd));
1739     const TopTools_ListOfShape& anEdgList = aMapEF.FindFromIndex(anInd);
1740     if (anEdgList.Extent() != 2)
1741       continue;
1742     TopTools_ListIteratorOfListOfShape anItF(anEdgList);
1743     const TopoDS_Face aFace1 = TopoDS::Face(anItF.Value());
1744     anItF.Next();
1745     const TopoDS_Face aFace2 = TopoDS::Face(anItF.Value());
1746     TopLoc_Location aLoc1, aLoc2;
1747     const Handle(Poly_Triangulation)& aPT1 = BRep_Tool::Triangulation(aFace1, aLoc1);
1748     const Handle(Poly_Triangulation)& aPT2 = BRep_Tool::Triangulation(aFace2, aLoc2);
1749
1750     if(aPT1.IsNull() || aPT2.IsNull())
1751       continue;
1752
1753     if(!aPT1->HasNormals() || !aPT2->HasNormals())
1754       continue;
1755
1756     const Handle(Poly_PolygonOnTriangulation)& aPTEF1 =
1757                                 BRep_Tool::PolygonOnTriangulation(anEdg, aPT1, aLoc1);
1758     const Handle(Poly_PolygonOnTriangulation)& aPTEF2 =
1759                                 BRep_Tool::PolygonOnTriangulation(anEdg, aPT2, aLoc2);
1760
1761     TShort_Array1OfShortReal& aNormArr1 = aPT1->ChangeNormals();
1762     TShort_Array1OfShortReal& aNormArr2 = aPT2->ChangeNormals();
1763
1764     for(Standard_Integer anEdgNode = aPTEF1->Nodes().Lower();
1765                          anEdgNode <= aPTEF1->Nodes().Upper(); anEdgNode++)
1766     {
1767       //Number of node
1768       const Standard_Integer aFNodF1 = aPTEF1->Nodes().Value(anEdgNode);
1769       const Standard_Integer aFNodF2 = aPTEF2->Nodes().Value(anEdgNode);
1770
1771       const Standard_Integer aFNorm1FirstIndex = aNormArr1.Lower() + 3*
1772                                                     (aFNodF1 - aPT1->Nodes().Lower());
1773       const Standard_Integer aFNorm2FirstIndex = aNormArr2.Lower() + 3*
1774                                                     (aFNodF2 - aPT2->Nodes().Lower());
1775
1776       gp_XYZ aNorm1(aNormArr1.Value(aFNorm1FirstIndex),
1777                     aNormArr1.Value(aFNorm1FirstIndex+1),
1778                     aNormArr1.Value(aFNorm1FirstIndex+2));
1779       gp_XYZ aNorm2(aNormArr2.Value(aFNorm2FirstIndex),
1780                     aNormArr2.Value(aFNorm2FirstIndex+1),
1781                     aNormArr2.Value(aFNorm2FirstIndex+2));
1782       const Standard_Real aDot = aNorm1 * aNorm2;
1783
1784       if(aDot > aThresDot)
1785       {
1786         gp_XYZ aNewNorm = (aNorm1 + aNorm2).Normalized();
1787         aNormArr1.ChangeValue(aFNorm1FirstIndex) =
1788           aNormArr2.ChangeValue(aFNorm2FirstIndex) =
1789           static_cast<Standard_ShortReal>(aNewNorm.X());
1790         aNormArr1.ChangeValue(aFNorm1FirstIndex+1) =
1791           aNormArr2.ChangeValue(aFNorm2FirstIndex+1) =
1792           static_cast<Standard_ShortReal>(aNewNorm.Y());
1793         aNormArr1.ChangeValue(aFNorm1FirstIndex+2) =
1794           aNormArr2.ChangeValue(aFNorm2FirstIndex+2) =
1795           static_cast<Standard_ShortReal>(aNewNorm.Z());
1796         aRetVal = Standard_True;
1797       }
1798     }
1799   }
1800
1801   return aRetVal;
1802 }
1803
1804 //=======================================================================
1805 //function : SortFaces
1806 //purpose  :
1807 //=======================================================================
1808
1809 void  BRepLib::SortFaces (const TopoDS_Shape& Sh,
1810   TopTools_ListOfShape& LF)
1811 {
1812   LF.Clear();
1813   TopTools_ListOfShape LTri,LPlan,LCyl,LCon,LSphere,LTor,LOther;
1814   TopExp_Explorer exp(Sh,TopAbs_FACE);
1815   TopLoc_Location l;
1816   Handle(Geom_Surface) S;
1817
1818   for (; exp.More(); exp.Next()) {
1819     const TopoDS_Face&   F = TopoDS::Face(exp.Current());
1820     S = BRep_Tool::Surface(F, l);
1821     if (!S.IsNull()) {
1822       if (S->DynamicType() == STANDARD_TYPE(Geom_RectangularTrimmedSurface)) {
1823         S = (*((Handle(Geom_RectangularTrimmedSurface)*)&S))->BasisSurface();
1824       }
1825       GeomAdaptor_Surface AS(S);
1826       switch (AS.GetType()) {
1827       case GeomAbs_Plane:
1828         {
1829           LPlan.Append(F);
1830           break;
1831         }
1832       case GeomAbs_Cylinder:
1833         {
1834           LCyl.Append(F);
1835           break;
1836         }
1837       case GeomAbs_Cone:
1838         {
1839           LCon.Append(F);
1840           break;
1841         }
1842       case GeomAbs_Sphere:
1843         {
1844           LSphere.Append(F);
1845           break;
1846         }
1847       case GeomAbs_Torus:
1848         {
1849           LTor.Append(F);
1850           break;
1851         }
1852       default:
1853         LOther.Append(F);
1854       }
1855     }
1856     else LTri.Append(F);
1857   }
1858   LF.Append(LPlan); LF.Append(LCyl  ); LF.Append(LCon); LF.Append(LSphere);
1859   LF.Append(LTor ); LF.Append(LOther); LF.Append(LTri);
1860 }
1861
1862 //=======================================================================
1863 //function : ReverseSortFaces
1864 //purpose  :
1865 //=======================================================================
1866
1867 void  BRepLib::ReverseSortFaces (const TopoDS_Shape& Sh,
1868   TopTools_ListOfShape& LF)
1869 {
1870   LF.Clear();
1871   TopTools_ListOfShape LTri,LPlan,LCyl,LCon,LSphere,LTor,LOther;
1872   TopExp_Explorer exp(Sh,TopAbs_FACE);
1873   TopLoc_Location l;
1874   Handle(Geom_Surface) S;
1875
1876   for (; exp.More(); exp.Next()) {
1877     const TopoDS_Face&   F = TopoDS::Face(exp.Current());
1878     S = BRep_Tool::Surface(F, l);
1879     if (!S.IsNull()) {
1880       if (S->DynamicType() == STANDARD_TYPE(Geom_RectangularTrimmedSurface)) {
1881         S = (*((Handle(Geom_RectangularTrimmedSurface)*)&S))->BasisSurface();
1882       }
1883       GeomAdaptor_Surface AS(S);
1884       switch (AS.GetType()) {
1885       case GeomAbs_Plane:
1886         {
1887           LPlan.Append(F);
1888           break;
1889         }
1890       case GeomAbs_Cylinder:
1891         {
1892           LCyl.Append(F);
1893           break;
1894         }
1895       case GeomAbs_Cone:
1896         {
1897           LCon.Append(F);
1898           break;
1899         }
1900       case GeomAbs_Sphere:
1901         {
1902           LSphere.Append(F);
1903           break;
1904         }
1905       case GeomAbs_Torus:
1906         {
1907           LTor.Append(F);
1908           break;
1909         }
1910       default:
1911         LOther.Append(F);
1912       }
1913     }
1914     else LTri.Append(F);
1915   }
1916   LF.Append(LTri); LF.Append(LOther); LF.Append(LTor ); LF.Append(LSphere);
1917   LF.Append(LCon); LF.Append(LCyl  ); LF.Append(LPlan);
1918
1919 }
1920