summaryrefslogtreecommitdiff
path: root/src/ShapeBuild/ShapeBuild_Vertex.cxx
blob: ffc4d71d8771164c50824224b3943fb856b9dfd5 (plain)
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
//    rln 22.03.99: syntax correction in CombineVertex
//szv#4 S4163
#include <ShapeBuild_Vertex.ixx>
#include <BRep_Tool.hxx>
#include <Precision.hxx>
#include <BRep_Builder.hxx>

//=======================================================================
//function : CombineVertex
//purpose  : 
//=======================================================================

TopoDS_Vertex ShapeBuild_Vertex::CombineVertex (const TopoDS_Vertex& V1,
						const TopoDS_Vertex& V2,
						const Standard_Real tolFactor) const
{
  return CombineVertex ( BRep_Tool::Pnt ( V1 ), BRep_Tool::Pnt ( V2 ), 
			 BRep_Tool::Tolerance ( V1 ), BRep_Tool::Tolerance ( V2 ), 
			 tolFactor );
}

//=======================================================================
//function : CombineVertex
//purpose  : 
//=======================================================================

TopoDS_Vertex ShapeBuild_Vertex::CombineVertex (const gp_Pnt& pnt1, 
						const gp_Pnt& pnt2,
						const Standard_Real tol1, 
						const Standard_Real tol2,
						const Standard_Real tolFactor) const
{
  gp_Pnt pos;
  Standard_Real tol;
  
  gp_Vec v = pnt2.XYZ() - pnt1.XYZ();
  Standard_Real dist = v.Magnitude();

  //#47 rln 09.12.98 S4054 PRO14323 entity 2844
  if ( dist + tol2 <= tol1 ) {
    pos = pnt1;
    tol = tol1;
  }
  else if ( dist + tol1 <= tol2 ) {
    pos = pnt2;
    tol = tol2;
  }
  else {
    tol = 0.5 * ( dist + tol1 + tol2 );
    Standard_Real s = ( dist > 0. )? ( tol2 - tol1 ) / dist : 0.; //szv#4:S4163:12Mar99 anti-exception
    pos = 0.5 * ( ( 1 - s ) * pnt1.XYZ() + ( 1 + s ) * pnt2.XYZ() );
  }
  
  TopoDS_Vertex V;
  BRep_Builder B;
  B.MakeVertex ( V, pos, tolFactor * tol );
  return V;
}