1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
|
// File: ShapeFix_EdgeConnect.cxx
// Created: Tue May 11 11:27:03 1999
// Author: Sergei ZERTCHANINOV
// <szv@nnov>
// Copyright: Matra Datavision 1999
#include <ShapeFix_EdgeConnect.ixx>
#include <TopExp.hxx>
#include <TopExp_Explorer.hxx>
#include <TopoDS.hxx>
#include <TopoDS_Vertex.hxx>
#include <TopoDS_Wire.hxx>
#include <TopTools_ListOfShape.hxx>
#include <TopTools_ListIteratorOfListOfShape.hxx>
#include <TopTools_DataMapIteratorOfDataMapOfShapeListOfShape.hxx>
#include <Precision.hxx>
#include <BRep_Builder.hxx>
#include <BRep_ListIteratorOfListOfCurveRepresentation.hxx>
#include <BRep_TEdge.hxx>
#include <BRep_GCurve.hxx>
#include <BRep_Tool.hxx>
#include <gp_XYZ.hxx>
#include <gp_Pnt.hxx>
#include <TColgp_SequenceOfXYZ.hxx>
//#define POSITION_USES_MEAN_POINT
//=======================================================================
//function : ShapeFix_EdgeConnect
//=======================================================================
ShapeFix_EdgeConnect::ShapeFix_EdgeConnect () {}
//=======================================================================
//function : Add
//purpose : Adds connectivity information for two edges
//=======================================================================
void ShapeFix_EdgeConnect::Add (const TopoDS_Edge& aFirst, const TopoDS_Edge& aSecond)
{
// Select vertices to connect
TopoDS_Vertex theFirstVertex = TopExp::LastVertex( aFirst, Standard_True );
TopoDS_Vertex theSecondVertex = TopExp::FirstVertex( aSecond, Standard_True );
// Make necessary bindings
if ( myVertices.IsBound( theFirstVertex ) ) {
// First vertex is bound - find shared vertex
TopoDS_Vertex theFirstShared = TopoDS::Vertex( myVertices( theFirstVertex ) );
if ( myVertices.IsBound( theSecondVertex ) ) {
// Second vertex is bound - find shared vertex
TopoDS_Vertex theSecondShared = TopoDS::Vertex( myVertices( theSecondVertex ) );
if ( !theFirstShared.IsSame(theSecondShared) ) {
// Concatenate lists
TopTools_ListOfShape& theFirstList = myLists( theFirstShared );
TopTools_ListOfShape& theSecondList = myLists( theSecondShared );
for ( TopTools_ListIteratorOfListOfShape theIterator( theSecondList );
theIterator.More();
theIterator.Next() ) {
// Rebind shared vertex for current one
myVertices( theIterator.Value() ) = theFirstShared;
// Skip the following edge
theIterator.Next();
}
// Append second list to the first one
theFirstList.Append( theSecondList );
// Unbind the second shared vertex
myLists.UnBind( theSecondShared );
}
}
else {
// Bind second vertex with shared vertex of the first one
myVertices.Bind( theSecondVertex, theFirstShared );
// Add second vertex and second edge to the list
TopTools_ListOfShape& theFirstList = myLists( theFirstShared );
theFirstList.Append( theSecondVertex );
theFirstList.Append( aSecond );
}
}
else {
if ( myVertices.IsBound( theSecondVertex ) ) {
// Second vertex is bound - find shared vertex
TopoDS_Vertex& theSecondShared = TopoDS::Vertex( myVertices( theSecondVertex ) );
// Bind first vertex with shared vertex of the second one
myVertices.Bind( theFirstVertex, theSecondShared );
// Add first vertex and first edge to the list
TopTools_ListOfShape& theSecondList = myLists( theSecondShared );
theSecondList.Append( theFirstVertex );
theSecondList.Append( aFirst );
}
else {
// None is bound - create new bindings
myVertices.Bind( theFirstVertex, theFirstVertex );
myVertices.Bind( theSecondVertex, theFirstVertex );
TopTools_ListOfShape theNewList;
theNewList.Append( theFirstVertex );
theNewList.Append( aFirst );
theNewList.Append( theSecondVertex );
theNewList.Append( aSecond );
myLists.Bind( theFirstVertex, theNewList );
}
}
}
//=======================================================================
//function : Add
//purpose : Adds connectivity information for the whole shape
//=======================================================================
void ShapeFix_EdgeConnect::Add (const TopoDS_Shape& aShape)
{
for ( TopExp_Explorer expw( aShape, TopAbs_WIRE ); expw.More(); expw.Next() ) {
TopoDS_Wire theWire = TopoDS::Wire(expw.Current());
TopExp_Explorer expe( theWire, TopAbs_EDGE );
if (expe.More()) {
// Obtain the first edge and remember it
TopoDS_Edge theEdge = TopoDS::Edge(expe.Current());
TopoDS_Edge theFirst = theEdge;
expe.Next();
for (; expe.More(); expe.Next()) {
// Obtain second edge and connect it
TopoDS_Edge theNext = TopoDS::Edge(expe.Current());
Add( theEdge, theNext );
theEdge = theNext;
}
// Connect first and last edges if wire is closed
if (theWire.Closed()) Add( theEdge, theFirst );
}
}
}
//=======================================================================
//function : Build
//purpose : Builds shared vertices
//=======================================================================
void ShapeFix_EdgeConnect::Build ()
{
TopTools_ListIteratorOfListOfShape theLIterator;
BRep_ListIteratorOfListOfCurveRepresentation theCIterator;
TColgp_SequenceOfXYZ thePositions;
gp_XYZ thePosition;
Standard_Real theMaxDev;
BRep_Builder theBuilder;
// Iterate on shared vertices
for ( TopTools_DataMapIteratorOfDataMapOfShapeListOfShape theSIterator( myLists );
theSIterator.More();
theSIterator.Next() ) {
TopoDS_Vertex theSharedVertex = TopoDS::Vertex( theSIterator.Key() );
const TopTools_ListOfShape& theList = theSIterator.Value();
thePositions.Clear();
// Iterate on edges, accumulating positions
for ( theLIterator.Initialize( theList );
theLIterator.More();
theLIterator.Next() ) {
TopoDS_Vertex& theVertex = TopoDS::Vertex( theLIterator.Value() );
theLIterator.Next();
TopoDS_Edge& theEdge = TopoDS::Edge( theLIterator.Value() );
// Determine usage of curve bound points
TopoDS_Vertex theStart, theEnd;
theEdge.Orientation(TopAbs_FORWARD);
TopExp::Vertices( theEdge, theStart, theEnd );
Standard_Boolean use_start = ( theVertex.IsSame( theStart ) );
Standard_Boolean use_end = ( theVertex.IsSame( theEnd ) );
// Iterate on edge curves, accumulating positions
for (theCIterator.Initialize((*((Handle(BRep_TEdge)*)&theEdge.TShape()))->ChangeCurves());
theCIterator.More(); theCIterator.Next()) {
Handle(BRep_GCurve) GC = Handle(BRep_GCurve)::DownCast(theCIterator.Value());
if ( GC.IsNull() ) continue;
// Calculate vertex position for this curve
Standard_Real theFParam, theLParam;
GC->Range( theFParam, theLParam );
gp_Pnt thePoint;
if (use_start) {
GC->D0( theFParam, thePoint );
thePositions.Append( thePoint.XYZ() );
}
if (use_end) {
GC->D0( theLParam, thePoint );
thePositions.Append( thePoint.XYZ() );
}
}
}
Standard_Integer i, theNbPos = thePositions.Length();
// Calculate vertex position
thePosition = gp_XYZ(0.,0.,0.);
#ifdef POSITION_USES_MEAN_POINT
#undef POSITION_USES_MEAN_POINT
for ( i = 1; i <= theNbPos; i++ ) thePosition += thePositions.Value(i);
if ( theNbPos > 1 ) thePosition /= theNbPos;
#else
gp_XYZ theLBound(0.,0.,0.), theRBound(0.,0.,0.);
for ( i = 1; i <= theNbPos; i++ ) {
thePosition = thePositions.Value(i);
if ( i == 1 ) theLBound = theRBound = thePosition;
Standard_Real val = thePosition.X();
if ( val < theLBound.X() ) theLBound.SetX( val );
else if ( val > theRBound.X() ) theRBound.SetX( val );
val = thePosition.Y();
if ( val < theLBound.Y() ) theLBound.SetY( val );
else if ( val > theRBound.Y() ) theRBound.SetY( val );
val = thePosition.Z();
if ( val < theLBound.Z() ) theLBound.SetZ( val );
else if ( val > theRBound.Z() ) theRBound.SetZ( val );
}
if ( theNbPos > 1 ) thePosition = (theLBound + theRBound)/2.;
#endif
// Calculate maximal deviation
theMaxDev = 0.;
for ( i = 1; i <= theNbPos; i++ ) {
Standard_Real theDeviation = (thePosition-thePositions.Value(i)).Modulus();
if ( theDeviation > theMaxDev ) theMaxDev = theDeviation;
}
theMaxDev *= 1.0001; // To avoid numerical roundings
if ( theMaxDev < Precision::Confusion() ) theMaxDev = Precision::Confusion();
// Update shared vertex
theBuilder.UpdateVertex( theSharedVertex, gp_Pnt(thePosition), theMaxDev );
// Iterate on edges, adding shared vertex
for ( theLIterator.Initialize( theList );
theLIterator.More();
theLIterator.Next() ) {
TopoDS_Vertex& theVertex = TopoDS::Vertex( theLIterator.Value() );
theLIterator.Next();
TopoDS_Edge& theEdge = TopoDS::Edge( theLIterator.Value() );
// Determine usage of old vertices
TopoDS_Vertex theStart, theEnd;
theEdge.Orientation(TopAbs_FORWARD);
TopExp::Vertices( theEdge, theStart, theEnd );
Standard_Boolean use_start = ( theVertex.IsSame( theStart ) );
Standard_Boolean use_end = ( theVertex.IsSame( theEnd ) );
// Prepare vertex to remove
TopoDS_Vertex theOldVertex;
if (use_start) theOldVertex = theStart; // start is preferred for closed edges
else theOldVertex = theEnd;
// Prepare vertex to add
TopoDS_Vertex theNewVertex;
//smh#8 Porting AIX
if (use_start) {
TopoDS_Shape tmpshapeFwd = theSharedVertex.Oriented(TopAbs_FORWARD);
theNewVertex = TopoDS::Vertex(tmpshapeFwd);
}
else {
TopoDS_Shape tmpshapeRev = theSharedVertex.Oriented(TopAbs_REVERSED);
theNewVertex = TopoDS::Vertex(tmpshapeRev);
}
if ( !theOldVertex.IsSame(theNewVertex) ) {
// Replace vertices
Standard_Boolean freeflag = theEdge.Free();
theEdge.Free(Standard_True); //smh
theBuilder.Remove( theEdge, theOldVertex );
theBuilder.Add( theEdge, theNewVertex );
if (use_start && use_end) {
// process special case for closed edge
theBuilder.Remove( theEdge, theOldVertex.Oriented(TopAbs_REVERSED) ); // remove reversed from closed edge
theBuilder.Add( theEdge, theNewVertex.Oriented(TopAbs_REVERSED) ); // add reversed to closed edge
}
theEdge.Free(freeflag);
}
}
}
// Clear maps after build
Clear();
}
//=======================================================================
//function : Clear
//purpose :
//=======================================================================
void ShapeFix_EdgeConnect::Clear ()
{
myVertices.Clear();
myLists.Clear();
}
|
