1 // Copyright (C) 2007-2012 CEA/DEN, EDF R&D, OPEN CASCADE
3 // This library is free software; you can redistribute it and/or
4 // modify it under the terms of the GNU Lesser General Public
5 // License as published by the Free Software Foundation; either
6 // version 2.1 of the License.
8 // This library is distributed in the hope that it will be useful,
9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 // Lesser General Public License for more details.
13 // You should have received a copy of the GNU Lesser General Public
14 // License along with this library; if not, write to the Free Software
15 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
17 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
19 #include <Standard_Stream.hxx>
21 #include <GEOMImpl_Fillet1dDriver.hxx>
23 #include <GEOMImpl_Fillet1d.hxx>
24 #include <GEOMImpl_IFillet1d.hxx>
25 #include <GEOMImpl_Types.hxx>
26 #include <GEOMImpl_IShapesOperations.hxx>
27 #include <GEOMImpl_HealingDriver.hxx>
28 #include <GEOM_Function.hxx>
30 #include <ShapeFix_Wire.hxx>
31 #include <StdFail_NotDone.hxx>
32 #include <Standard_ConstructionError.hxx>
36 #include <TopoDS_Edge.hxx>
37 #include <TopoDS_Wire.hxx>
38 #include <TopoDS_Shape.hxx>
40 #include <TopExp_Explorer.hxx>
41 #include <TopTools_DataMapOfShapeShape.hxx>
42 #include <TopTools_ListOfShape.hxx>
43 #include <TopTools_ListIteratorOfListOfShape.hxx>
44 #include <TopTools_IndexedDataMapOfShapeListOfShape.hxx>
45 #include <TopTools_IndexedMapOfShape.hxx>
47 #include <BRep_Tool.hxx>
48 #include <BRepTools.hxx>
49 #include <BRepBuilderAPI_MakeWire.hxx>
50 #include <BRepCheck_Analyzer.hxx>
56 #include <Precision.hxx>
58 //=======================================================================
61 //=======================================================================
62 const Standard_GUID& GEOMImpl_Fillet1dDriver::GetID()
64 static Standard_GUID aFillet1dDriver("FF60908B-AB2E-4b71-B098-5C256C37D961");
65 return aFillet1dDriver;
68 //=======================================================================
69 //function : GEOMImpl_Fillet1dDriver
71 //=======================================================================
72 GEOMImpl_Fillet1dDriver::GEOMImpl_Fillet1dDriver()
76 //=======================================================================
77 //function : anotherVertex
78 //purpose : local function to get vertex from edge
79 //=======================================================================
80 static TopoDS_Vertex anotherVertex( const TopoDS_Edge& theE,
81 const TopoDS_Vertex& theV )
83 // here is an assumption that edge has different vertices
85 TopExp_Explorer anExp( theE, TopAbs_VERTEX );
86 for ( ; anExp.More(); anExp.Next() )
88 if ( BRepTools::Compare(theV,TopoDS::Vertex(anExp.Current())) /*theV.IsSame(anExp.Current())*/ )
90 aV = TopoDS::Vertex( anExp.Current() );
96 //=======================================================================
97 //function : takePlane
98 //purpose : local function returns plane of given edges
99 //=======================================================================
100 static Standard_Boolean takePlane( const TopoDS_Edge& theE1,
101 const TopoDS_Edge& theE2,
102 const TopoDS_Vertex& theV,
105 TopoDS_Vertex aV12 = anotherVertex( theE1, theV );
106 TopoDS_Vertex aV22 = anotherVertex( theE2, theV );
107 // check can closed wire be created by two initial edges
108 if ( aV12.IsNull() || aV22.IsNull() || aV12.IsSame( aV22 ) )
111 // create plane by 3 points
112 gp_XYZ aXYZ = BRep_Tool::Pnt( theV ).XYZ();
113 gp_XYZ aXYZ1 = BRep_Tool::Pnt( aV12 ).XYZ();
114 gp_XYZ aXYZ2 = BRep_Tool::Pnt( aV22 ).XYZ();
116 gp_Dir aDir1( aXYZ - aXYZ1 );
117 gp_Dir aDir2( aXYZ2 - aXYZ );
118 Standard_Real anAngle = aDir1.Angle(aDir2);
119 if ( fabs(anAngle) <= gp::Resolution() ||
120 fabs(anAngle - M_PI) <= gp::Resolution() )
122 thePlane = gp_Pln( gp_Pnt(aXYZ), aDir1^ aDir2);
124 catch (Standard_Failure) {
130 //=======================================================================
131 //function : addEdgeRelation
132 //purpose : local function to remember relation between initial and modified edge
133 //=======================================================================
134 static void addEdgeRelation(TopTools_DataMapOfShapeShape& theMap,
135 const TopoDS_Edge& theInitE,
136 const TopoDS_Edge& theResE)
138 if ( theMap.IsBound( theInitE ) )
139 theMap.ChangeFind( theInitE ) = theResE;
141 theMap.Bind( theInitE, theResE );
144 //=======================================================================
147 //=======================================================================
148 Standard_Integer GEOMImpl_Fillet1dDriver::Execute(TFunction_Logbook& log) const
150 if (Label().IsNull()) return 0;
151 Handle(GEOM_Function) aFunction = GEOM_Function::GetFunction(Label());
153 GEOMImpl_IFillet1d aCI (aFunction);
155 Handle(GEOM_Function) aRefShape = aCI.GetShape();
156 TopoDS_Shape aShape = aRefShape->GetValue();
159 if (aShape.ShapeType() != TopAbs_WIRE)
160 Standard_ConstructionError::Raise("Wrong arguments: polyline as wire must be given");
162 TopoDS_Wire aWire = TopoDS::Wire(aShape);
164 bool doIgnoreSecantPoints = aCI.GetFlag();
166 double rad = aCI.GetR();
167 if (rad < Precision::Confusion())
170 // collect vertices for make fillet
171 TopTools_ListOfShape aVertexList;
172 TopTools_IndexedMapOfShape anIndices;
173 TopExp::MapShapes(aWire, anIndices);
174 int aLen = aCI.GetLength();
176 for (int ii = 1; ii <= aLen; ii++) {
177 int ind = aCI.GetVertex(ii);
178 if (1 <= ind && ind <= anIndices.Extent()) {
179 TopoDS_Shape aShapeVertex = anIndices.FindKey(ind);
180 if (aShapeVertex.ShapeType() == TopAbs_VERTEX)
181 aVertexList.Append(aShapeVertex);
185 else { // get all vertices from wire
186 TopTools_MapOfShape mapShape;
187 TopExp_Explorer anExp (aWire, TopAbs_VERTEX);
188 for (; anExp.More(); anExp.Next()) {
189 if (mapShape.Add(anExp.Current()))
190 aVertexList.Append(anExp.Current());
193 if (aVertexList.IsEmpty())
194 Standard_ConstructionError::Raise("Invalid input: no vertices to make fillet");
196 // at first we try to make fillet on the initial wire (without edges fusing)
197 bool isFinalPass = !doIgnoreSecantPoints;
199 bool isAllStepsOk = MakeFillet(aWire, aVertexList, rad, isFinalPass, aResult);
201 // try to fuse collinear edges to allow bigger radius
202 if (!isFinalPass && !isAllStepsOk) {
204 TopoDS_Shape aShapeNew;
205 Handle(TColStd_HSequenceOfTransient) aVerts;
206 GEOMImpl_HealingDriver::FuseCollinearEdges(aWire, aVerts, aShapeNew);
207 TopoDS_Wire aWireNew = TopoDS::Wire(aShapeNew);
209 // 2. Rebuild the list of vertices (by coincidence)
210 Standard_Real tol, tolMax = Precision::Confusion();
211 for (TopExp_Explorer ExV (aWireNew, TopAbs_VERTEX); ExV.More(); ExV.Next()) {
212 TopoDS_Vertex Vertex = TopoDS::Vertex(ExV.Current());
213 tol = BRep_Tool::Tolerance(Vertex);
218 TopTools_ListOfShape aVertexListNew;
219 TopTools_IndexedMapOfShape anIndicesNew;
220 TopExp::MapShapes(aWireNew, anIndicesNew);
221 TopTools_ListIteratorOfListOfShape anIt (aVertexList);
222 for (; anIt.More(); anIt.Next()) {
223 TopoDS_Vertex aV = TopoDS::Vertex(anIt.Value());
224 if (anIndicesNew.Contains(aV))
225 aVertexListNew.Append(aV);
227 // try to find by coords in the new wire
228 gp_Pnt aP = BRep_Tool::Pnt(aV);
230 bool isFound = false;
231 TopTools_MapOfShape mapShape;
232 TopExp_Explorer exp (aWireNew, TopAbs_VERTEX);
233 for (; exp.More() && !isFound; exp.Next()) {
234 if (mapShape.Add(exp.Current())) {
235 TopoDS_Vertex aVi = TopoDS::Vertex(exp.Current());
236 gp_Pnt aPi = BRep_Tool::Pnt(aVi);
237 if (aPi.Distance(aP) < tolMax) {
238 aVertexListNew.Append(aVi);
246 // 3. Repeat the fillet algorithm
248 MakeFillet(aWireNew, aVertexListNew, rad, isFinalPass, aResult);
251 aFunction->SetValue(aResult);
252 log.SetTouched(Label());
257 //=======================================================================
258 //function : MakeFillet
260 //=======================================================================
261 bool GEOMImpl_Fillet1dDriver::MakeFillet(const TopoDS_Wire& aWire,
262 const TopTools_ListOfShape& aVertexList,
263 const Standard_Real rad,
265 TopoDS_Wire& aResult) const
267 // this variable is needed to break execution
268 // in case of fillet failure and try to fuse edges
269 bool isAllStepsOk = true;
271 //INFO: this algorithm implemented in assumption that user can select both
272 // vertices of some edges to make fillet. In this case we should remember
273 // already modified initial edges to take care in next fillet step
274 TopTools_DataMapOfShapeShape anEdgeToEdgeMap;
276 //iterates on vertices, and make fillet on each couple of edges
277 //collect result fillet edges in list
278 TopTools_ListOfShape aListOfNewEdge;
279 // remember relation between initial and modified map
280 TopTools_IndexedDataMapOfShapeListOfShape aMapVToEdges;
281 TopExp::MapShapesAndAncestors( aWire, TopAbs_VERTEX, TopAbs_EDGE, aMapVToEdges );
282 TopTools_ListIteratorOfListOfShape anIt( aVertexList );
283 for ( ; anIt.More(); anIt.Next() ) {
284 TopoDS_Vertex aV = TopoDS::Vertex( anIt.Value() );
285 if ( aV.IsNull() || !aMapVToEdges.Contains( aV ) )
287 const TopTools_ListOfShape& aVertexEdges = aMapVToEdges.FindFromKey( aV );
288 if ( aVertexEdges.Extent() != 2 )
289 continue; // no input data to make fillet
290 TopoDS_Edge anEdge1 = TopoDS::Edge( aVertexEdges.First() );
291 TopoDS_Edge anEdge2 = TopoDS::Edge( aVertexEdges.Last() );
292 // check if initial edges already modified in previous fillet operation
293 if ( anEdgeToEdgeMap.IsBound( anEdge1 ) ) anEdge1 = TopoDS::Edge(anEdgeToEdgeMap.Find( anEdge1 ));
294 if ( anEdgeToEdgeMap.IsBound( anEdge2 ) ) anEdge2 = TopoDS::Edge(anEdgeToEdgeMap.Find( anEdge2 ));
295 if ( anEdge1.IsNull() || anEdge2.IsNull() || anEdge1.IsSame( anEdge2 ) )
296 continue; //no input data to make fillet
298 // create plane on 2 edges
300 if ( !takePlane(anEdge1, anEdge2, aV, aPlane) )
301 continue; // seems edges does not belong to same plane or parallel (fillet can not be build)
303 GEOMImpl_Fillet1d aFilletAlgo (anEdge1, anEdge2, aPlane);
304 if (!aFilletAlgo.Perform(rad)) {
306 continue; // can not create fillet with given radius
308 isAllStepsOk = false;
309 break; // can not create fillet with given radius
313 // take fillet result in given vertex
314 TopoDS_Edge aModifE1, aModifE2;
315 TopoDS_Edge aNewE = aFilletAlgo.Result(BRep_Tool::Pnt(aV), aModifE1, aModifE2);
316 if (aNewE.IsNull()) {
318 continue; // no result found
320 isAllStepsOk = false;
321 break; // no result found
325 // add new created edges and take modified edges
326 aListOfNewEdge.Append(aNewE);
328 // check if wire edges modified,
329 // if yes, then map to original edges (from vertex-edges list), because edges can be modified before
330 if (aModifE1.IsNull() || !anEdge1.IsSame( aModifE1 ))
331 addEdgeRelation( anEdgeToEdgeMap, TopoDS::Edge(aVertexEdges.First()), aModifE1 );
332 if (aModifE2.IsNull() || !anEdge2.IsSame( aModifE2 ))
333 addEdgeRelation( anEdgeToEdgeMap, TopoDS::Edge(aVertexEdges.Last()), aModifE2 );
336 if (anEdgeToEdgeMap.IsEmpty() && aListOfNewEdge.IsEmpty()) {
338 StdFail_NotDone::Raise("1D Fillet can't be computed on the given shape with the given radius");
340 isAllStepsOk = false;
346 // create new wire instead of original
347 for (TopExp_Explorer anExp (aWire, TopAbs_EDGE); anExp.More(); anExp.Next()) {
348 TopoDS_Shape anEdge = anExp.Current();
349 if (!anEdgeToEdgeMap.IsBound(anEdge))
350 aListOfNewEdge.Append(anEdge);
351 else if (!anEdgeToEdgeMap.Find(anEdge).IsNull())
352 aListOfNewEdge.Append(anEdgeToEdgeMap.Find(anEdge));
355 GEOMImpl_IShapesOperations::SortShapes(aListOfNewEdge);
357 BRepBuilderAPI_MakeWire aWireTool;
358 aWireTool.Add(aListOfNewEdge);
360 if (!aWireTool.IsDone())
363 aResult = aWireTool.Wire();
369 //=======================================================================
370 //function : GEOMImpl_Fillet1dDriver_Type_
372 //=======================================================================
373 Standard_EXPORT Handle_Standard_Type& GEOMImpl_Fillet1dDriver_Type_()
375 static Handle_Standard_Type aType1 = STANDARD_TYPE(TFunction_Driver);
376 if ( aType1.IsNull()) aType1 = STANDARD_TYPE(TFunction_Driver);
377 static Handle_Standard_Type aType2 = STANDARD_TYPE(MMgt_TShared);
378 if ( aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared);
379 static Handle_Standard_Type aType3 = STANDARD_TYPE(Standard_Transient);
380 if ( aType3.IsNull()) aType3 = STANDARD_TYPE(Standard_Transient);
382 static Handle_Standard_Transient _Ancestors[]= {aType1,aType2,aType3,NULL};
383 static Handle_Standard_Type _aType = new Standard_Type("GEOMImpl_Fillet1dDriver",
384 sizeof(GEOMImpl_Fillet1dDriver),
386 (Standard_Address)_Ancestors,
387 (Standard_Address)NULL);
392 //=======================================================================
393 //function : DownCast
395 //=======================================================================
396 const Handle(GEOMImpl_Fillet1dDriver) Handle(GEOMImpl_Fillet1dDriver)::DownCast(const Handle(Standard_Transient)& AnObject)
398 Handle(GEOMImpl_Fillet1dDriver) _anOtherObject;
400 if (!AnObject.IsNull()) {
401 if (AnObject->IsKind(STANDARD_TYPE(GEOMImpl_Fillet1dDriver))) {
402 _anOtherObject = Handle(GEOMImpl_Fillet1dDriver)((Handle(GEOMImpl_Fillet1dDriver)&)AnObject);
406 return _anOtherObject;