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: Draft.cxx
// Created: Mon Feb 20 17:29:07 1995
// Author: Jacques GOUSSARD
// <jag@topsn2>
#include <Draft.ixx>
#include <Geom_Surface.hxx>
#include <Geom_RectangularTrimmedSurface.hxx>
#include <Geom_CylindricalSurface.hxx>
#include <Geom_ConicalSurface.hxx>
#include <Geom_Plane.hxx>
#include <BRep_Tool.hxx>
#include <BRepTools.hxx>
#include <ElSLib.hxx>
#include <Precision.hxx>
#include <Standard_DomainError.hxx>
//=======================================================================
//function : Angle
//purpose :
//=======================================================================
Standard_Real Draft::Angle(const TopoDS_Face& F,
const gp_Dir& D)
{
TopLoc_Location Lo;
Handle(Geom_Surface) S = BRep_Tool::Surface(F,Lo);
Handle(Standard_Type) TypeS = S->DynamicType();
if (TypeS == STANDARD_TYPE(Geom_RectangularTrimmedSurface)) {
S = Handle(Geom_RectangularTrimmedSurface)::DownCast(S)->BasisSurface();
TypeS = S->DynamicType();
}
if (TypeS != STANDARD_TYPE(Geom_Plane) &&
TypeS != STANDARD_TYPE(Geom_ConicalSurface) &&
TypeS != STANDARD_TYPE(Geom_CylindricalSurface)) {
Standard_DomainError::Raise();
}
Standard_Real Angle;
S = Handle(Geom_Surface)::DownCast(S->Transformed(Lo.Transformation()));
if (TypeS == STANDARD_TYPE(Geom_Plane)) {
gp_Ax3 ax3(Handle(Geom_Plane)::DownCast(S)->Pln().Position());
gp_Vec normale(ax3.Direction());
if (!ax3.Direct()) {
normale.Reverse();
}
if (F.Orientation() == TopAbs_REVERSED) {
normale.Reverse();
}
Angle = ASin(normale.Dot(D));
}
else if (TypeS == STANDARD_TYPE(Geom_CylindricalSurface)) {
gp_Cylinder Cy(Handle(Geom_CylindricalSurface)::DownCast(S)->Cylinder());
Standard_Real testdir = D.Dot(Cy.Axis().Direction());
if (Abs(testdir) <= 1.-Precision::Angular()) {
Standard_DomainError::Raise();
}
Angle = 0.;
}
else { // STANDARD_TYPE(Geom_ConicalSurface)
gp_Cone Co(Handle(Geom_ConicalSurface)::DownCast(S)->Cone());
Standard_Real testdir = D.Dot(Co.Axis().Direction());
if (Abs(testdir) <= 1.-Precision::Angular()) {
Standard_DomainError::Raise();
}
Standard_Real umin,umax,vmin,vmax;
BRepTools::UVBounds(F,umin,umax,vmin,vmax);
gp_Pnt ptbid;
gp_Vec d1u,d1v;
ElSLib::D1(umin+umax/2.,vmin+vmax/2.,Co,ptbid,d1u,d1v);
d1u.Cross(d1v);
d1u.Normalize();
if (F.Orientation() == TopAbs_REVERSED) {
d1u.Reverse();
}
Angle = ASin(d1u.Dot(D));
}
return Angle;
}
|
