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
|
// File: Bisector_FunctionH.cxx
// Created: Tue Apr 5 14:33:16 1994
// Author: Yves FRICAUD
// <yfr@phylox>
#include <Bisector_FunctionH.ixx>
#include <Geom2d_Curve.hxx>
//=============================================================================
//function :
// purpose :
//=============================================================================
Bisector_FunctionH::Bisector_FunctionH (const Handle(Geom2d_Curve)& C2,
const gp_Pnt2d& P1,
const gp_Vec2d& T1)
:p1(P1),t1(T1)
{
t1.Normalize();
curve2 = C2;
}
//=============================================================================
//function : Value
// purpose :
// F = P1P2.(||T2||T1 + T2)
//=============================================================================
Standard_Boolean Bisector_FunctionH::Value (const Standard_Real X,
Standard_Real& F)
{
gp_Pnt2d P2 ; // point sur C2.
gp_Vec2d T2 ; // tangente a C2 en V.
curve2->D1(X,P2,T2);
Standard_Real NormT2 = T2.Magnitude();
Standard_Real Ax = NormT2*t1.X() - T2.X();
Standard_Real Ay = NormT2*t1.Y() - T2.Y();
F = (p1.X() - P2.X())*Ax + (p1.Y() - P2.Y())*Ay;
return Standard_True;
}
//=============================================================================
//function : Derivative
// purpose :
//=============================================================================
Standard_Boolean Bisector_FunctionH::Derivative(const Standard_Real X,
Standard_Real& D)
{
Standard_Real F;
return Values (X,F,D);
}
//=============================================================================
//function : Values
// purpose :
//=============================================================================
Standard_Boolean Bisector_FunctionH::Values (const Standard_Real X,
Standard_Real& F,
Standard_Real& D)
{
gp_Pnt2d P2 ; // point sur C2.
gp_Vec2d T2 ; // tangente a C2 en V.
gp_Vec2d T2v ; // derivee seconde a C2 en V.
curve2->D2(X,P2,T2,T2v);
Standard_Real NormT2 = T2.Magnitude();
Standard_Real Ax = NormT2*t1.X() - T2.X();
Standard_Real Ay = NormT2*t1.Y() - T2.Y();
F = (p1.X() - P2.X())*Ax + (p1.Y() - P2.Y())*Ay;
Standard_Real Scal = T2.Dot(T2v)/NormT2;
Standard_Real dAx = Scal*t1.X() - T2v.X();
Standard_Real dAy = Scal*t1.Y() - T2v.Y();
D = - T2.X()*Ax - T2.Y()*Ay + (p1.X() - P2.X())*dAx + (p1.Y() - P2.Y())*dAy;
return Standard_True;
}
|
