973c2be1 |
1 | // Copyright (c) 1999-2014 OPEN CASCADE SAS |
b311480e |
2 | // |
973c2be1 |
3 | // This file is part of Open CASCADE Technology software library. |
b311480e |
4 | // |
d5f74e42 |
5 | // This library is free software; you can redistribute it and/or modify it under |
6 | // the terms of the GNU Lesser General Public License version 2.1 as published |
973c2be1 |
7 | // by the Free Software Foundation, with special exception defined in the file |
8 | // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT |
9 | // distribution for complete text of the license and disclaimer of any warranty. |
b311480e |
10 | // |
973c2be1 |
11 | // Alternatively, this file may be used under the terms of Open CASCADE |
12 | // commercial license or contractual agreement. |
b311480e |
13 | |
7fd59977 |
14 | #include <IGESConvGeom_GeomBuilder.ixx> |
15 | #include <TColStd_HArray1OfReal.hxx> |
16 | #include <TColStd_HArray2OfReal.hxx> |
17 | #include <Interface_Translates.hxx> |
18 | #include <Standard_DomainError.hxx> |
19 | #include <gp.hxx> |
20 | |
21 | |
22 | static Standard_Real epsl = 1.E-10; |
23 | static Standard_Real epsa = 1.E-10; |
24 | |
25 | IGESConvGeom_GeomBuilder::IGESConvGeom_GeomBuilder () |
26 | { Clear(); } |
27 | |
28 | |
29 | void IGESConvGeom_GeomBuilder::Clear () |
30 | { |
31 | theXYZ = new TColgp_HSequenceOfXYZ(); |
32 | theVec = new TColgp_HSequenceOfXYZ(); |
33 | gp_Trsf trid; thepos = trid; |
34 | } |
35 | |
36 | void IGESConvGeom_GeomBuilder::AddXY (const gp_XY& val) |
37 | { |
38 | gp_XYZ aval (val.X(),val.Y(),0.); |
39 | theXYZ->Append (aval); |
40 | aval.SetCoord (0.,0.,0.); |
41 | theVec->Append (aval); |
42 | } |
43 | |
44 | void IGESConvGeom_GeomBuilder::AddXYZ (const gp_XYZ& val) |
45 | { |
46 | theXYZ->Append (val); |
47 | theVec->Append (gp_XYZ(0.,0.,0.) ); |
48 | } |
49 | |
50 | void IGESConvGeom_GeomBuilder::AddVec (const gp_XYZ& val) |
51 | { |
52 | if (!theVec->IsEmpty()) theVec->SetValue (theVec->Length(), val); |
53 | } |
54 | |
55 | Standard_Integer IGESConvGeom_GeomBuilder::NbPoints () const |
56 | { return theXYZ->Length(); } |
57 | |
58 | gp_XYZ IGESConvGeom_GeomBuilder::Point (const Standard_Integer num) const |
59 | { return theXYZ->Value (num); } |
60 | |
61 | Handle(IGESGeom_CopiousData) IGESConvGeom_GeomBuilder::MakeCopiousData |
62 | (const Standard_Integer datatype, const Standard_Boolean polyline) const |
63 | { |
64 | Standard_Integer num, nb = theXYZ->Length(); |
65 | if (datatype < 1 || datatype > 3 || nb == 0 || (polyline && datatype == 3)) |
66 | Standard_DomainError::Raise ("IGESConvGeom_GeomBuilder : MakeCopiousData"); |
67 | |
68 | Standard_Integer nbd = datatype+1; // 1->2 2->3 et 3->6 |
69 | if (datatype == 3) nbd = 6; |
70 | Handle(TColStd_HArray1OfReal) data = new TColStd_HArray1OfReal (1,nb*nbd); |
71 | Standard_Real CZ = 0.; |
72 | for (num = 1; num <= nb; num ++) { |
73 | const gp_XYZ& pnt = theXYZ->Value(num); |
74 | data->SetValue ((num-1)*nbd+1 , pnt.X()); |
75 | data->SetValue ((num-1)*nbd+2 , pnt.Y()); |
76 | if (datatype > 1) data->SetValue ((num-1)*nbd+3 , pnt.Z()); |
77 | else CZ += pnt.Z(); |
78 | if (datatype < 3) continue; |
79 | const gp_XYZ& vec = theVec->Value(num); |
80 | data->SetValue ((num-1)*nbd+4 , vec.X()); |
81 | data->SetValue ((num-1)*nbd+5 , vec.Y()); |
82 | data->SetValue ((num-1)*nbd+6 , vec.Z()); |
83 | } |
84 | if (datatype == 1) CZ /= nb; |
85 | |
86 | Handle(IGESGeom_CopiousData) res = new IGESGeom_CopiousData; |
87 | res->Init (datatype,CZ,data); |
88 | res->SetPolyline (polyline); |
89 | return res; |
90 | } |
91 | |
7fd59977 |
92 | gp_Trsf IGESConvGeom_GeomBuilder::Position () const |
93 | { return thepos; } |
94 | |
95 | void IGESConvGeom_GeomBuilder::SetPosition (const gp_Trsf& pos) |
96 | { thepos = pos; } |
97 | |
98 | void IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax3& pos) |
99 | { |
100 | gp_Ax3 orig (gp::XOY()); |
101 | gp_Trsf ps; |
102 | ps.SetTransformation (pos,orig); |
103 | thepos = ps; |
104 | } |
105 | |
106 | void IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax2& pos) |
107 | { |
108 | gp_Ax3 a3(pos); |
109 | SetPosition (a3); |
110 | } |
111 | |
112 | void IGESConvGeom_GeomBuilder::SetPosition (const gp_Ax1& pos) |
113 | { |
114 | const gp_Pnt& p = pos.Location(); |
115 | const gp_Dir& d = pos.Direction(); |
116 | gp_Ax3 a3 (p,d); |
117 | SetPosition (a3); |
118 | } |
119 | |
120 | Standard_Boolean IGESConvGeom_GeomBuilder::IsIdentity () const |
121 | { |
122 | if (thepos.Form() == gp_Identity) return Standard_True; |
123 | // sinon, regarder de plus pres ... |
124 | if (!IsTranslation()) return Standard_False; |
125 | if (!thepos.TranslationPart().IsEqual (gp_XYZ(0.,0.,0.),epsl) ) |
126 | return Standard_False; |
127 | return Standard_True; |
128 | } |
129 | |
130 | Standard_Boolean IGESConvGeom_GeomBuilder::IsTranslation () const |
131 | { |
132 | if (thepos.Form() == gp_Identity || thepos.Form() == gp_Translation) |
133 | return Standard_True; |
134 | // sinon, regarder de plus pres ... |
135 | |
136 | Standard_Integer i,j; |
137 | for (i = 1; i <= 3; i ++) |
138 | for (j = 1; j <= 3; j ++) { |
139 | Standard_Real cons = (i == j ? 1. : 0.); |
140 | Standard_Real val = thepos.Value(i,j); |
141 | if (val > cons + epsa || val < cons - epsa) return Standard_False; |
142 | } |
143 | return Standard_True; |
144 | } |
145 | |
146 | Standard_Boolean IGESConvGeom_GeomBuilder::IsZOnly () const |
147 | { |
148 | if (!IsTranslation()) return Standard_False; |
149 | gp_XYZ t = thepos.TranslationPart(); t.SetZ (0.0); |
150 | if (!t.IsEqual (gp_XYZ(0.,0.,0.),epsl) ) return Standard_False; |
151 | return Standard_True; |
152 | } |
153 | |
154 | void IGESConvGeom_GeomBuilder::EvalXYZ |
155 | (const gp_XYZ& val, |
156 | Standard_Real& X, Standard_Real& Y, Standard_Real& Z) const |
157 | { |
158 | val.Coord (X,Y,Z); |
159 | thepos.Inverted().Transforms (X,Y,Z); |
160 | } |
161 | |
162 | Handle(IGESGeom_TransformationMatrix) |
163 | IGESConvGeom_GeomBuilder::MakeTransformation (const Standard_Real unit) const |
164 | { |
165 | Handle(TColStd_HArray2OfReal) data = new TColStd_HArray2OfReal (1,3,1,4); |
166 | Standard_Integer i,j; |
167 | for (i = 1; i <= 3; i ++) |
168 | for (j = 1; j <= 4; j ++) |
169 | data->SetValue (i,j, (j == 4 ? thepos.Value(i,j)/unit : thepos.Value(i,j)) ); |
170 | Handle(IGESGeom_TransformationMatrix) rs = new IGESGeom_TransformationMatrix; |
171 | rs->Init (data); |
172 | if (thepos.IsNegative()) rs->SetFormNumber(1); |
173 | return rs; |
174 | } |