1 // Copyright (C) 2009 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
2 // CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
4 // This library is free software; you can redistribute it and/or
5 // modify it under the terms of the GNU Lesser General Public
6 // License as published by the Free Software Foundation; either
7 // version 2.1 of the License.
9 // This library is distributed in the hope that it will be useful
10 // but WITHOUT ANY WARRANTY; without even the implied warranty of
11 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 // Lesser General Public License for more details.
14 // You should have received a copy of the GNU Lesser General Public
15 // License along with this library; if not, write to the Free Software
16 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
18 // See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
21 #include <Standard_Stream.hxx>
23 #include <GEOMImpl_Fillet1dDriver.hxx>
25 #include <GEOMImpl_Fillet1d.hxx>
26 #include <GEOMImpl_IFillet1d.hxx>
27 #include <GEOMImpl_Types.hxx>
28 #include <GEOMImpl_ILocalOperations.hxx>
29 #include <GEOMImpl_IShapesOperations.hxx>
30 #include <GEOM_Function.hxx>
36 #include <BRep_Tool.hxx>
37 #include <BRepTools.hxx>
38 #include <BRepBuilderAPI_MakeWire.hxx>
39 #include <BRepCheck_Analyzer.hxx>
41 #include <Precision.hxx>
43 #include <ShapeFix_Wire.hxx>
44 #include <StdFail_NotDone.hxx>
45 #include <Standard_ConstructionError.hxx>
49 #include <TopoDS_Edge.hxx>
50 #include <TopoDS_Wire.hxx>
51 #include <TopoDS_Shape.hxx>
53 #include <TopExp_Explorer.hxx>
54 #include <TopTools_DataMapOfShapeShape.hxx>
55 #include <TopTools_ListOfShape.hxx>
56 #include <TopTools_ListIteratorOfListOfShape.hxx>
57 #include <TopTools_IndexedDataMapOfShapeListOfShape.hxx>
59 //=======================================================================
62 //=======================================================================
63 const Standard_GUID& GEOMImpl_Fillet1dDriver::GetID()
65 static Standard_GUID aFillet1dDriver("FF60908B-AB2E-4b71-B098-5C256C37D961");
66 return aFillet1dDriver;
69 //=======================================================================
70 //function : GEOMImpl_Fillet1dDriver
72 //=======================================================================
73 GEOMImpl_Fillet1dDriver::GEOMImpl_Fillet1dDriver()
77 //=======================================================================
78 //function : anotherVertex
79 //purpose : local function to get vertex from edge
80 //=======================================================================
81 static TopoDS_Vertex anotherVertex( const TopoDS_Edge& theE,
82 const TopoDS_Vertex& theV )
84 // here is an assumption that edge has different vertices
86 TopExp_Explorer anExp( theE, TopAbs_VERTEX );
87 for ( ; anExp.More(); anExp.Next() )
89 if ( BRepTools::Compare(theV,TopoDS::Vertex(anExp.Current())) /*theV.IsSame(anExp.Current())*/ )
91 aV = TopoDS::Vertex( anExp.Current() );
97 //=======================================================================
98 //function : takePlane
99 //purpose : local function returns plane of given edges
100 //=======================================================================
101 static Standard_Boolean takePlane( const TopoDS_Edge& theE1,
102 const TopoDS_Edge& theE2,
103 const TopoDS_Vertex& theV,
106 TopoDS_Vertex aV12 = anotherVertex( theE1, theV );
107 TopoDS_Vertex aV22 = anotherVertex( theE2, theV );
108 // check can closed wire be created by two initial edges
109 if ( aV12.IsNull() || aV22.IsNull() || aV12.IsSame( aV22 ) )
112 // create plane by 3 points
113 gp_XYZ aXYZ = BRep_Tool::Pnt( theV ).XYZ();
114 gp_XYZ aXYZ1 = BRep_Tool::Pnt( aV12 ).XYZ();
115 gp_XYZ aXYZ2 = BRep_Tool::Pnt( aV22 ).XYZ();
117 gp_Dir aDir1( aXYZ - aXYZ1 );
118 gp_Dir aDir2( aXYZ2 - aXYZ );
119 Standard_Real anAngle = aDir1.Angle(aDir2);
120 if ( fabs(anAngle) <= gp::Resolution() ||
121 fabs(anAngle - PI) <= gp::Resolution() )
123 thePlane = gp_Pln( gp_Pnt(aXYZ), aDir1^ aDir2);
125 catch (Standard_Failure) {
131 //=======================================================================
132 //function : addEdgeRelation
133 //purpose : local function to remember relation between initial and modified edge
134 //=======================================================================
135 static void addEdgeRelation(TopTools_DataMapOfShapeShape& theMap,
136 const TopoDS_Edge& theInitE,
137 const TopoDS_Edge& theResE)
139 if ( theMap.IsBound( theInitE ) )
140 theMap.ChangeFind( theInitE ) = theResE;
142 theMap.Bind( theInitE, theResE );
145 //=======================================================================
148 //=======================================================================
149 Standard_Integer GEOMImpl_Fillet1dDriver::Execute(TFunction_Logbook& log) const
151 if (Label().IsNull()) return 0;
152 Handle(GEOM_Function) aFunction = GEOM_Function::GetFunction(Label());
154 GEOMImpl_IFillet1d aCI (aFunction);
156 Handle(GEOM_Function) aRefShape = aCI.GetShape();
157 TopoDS_Shape aShape = aRefShape->GetValue();
160 if (aShape.ShapeType() != TopAbs_WIRE)
161 Standard_ConstructionError::Raise("Wrong arguments: polyline as wire must be given");
163 TopoDS_Wire aWire = TopoDS::Wire(aShape);
165 double rad = aCI.GetR();
167 if ( rad < Precision::Confusion())
170 // collect vertices for make fillet
171 TopTools_ListOfShape aVertexList;
172 TopTools_MapOfShape mapShape;
173 int aLen = aCI.GetLength();
175 for (int ind = 1; ind <= aLen; ind++) {
176 TopoDS_Shape aShapeVertex;
177 if (GEOMImpl_ILocalOperations::GetSubShape
178 (aWire, aCI.GetVertex(ind), aShapeVertex))
179 if (mapShape.Add(aShapeVertex))
180 aVertexList.Append( aShapeVertex );
182 } else { // get all vertices from wire
183 TopExp_Explorer anExp( aWire, TopAbs_VERTEX );
184 for ( ; anExp.More(); anExp.Next() ) {
185 if (mapShape.Add(anExp.Current()))
186 aVertexList.Append( anExp.Current() );
189 if (aVertexList.IsEmpty())
190 Standard_ConstructionError::Raise("Invalid input no vertices to make fillet");
192 //INFO: this algorithm implemented in assumption that user can select both
193 // vertices of some edges to make fillet. In this case we should remember
194 // already modified initial edges to take care in next fillet step
195 TopTools_DataMapOfShapeShape anEdgeToEdgeMap;
197 //iterates on vertices, and make fillet on each couple of edges
198 //collect result fillet edges in list
199 TopTools_ListOfShape aListOfNewEdge;
200 // remember relation between initial and modified map
201 TopTools_IndexedDataMapOfShapeListOfShape aMapVToEdges;
202 TopExp::MapShapesAndAncestors( aWire, TopAbs_VERTEX, TopAbs_EDGE, aMapVToEdges );
203 TopTools_ListIteratorOfListOfShape anIt( aVertexList );
204 for ( ; anIt.More(); anIt.Next() ) {
205 TopoDS_Vertex aV = TopoDS::Vertex( anIt.Value() );
206 if ( aV.IsNull() || !aMapVToEdges.Contains( aV ) )
208 const TopTools_ListOfShape& aVertexEdges = aMapVToEdges.FindFromKey( aV );
209 if ( aVertexEdges.Extent() != 2 )
210 continue; // no input data to make fillet
211 TopoDS_Edge anEdge1 = TopoDS::Edge( aVertexEdges.First() );
212 TopoDS_Edge anEdge2 = TopoDS::Edge( aVertexEdges.Last() );
213 // check if initial edges already modified in previous fillet operation
214 if ( anEdgeToEdgeMap.IsBound( anEdge1 ) ) anEdge1 = TopoDS::Edge(anEdgeToEdgeMap.Find( anEdge1 ));
215 if ( anEdgeToEdgeMap.IsBound( anEdge2 ) ) anEdge2 = TopoDS::Edge(anEdgeToEdgeMap.Find( anEdge2 ));
216 if ( anEdge1.IsNull() || anEdge2.IsNull() || anEdge1.IsSame( anEdge2 ) )
217 continue; //no input data to make fillet
219 // create plane on 2 edges
221 if ( !takePlane(anEdge1, anEdge2, aV, aPlane) )
222 continue; // seems edges does not belong to same plane or parallel (fillet can not be build)
224 GEOMImpl_Fillet1d aFilletAlgo(anEdge1, anEdge2, aPlane);
225 if ( !aFilletAlgo.Perform(rad) )
226 continue; // can not create fillet with given radius
228 // take fillet result in given vertex
229 TopoDS_Edge aModifE1, aModifE2;
230 TopoDS_Edge aNewE = aFilletAlgo.Result(BRep_Tool::Pnt(aV), aModifE1, aModifE2);
232 continue; // no result found
234 // add new created edges and take modified edges
235 aListOfNewEdge.Append( aNewE );
237 // check if face edges modified,
238 // if yes, than map to original edges (from vertex-edges list), because edges can be modified before
239 if (!aModifE1.IsNull() && !aModifE1.IsSame( anEdge1 ))
240 addEdgeRelation( anEdgeToEdgeMap, TopoDS::Edge(aVertexEdges.First()), aModifE1 );
241 if (!aModifE2.IsNull() && !aModifE2.IsSame( anEdge2 ))
242 addEdgeRelation( anEdgeToEdgeMap, TopoDS::Edge(aVertexEdges.Last()), aModifE2 );
245 if ( anEdgeToEdgeMap.IsEmpty() && aListOfNewEdge.IsEmpty() ) {
246 StdFail_NotDone::Raise("1D Fillet can't be computed on the given shape with the given radius");
250 // create new wire instead of original
251 for ( TopExp_Explorer anExp( aWire, TopAbs_EDGE ); anExp.More(); anExp.Next() ) {
252 TopoDS_Shape anEdge = anExp.Current();
253 if ( !anEdgeToEdgeMap.IsBound( anEdge ) )
254 aListOfNewEdge.Append( anEdge );
256 aListOfNewEdge.Append( anEdgeToEdgeMap.Find( anEdge ) );
259 GEOMImpl_IShapesOperations::SortShapes( aListOfNewEdge );
261 BRepBuilderAPI_MakeWire aWireTool;
262 aWireTool.Add( aListOfNewEdge );
264 if (!aWireTool.IsDone())
267 aWire = aWireTool.Wire();
268 aFunction->SetValue(aWire);
269 log.SetTouched(Label());
275 //=======================================================================
276 //function : GEOMImpl_Fillet1dDriver_Type_
278 //=======================================================================
279 Standard_EXPORT Handle_Standard_Type& GEOMImpl_Fillet1dDriver_Type_()
282 static Handle_Standard_Type aType1 = STANDARD_TYPE(TFunction_Driver);
283 if ( aType1.IsNull()) aType1 = STANDARD_TYPE(TFunction_Driver);
284 static Handle_Standard_Type aType2 = STANDARD_TYPE(MMgt_TShared);
285 if ( aType2.IsNull()) aType2 = STANDARD_TYPE(MMgt_TShared);
286 static Handle_Standard_Type aType3 = STANDARD_TYPE(Standard_Transient);
287 if ( aType3.IsNull()) aType3 = STANDARD_TYPE(Standard_Transient);
290 static Handle_Standard_Transient _Ancestors[]= {aType1,aType2,aType3,NULL};
291 static Handle_Standard_Type _aType = new Standard_Type("GEOMImpl_Fillet1dDriver",
292 sizeof(GEOMImpl_Fillet1dDriver),
294 (Standard_Address)_Ancestors,
295 (Standard_Address)NULL);
300 //=======================================================================
301 //function : DownCast
303 //=======================================================================
304 const Handle(GEOMImpl_Fillet1dDriver) Handle(GEOMImpl_Fillet1dDriver)::DownCast(const Handle(Standard_Transient)& AnObject)
306 Handle(GEOMImpl_Fillet1dDriver) _anOtherObject;
308 if (!AnObject.IsNull()) {
309 if (AnObject->IsKind(STANDARD_TYPE(GEOMImpl_Fillet1dDriver))) {
310 _anOtherObject = Handle(GEOMImpl_Fillet1dDriver)((Handle(GEOMImpl_Fillet1dDriver)&)AnObject);
314 return _anOtherObject ;