src/BRepLib/BRepLib_MakeWire.cxx

   1 // Created on: 1993-07-23
   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
  18 #include <BRep_Builder.hxx>
  19 #include <BRep_Tool.hxx>
  20 #include <BRepLib.hxx>
  21 #include <BRepLib_MakeEdge.hxx>
  22 #include <BRepLib_MakeWire.hxx>
  23 #include <Geom_Curve.hxx>
  24 #include <gp.hxx>
  25 #include <gp_Pnt.hxx>
  26 #include <StdFail_NotDone.hxx>
  27 #include <TopExp.hxx>
  28 #include <TopExp_Explorer.hxx>
  29 #include <TopoDS.hxx>
  30 #include <TopoDS_Edge.hxx>
  31 #include <TopoDS_Iterator.hxx>
  32 #include <TopoDS_Vertex.hxx>
  33 #include <TopoDS_Wire.hxx>
  34 #include <TopTools_MapIteratorOfMapOfShape.hxx>
  35 #include <TopTools_MapOfShape.hxx>
  36
  37 //=======================================================================
  38 //function : BRepLib_MakeWire
  39 //purpose  :
  40 //=======================================================================
  41 BRepLib_MakeWire::BRepLib_MakeWire() :
  42      myError(BRepLib_EmptyWire)
  43 {
  44 }
  45
  46
  47 //=======================================================================
  48 //function : BRepLib_MakeWire
  49 //purpose  :
  50 //=======================================================================
  51
  52 BRepLib_MakeWire::BRepLib_MakeWire(const TopoDS_Edge& E)
  53 {
  54   Add(E);
  55 }
  56
  57
  58 //=======================================================================
  59 //function : BRepLib_MakeWire
  60 //purpose  :
  61 //=======================================================================
  62
  63 BRepLib_MakeWire::BRepLib_MakeWire(const TopoDS_Edge& E1,
  64                                    const TopoDS_Edge& E2)
  65 {
  66   Add(E1);
  67   Add(E2);
  68 }
  69
  70
  71 //=======================================================================
  72 //function : BRepLib_MakeWire
  73 //purpose  :
  74 //=======================================================================
  75
  76 BRepLib_MakeWire::BRepLib_MakeWire(const TopoDS_Edge& E1,
  77                                    const TopoDS_Edge& E2,
  78                                    const TopoDS_Edge& E3)
  79 {
  80   Add(E1);
  81   Add(E2);
  82   Add(E3);
  83 }
  84
  85
  86 //=======================================================================
  87 //function : BRepLib_MakeWire
  88 //purpose  :
  89 //=======================================================================
  90
  91 BRepLib_MakeWire::BRepLib_MakeWire(const TopoDS_Edge& E1,
  92                                    const TopoDS_Edge& E2,
  93                                    const TopoDS_Edge& E3,
  94                                    const TopoDS_Edge& E4)
  95 {
  96   Add(E1);
  97   Add(E2);
  98   Add(E3);
  99   Add(E4);
 100 }
 101
 102
 103 //=======================================================================
 104 //function : BRepLib_MakeWire
 105 //purpose  :
 106 //=======================================================================
 107
 108 BRepLib_MakeWire::BRepLib_MakeWire(const TopoDS_Wire& W)
 109 {
 110   Add(W);
 111 }
 112
 113
 114 //=======================================================================
 115 //function : BRepLib_MakeWire
 116 //purpose  :
 117 //=======================================================================
 118
 119 BRepLib_MakeWire::BRepLib_MakeWire(const TopoDS_Wire& W,
 120                                    const TopoDS_Edge& E)
 121 {
 122   Add(W);
 123   Add(E);
 124 }
 125
 126
 127 //=======================================================================
 128 //function : Add
 129 //purpose  :
 130 //=======================================================================
 131
 132 void  BRepLib_MakeWire::Add(const TopoDS_Wire& W)
 133 {
 134   TopExp_Explorer ex(W,TopAbs_EDGE);
 135   while (ex.More()) {
 136     Add(TopoDS::Edge(ex.Current()));
 137     ex.Next();
 138   }
 139 }
 140
 141 //=======================================================================
 142 //function : Add
 143 //purpose  :
 144 // PMN  19/03/1998  For the Problem of performance TopExp::Vertices are not used on wire
 145 // PMN  10/09/1998  In case if the wire is previously closed (or degenerated)
 146 //                  TopExp::Vertices is used to reduce the ambiguity.
 147 //=======================================================================
 148
 149 void  BRepLib_MakeWire::Add(const TopoDS_Edge& E)
 150 {
 151
 152   Standard_Boolean forward = Standard_False;
 153      // to tell if it has been decided to add forward
 154   Standard_Boolean reverse = Standard_False;
 155      // to tell if it has been decided to add reversed
 156   Standard_Boolean init = Standard_False;
 157      // To know if it is necessary to calculate VL, VF
 158   BRep_Builder B;
 159   TopoDS_Iterator it;
 160
 161   if (myEdge.IsNull()) {
 162     init = Standard_True;
 163     // first edge, create the wire
 164     B.MakeWire(TopoDS::Wire(myShape));
 165
 166     // set the edge
 167     myEdge = E;
 168
 169     // add the vertices
 170     for (it.Initialize(myEdge); it.More(); it.Next())
 171       myVertices.Add(it.Value());
 172   }
 173
 174   else {
 175     init = myShape.Closed(); // If it is closed no control
 176     TopoDS_Shape aLocalShape = E.Oriented(TopAbs_FORWARD);
 177     TopoDS_Edge EE = TopoDS::Edge(aLocalShape);
 178 //    TopoDS_Edge EE = TopoDS::Edge(E.Oriented(TopAbs_FORWARD));
 179
 180     // test the vertices of the edge
 181
 182     Standard_Boolean connected = Standard_False;
 183     Standard_Boolean copyedge  = Standard_False;
 184
 185     if (myError != BRepLib_NonManifoldWire) {
 186       if (VF.IsNull() || VL.IsNull())
 187         myError = BRepLib_NonManifoldWire;
 188     }
 189
 190     for (it.Initialize(EE); it.More(); it.Next()) {
 191
 192       const TopoDS_Vertex& VE = TopoDS::Vertex(it.Value());
 193
 194       // if the vertex is in the wire, ok for the connection
 195       if (myVertices.Contains(VE)) {
 196         connected = Standard_True;
 197         myVertex = VE;
 198         if (myError != BRepLib_NonManifoldWire) {
 199           // is it always so ?
 200           if (VF.IsSame(VL)) {
 201             // Orientation indetermined (in 3d) : Preserve the initial
 202             if (!VF.IsSame(VE)) myError = BRepLib_NonManifoldWire;
 203           }
 204           else {
 205             if (VF.IsSame(VE)) {
 206               if  (VE.Orientation() == TopAbs_FORWARD)
 207                 reverse = Standard_True;
 208               else
 209                 forward = Standard_True;
 210             }
 211             else if (VL.IsSame(VE)) {
 212               if (VE.Orientation() == TopAbs_REVERSED)
 213                 reverse = Standard_True;
 214               else
 215                 forward = Standard_True;
 216             }
 217             else
 218               myError = BRepLib_NonManifoldWire;
 219           }
 220         }
 221       }
 222       else {
 223           // search if there is a similar vertex in the edge
 224         gp_Pnt PE = BRep_Tool::Pnt(VE);
 225
 226 //      Standard_Boolean newvertex = Standard_False;
 227         TopTools_MapIteratorOfMapOfShape itm(myVertices);
 228         while (itm.More()) {
 229
 230           const TopoDS_Vertex& VW = TopoDS::Vertex(itm.Key());
 231           gp_Pnt PW = BRep_Tool::Pnt(VW);
 232           Standard_Real l = PE.Distance(PW);
 233
 234           if ((l < BRep_Tool::Tolerance(VE)) ||
 235               (l < BRep_Tool::Tolerance(VW))) {
 236             copyedge = Standard_True;
 237             if (myError != BRepLib_NonManifoldWire) {
 238               // is it always so ?
 239               if (VF.IsSame(VL)) {
 240                 // Orientation indetermined (in 3d) : Preserve the initial
 241                 if (!VF.IsSame(VW)) myError = BRepLib_NonManifoldWire;
 242               }
 243               else {
 244                 if (VF.IsSame(VW)) {
 245                  if  (VE.Orientation() == TopAbs_FORWARD)
 246                    reverse = Standard_True;
 247                  else
 248                    forward = Standard_True;
 249                 }
 250                 else if (VL.IsSame(VW)) {
 251                   if (VE.Orientation() == TopAbs_REVERSED)
 252                     reverse = Standard_True;
 253                   else
 254                     forward = Standard_True;
 255                 }
 256                 else
 257                   myError = BRepLib_NonManifoldWire;
 258               }
 259             }
 260             break;
 261           }
 262           itm.Next();
 263         }
 264         if (copyedge) {
 265           connected = Standard_True;
 266         }
 267       }
 268     }
 269
 270     if (!connected) {
 271       myError = BRepLib_DisconnectedWire;
 272       NotDone();
 273       return;
 274     }
 275     else {
 276       if (!copyedge) {
 277         myEdge = EE;
 278         for (it.Initialize(EE); it.More(); it.Next())
 279           myVertices.Add(it.Value());
 280       }
 281       else {
 282         // copy the edge
 283         TopoDS_Shape Dummy = EE.EmptyCopied();
 284         myEdge = TopoDS::Edge(Dummy);
 285
 286         for (it.Initialize(EE); it.More(); it.Next()) {
 287
 288           const TopoDS_Vertex& VE = TopoDS::Vertex(it.Value());
 289           gp_Pnt PE = BRep_Tool::Pnt(VE);
 290
 291           Standard_Boolean newvertex = Standard_False;
 292           TopTools_MapIteratorOfMapOfShape itm(myVertices);
 293           while (itm.More()) {
 294
 295             const TopoDS_Vertex& VW = TopoDS::Vertex(itm.Key());
 296             gp_Pnt PW = BRep_Tool::Pnt(VW);
 297             Standard_Real l = PE.Distance(PW), tolE, tolW;
 298             tolW = BRep_Tool::Tolerance(VW);
 299             tolE = BRep_Tool::Tolerance(VE);
 300
 301             if ((l < tolE) || (l < tolW)) {
 302
 303               Standard_Real maxtol = .5*(tolW + tolE + l), cW, cE;
 304               if(maxtol > tolW && maxtol > tolE) {
 305                 cW = (maxtol - tolE)/l;
 306                 cE = 1. - cW;
 307               }
 308               else if (maxtol > tolW) {maxtol = tolE; cW = 0.; cE = 1.;}
 309               else {maxtol = tolW; cW = 1.; cE = 0.;}
 310
 311               gp_Pnt PC(cW*PW.X() + cE*PE.X(),cW*PW.Y() + cE*PE.Y(),cW*PW.Z() + cE*PE.Z());
 312
 313               B.UpdateVertex(VW, PC, maxtol);
 314
 315               newvertex = Standard_True;
 316               myVertex = VW;
 317               myVertex.Orientation(VE.Orientation());
 318               B.Add(myEdge,myVertex);
 319               B.Transfert(EE,myEdge,VE,myVertex);
 320               break;
 321             }
 322
 323             itm.Next();
 324           }
 325           if (!newvertex) {
 326             myVertices.Add(VE);
 327             B.Add(myEdge,VE);
 328             B.Transfert(EE,myEdge,VE,VE);
 329           }
 330         }
 331       }
 332     }
 333     // Make a decision about the orientation of the edge
 334     // If there is an ambiguity (in 3d) preserve the orientation given at input
 335     // Case of ambiguity :
 336     // reverse and forward are false as nothing has been decided :
 337     //       closed wire, internal vertex ...
 338     // reverse and forward are true : closed or degenerated edge
 339     if ( ((forward == reverse) && (E.Orientation() == TopAbs_REVERSED)) ||
 340        ( reverse && !forward) )  myEdge.Reverse();
 341   }
 342
 343   // add myEdge to myShape
 344   B.Add(myShape,myEdge);
 345   myShape.Closed(Standard_False);
 346
 347   // Initialize VF, VL
 348   if (init) TopExp::Vertices(TopoDS::Wire(myShape), VF,VL);
 349   else {
 350     if (myError == BRepLib_WireDone){ // Update only
 351       TopoDS_Vertex V1,V2,VRef;
 352       TopExp::Vertices(myEdge, V1, V2);
 353       if (V1.IsSame(myVertex)) VRef = V2;
 354       else if (V2.IsSame(myVertex)) VRef = V1;
 355       else {
 356 #ifdef OCCT_DEBUG
 357         cout << "MakeWire : There is a PROBLEM !!" << endl;
 358 #endif
 359         myError = BRepLib_NonManifoldWire;
 360       }
 361
 362       if (VF.IsSame(VL)) {
 363         // Particular case: it is required to control the orientation
 364 #ifdef OCCT_DEBUG
 365         if (!VF.IsSame(myVertex))
 366           cout << "MakeWire : There is a PROBLEM !!" << endl;
 367 #endif
 368
 369       }
 370       else { // General case
 371         if (VF.IsSame(myVertex)) VF = VRef;
 372         else if (VL.IsSame(myVertex)) VL = VRef;
 373         else {
 374 #ifdef OCCT_DEBUG
 375           cout << "MakeWire : Y A UN PROBLEME !!" << endl;
 376 #endif
 377           myError = BRepLib_NonManifoldWire;
 378         }
 379       }
 380     }
 381     if (myError == BRepLib_NonManifoldWire) {
 382       VF = VL = TopoDS_Vertex(); // nullify
 383     }
 384   }
 385   // Test myShape is closed
 386   if (!VF.IsNull() && !VL.IsNull() && VF.IsSame(VL))
 387     myShape.Closed(Standard_True);
 388
 389   myError = BRepLib_WireDone;
 390   Done();
 391 }
 392
 393
 394 //=======================================================================
 395 //function : Wire
 396 //purpose  :
 397 //=======================================================================
 398
 399 const TopoDS_Wire&  BRepLib_MakeWire::Wire()const
 400 {
 401   return TopoDS::Wire(Shape());
 402 }
 403
 404
 405 //=======================================================================
 406 //function : Edge
 407 //purpose  :
 408 //=======================================================================
 409
 410 const TopoDS_Edge&  BRepLib_MakeWire::Edge()const
 411 {
 412   return myEdge;
 413 }
 414
 415
 416 //=======================================================================
 417 //function : Vertex
 418 //purpose  :
 419 //=======================================================================
 420
 421 const TopoDS_Vertex&  BRepLib_MakeWire::Vertex()const
 422 {
 423   return myVertex;
 424 }
 425
 426
 427 //=======================================================================
 428 //function : operator
 429 //purpose  :
 430 //=======================================================================
 431
 432 BRepLib_MakeWire::operator TopoDS_Wire() const
 433 {
 434   return Wire();
 435 }
 436
 437
 438
 439 //=======================================================================
 440 //function : Error
 441 //purpose  :
 442 //=======================================================================
 443
 444 BRepLib_WireError BRepLib_MakeWire::Error() const
 445 {
 446   return myError;
 447 }