b311480e |
1 | // Copyright (c) 1995-1999 Matra Datavision |
973c2be1 |
2 | // Copyright (c) 1999-2014 OPEN CASCADE SAS |
b311480e |
3 | // |
973c2be1 |
4 | // This file is part of Open CASCADE Technology software library. |
b311480e |
5 | // |
d5f74e42 |
6 | // This library is free software; you can redistribute it and/or modify it under |
7 | // the terms of the GNU Lesser General Public License version 2.1 as published |
973c2be1 |
8 | // by the Free Software Foundation, with special exception defined in the file |
9 | // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT |
10 | // distribution for complete text of the license and disclaimer of any warranty. |
b311480e |
11 | // |
973c2be1 |
12 | // Alternatively, this file may be used under the terms of Open CASCADE |
13 | // commercial license or contractual agreement. |
b311480e |
14 | |
7fd59977 |
15 | // Modif JCV 08/01/91 modifs suite a la deuxieme revue de projet |
16 | // et introduction des classes XY, Mat2d + nouveau operateurs |
17 | |
18 | #include <gp_Dir2d.hxx> |
19 | #include <gp_Trsf2d.hxx> |
20 | #include <gp_Pnt2d.hxx> |
21 | |
22 | inline gp_Vec2d::gp_Vec2d() |
23 | {} |
24 | |
25 | inline gp_Vec2d::gp_Vec2d (const gp_Dir2d& V) |
26 | { coord = V.XY(); } |
27 | |
28 | inline gp_Vec2d::gp_Vec2d (const gp_XY& Coord) : coord(Coord) |
29 | {} |
30 | |
31 | inline gp_Vec2d::gp_Vec2d (const Standard_Real Xv, |
32 | const Standard_Real Yv) : coord (Xv, Yv) |
33 | { } |
34 | |
35 | inline gp_Vec2d::gp_Vec2d (const gp_Pnt2d& P1, |
36 | const gp_Pnt2d& P2) |
37 | { coord = P2.XY().Subtracted (P1.XY()); } |
38 | |
39 | inline void gp_Vec2d::SetCoord (const Standard_Integer Index, |
40 | const Standard_Real Xi) |
41 | { coord.SetCoord (Index, Xi); } |
42 | |
43 | inline void gp_Vec2d::SetCoord (const Standard_Real Xv, |
44 | const Standard_Real Yv) |
45 | { coord.SetCoord (Xv, Yv); } |
46 | |
47 | inline void gp_Vec2d::SetX (const Standard_Real X) |
48 | { coord.SetX (X); } |
49 | |
50 | inline void gp_Vec2d::SetY (const Standard_Real Y) |
51 | { coord.SetY (Y); } |
52 | |
53 | inline void gp_Vec2d::SetXY (const gp_XY& Coord) |
54 | { coord = Coord; } |
55 | |
56 | inline Standard_Real gp_Vec2d::Coord (const Standard_Integer Index) const |
57 | { return coord.Coord(Index); } |
58 | |
59 | inline void gp_Vec2d::Coord(Standard_Real& Xv, |
60 | Standard_Real& Yv) const |
61 | { coord.Coord(Xv, Yv); } |
62 | |
63 | inline Standard_Real gp_Vec2d::X() const |
64 | { return coord.X(); } |
65 | |
66 | inline Standard_Real gp_Vec2d::Y() const |
67 | { return coord.Y(); } |
68 | |
69 | inline const gp_XY& gp_Vec2d::XY () const |
70 | { return coord; } |
71 | |
72 | inline Standard_Boolean gp_Vec2d::IsNormal |
d0fcf95a |
73 | (const gp_Vec2d& theOther, |
74 | const Standard_Real theAngularTolerance) const |
7fd59977 |
75 | { |
d0fcf95a |
76 | const Standard_Real anAng = Abs(M_PI_2 - Abs(Angle(theOther))); |
77 | return !(anAng > theAngularTolerance); |
7fd59977 |
78 | } |
79 | |
80 | inline Standard_Boolean gp_Vec2d::IsOpposite |
81 | (const gp_Vec2d& Other, |
82 | const Standard_Real AngularTolerance) const |
83 | { |
84 | Standard_Real Ang = Angle(Other); |
85 | if (Ang < 0) Ang = - Ang; |
c6541a0c |
86 | return M_PI - Ang <= AngularTolerance; |
7fd59977 |
87 | } |
88 | |
89 | inline Standard_Boolean gp_Vec2d::IsParallel |
90 | (const gp_Vec2d& Other, |
91 | const Standard_Real AngularTolerance) const |
92 | { |
93 | Standard_Real Ang = Angle(Other); |
94 | if (Ang < 0) Ang = - Ang; |
c6541a0c |
95 | return Ang <= AngularTolerance || M_PI - Ang <= AngularTolerance; |
7fd59977 |
96 | } |
97 | |
98 | inline Standard_Real gp_Vec2d::Magnitude() const |
99 | { return coord.Modulus(); } |
100 | |
101 | inline Standard_Real gp_Vec2d::SquareMagnitude() const |
102 | { return coord.SquareModulus(); } |
103 | |
104 | inline void gp_Vec2d::Add (const gp_Vec2d& Other) |
105 | { coord.Add (Other.coord); } |
106 | |
107 | inline gp_Vec2d gp_Vec2d::Added (const gp_Vec2d& Other) const |
108 | { |
109 | gp_Vec2d V = *this; |
110 | V.coord.Add (Other.coord); |
111 | return V; |
112 | } |
113 | |
114 | inline Standard_Real gp_Vec2d::Crossed (const gp_Vec2d& Right) const |
115 | { return coord.Crossed (Right.coord); } |
116 | |
117 | inline Standard_Real gp_Vec2d::CrossMagnitude (const gp_Vec2d& Right) const |
118 | { return coord.CrossMagnitude (Right.coord); } |
119 | |
120 | inline Standard_Real gp_Vec2d::CrossSquareMagnitude |
121 | (const gp_Vec2d& Right) const |
122 | { return coord.CrossSquareMagnitude (Right.coord); } |
123 | |
124 | inline void gp_Vec2d::Divide (const Standard_Real Scalar) |
125 | { coord.Divide (Scalar); } |
126 | |
127 | inline gp_Vec2d gp_Vec2d::Divided (const Standard_Real Scalar) const |
128 | { |
129 | gp_Vec2d V = *this; |
130 | V.coord.Divide(Scalar); |
131 | return V; |
132 | } |
133 | |
134 | inline Standard_Real gp_Vec2d::Dot (const gp_Vec2d& Other) const |
135 | { return coord.Dot (Other.coord); } |
136 | |
137 | inline void gp_Vec2d::Multiply (const Standard_Real Scalar) |
138 | { coord.Multiply (Scalar); } |
139 | |
140 | inline gp_Vec2d gp_Vec2d::Multiplied (const Standard_Real Scalar) const |
141 | { |
142 | gp_Vec2d V = *this; |
143 | V.coord.Multiply(Scalar); |
144 | return V; |
145 | } |
146 | |
147 | inline void gp_Vec2d::Normalize() |
148 | { |
149 | Standard_Real D = coord.Modulus(); |
150 | Standard_ConstructionError_Raise_if (D <= gp::Resolution(), ""); |
151 | coord.Divide (D); |
152 | } |
153 | |
154 | inline gp_Vec2d gp_Vec2d::Normalized() const |
155 | { |
156 | Standard_Real D = coord.Modulus(); |
157 | Standard_ConstructionError_Raise_if (D <= gp::Resolution(), ""); |
158 | gp_Vec2d V = *this; |
159 | V.coord.Divide (D); |
160 | return V; |
161 | } |
162 | |
163 | inline void gp_Vec2d::Reverse() |
164 | { coord.Reverse(); } |
165 | |
166 | inline gp_Vec2d gp_Vec2d::Reversed() const |
167 | { |
168 | gp_Vec2d V = *this; |
169 | V.coord.Reverse(); |
170 | return V; |
171 | } |
172 | |
173 | inline void gp_Vec2d::Subtract (const gp_Vec2d& Right) |
174 | { coord.Subtract (Right.coord); } |
175 | |
176 | inline gp_Vec2d gp_Vec2d::Subtracted (const gp_Vec2d& Right) const |
177 | { |
178 | gp_Vec2d V = *this; |
179 | V.coord.Subtract (Right.coord); |
180 | return V; |
181 | } |
182 | |
183 | inline void gp_Vec2d::SetLinearForm (const Standard_Real L, |
184 | const gp_Vec2d& Left, |
185 | const Standard_Real R, |
186 | const gp_Vec2d& Right) |
187 | { coord.SetLinearForm (L, Left.coord, R, Right.coord); } |
188 | |
189 | inline void gp_Vec2d::SetLinearForm (const Standard_Real L, |
190 | const gp_Vec2d& Left, |
191 | const gp_Vec2d& Right) |
192 | { coord.SetLinearForm (L, Left.coord, Right.coord); } |
193 | |
194 | inline void gp_Vec2d::SetLinearForm (const gp_Vec2d& Left, |
195 | const gp_Vec2d& Right) |
196 | { coord.SetLinearForm (Left.coord, Right.coord); } |
197 | |
198 | inline void gp_Vec2d::SetLinearForm (const Standard_Real A1, |
199 | const gp_Vec2d& V1, |
200 | const Standard_Real A2, |
201 | const gp_Vec2d& V2, |
202 | const gp_Vec2d& V3) |
203 | { coord.SetLinearForm (A1, V1.coord, A2, V2.coord, V3.coord); } |
204 | |
205 | inline void gp_Vec2d::Rotate (const Standard_Real Ang) |
206 | { |
207 | gp_Trsf2d T; |
208 | T.SetRotation (gp_Pnt2d (0.0, 0.0), Ang); |
209 | coord.Multiply (T.VectorialPart ()); |
210 | } |
211 | |
212 | inline gp_Vec2d gp_Vec2d::Rotated (const Standard_Real Ang) const |
213 | { |
214 | gp_Vec2d V = *this; |
215 | V.Rotate (Ang); |
216 | return V; |
217 | } |
218 | |
219 | inline void gp_Vec2d::Scale (const Standard_Real S) |
220 | { coord.Multiply (S); } |
221 | |
222 | inline gp_Vec2d gp_Vec2d::Scaled (const Standard_Real S) const |
223 | { |
224 | gp_Vec2d V = *this; |
225 | V.coord.Multiply (S); |
226 | return V; |
227 | } |
228 | |
229 | inline gp_Vec2d gp_Vec2d::Transformed (const gp_Trsf2d& T) const |
230 | { |
231 | gp_Vec2d V = *this; |
232 | V.Transform(T); |
233 | return V; |
234 | } |
235 | |
236 | inline gp_Vec2d operator* (const Standard_Real Scalar, |
237 | const gp_Vec2d& V) |
238 | { return V.Multiplied(Scalar); } |
239 | |
32ca7a51 |
240 | inline gp_Vec2d gp_Vec2d::GetNormal() const |
d0fcf95a |
241 | { |
32ca7a51 |
242 | return gp_Vec2d(this->Y(), (-1)*this->X()); |
d0fcf95a |
243 | } |
32ca7a51 |
244 | |