b77e7a17809b2aed2e8b8ede889de07ec0815a82
[occt.git] / src / gp / gp_Vec.cxx
1 // Copyright (c) 1995-1999 Matra Datavision
2 // Copyright (c) 1999-2014 OPEN CASCADE SAS
3 //
4 // This file is part of Open CASCADE Technology software library.
5 //
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
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.
11 //
12 // Alternatively, this file may be used under the terms of Open CASCADE
13 // commercial license or contractual agreement.
14
15 // JCV 30/08/90 Modif passage version C++ 2.0 sur Sun
16 // JCV 1/10/90 Changement de nom du package vgeom -> gp
17 // JCV 07/12/90 Modifs suite a l'introduction des classes XYZ et Mat dans gp
18
19 #define No_Standard_OutOfRange
20
21 #include <gp_Vec.hxx>
22
23 #include <gp.hxx>
24 #include <gp_Ax1.hxx>
25 #include <gp_Ax2.hxx>
26 #include <gp_Dir.hxx>
27 #include <gp_Pnt.hxx>
28 #include <gp_Trsf.hxx>
29 #include <gp_VectorWithNullMagnitude.hxx>
30 #include <gp_XYZ.hxx>
31 #include <Standard_ConstructionError.hxx>
32 #include <Standard_DomainError.hxx>
33 #include <Standard_Dump.hxx>
34 #include <Standard_OutOfRange.hxx>
35
36 Standard_Boolean gp_Vec::IsEqual
37 (const gp_Vec& Other, 
38  const Standard_Real LinearTolerance,
39  const Standard_Real AngularTolerance) const
40 {
41   if (Magnitude ()       <= LinearTolerance || 
42       Other.Magnitude () <= LinearTolerance) {
43     Standard_Real val = Magnitude() - Other.Magnitude();
44     if (val < 0) val = - val;
45     return val <= LinearTolerance;
46   }
47   else {
48     Standard_Real val = Magnitude() - Other.Magnitude();
49     if (val < 0) val = - val;
50     return val <= LinearTolerance && Angle(Other) <= AngularTolerance;
51   }
52 }    
53
54 void gp_Vec::Mirror (const gp_Vec& V)
55 {
56   Standard_Real D = V.coord.Modulus();
57   if (D > gp::Resolution()) {
58     const gp_XYZ& XYZ = V.coord;
59     Standard_Real A = XYZ.X() / D;
60     Standard_Real B = XYZ.Y() / D;
61     Standard_Real C = XYZ.Z() / D; 
62     Standard_Real M1 = 2.0 * A * B;
63     Standard_Real M2 = 2.0 * A * C;
64     Standard_Real M3 = 2.0 * B * C;
65     Standard_Real X = coord.X();
66     Standard_Real Y = coord.Y();
67     Standard_Real Z = coord.Z();
68     coord.SetX(((2.0 * A * A) - 1.0) * X + M1 * Y + M2 * Z);
69     coord.SetY(M1 * X + ((2.0 * B * B) - 1.0) * Y + M3 * Z);
70     coord.SetZ(M2 * X + M3 * Y + ((2.0 * C * C) - 1.0) * Z);
71   }
72 }
73
74 void gp_Vec::Mirror (const gp_Ax1& A1)
75 {
76   const gp_XYZ& V = A1.Direction().XYZ();
77   Standard_Real A = V.X();
78   Standard_Real B = V.Y();
79   Standard_Real C = V.Z();
80   Standard_Real X = coord.X();
81   Standard_Real Y = coord.Y();
82   Standard_Real Z = coord.Z();
83   Standard_Real M1 = 2.0 * A * B;
84   Standard_Real M2 = 2.0 * A * C;
85   Standard_Real M3 = 2.0 * B * C;
86   coord.SetX(((2.0 * A * A) - 1.0) * X + M1 * Y + M2 * Z);
87   coord.SetY(M1 * X + ((2.0 * B * B) - 1.0) * Y + M3 * Z);
88   coord.SetZ(M2 * X + M3 * Y + ((2.0 * C * C) - 1.0) * Z);
89 }
90
91 void gp_Vec::Mirror (const gp_Ax2& A2)
92 {
93   gp_XYZ Z      = A2.Direction().XYZ();
94   gp_XYZ MirXYZ = Z.Crossed (coord);
95   if (MirXYZ.Modulus() <= gp::Resolution()) { coord.Reverse(); }
96   else {
97     Z.Cross (MirXYZ);
98     Mirror (Z);
99   }
100 }
101
102 void gp_Vec::Transform(const gp_Trsf& T)
103 {
104   if (T.Form() == gp_Identity || T.Form() == gp_Translation) { }
105   else if (T.Form() == gp_PntMirror) { coord.Reverse(); }
106   else if (T.Form() == gp_Scale) { coord.Multiply (T.ScaleFactor()); }
107   else { coord.Multiply (T.VectorialPart()); }
108 }
109
110 gp_Vec gp_Vec::Mirrored (const gp_Vec& V) const
111 {
112   gp_Vec Vres = *this;
113   Vres.Mirror (V);
114   return Vres;                     
115 }
116
117 gp_Vec gp_Vec::Mirrored (const gp_Ax1& A1) const
118 {
119   gp_Vec Vres = *this;
120   Vres.Mirror (A1);
121   return Vres;                     
122 }
123
124 gp_Vec gp_Vec::Mirrored (const gp_Ax2& A2) const
125 {
126   gp_Vec Vres = *this;
127   Vres.Mirror (A2);
128   return Vres;                     
129 }
130
131 // =======================================================================
132 // function : DumpJson
133 // purpose  :
134 // =======================================================================
135 void gp_Vec::DumpJson (Standard_OStream& theOStream, Standard_Integer) const
136 {
137   OCCT_DUMP_VECTOR_CLASS (theOStream, "gp_Vec", 3, coord.X(), coord.Y(), coord.Z())
138 }