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 08/01/90 Modifs suite a l'introduction des classes XY et Mat2d dans gp 16 17 #define No_Standard_OutOfRange 18 19 #include <gp_Vec2d.hxx> 20 21 #include <gp.hxx> 22 #include <gp_Ax2d.hxx> 23 #include <gp_Dir2d.hxx> 24 #include <gp_Pnt2d.hxx> 25 #include <gp_Trsf2d.hxx> 26 #include <gp_VectorWithNullMagnitude.hxx> 27 #include <gp_XY.hxx> 28 #include <Standard_ConstructionError.hxx> 29 #include <Standard_OutOfRange.hxx> 30 IsEqual(const gp_Vec2d & Other,const Standard_Real LinearTolerance,const Standard_Real AngularTolerance) const31Standard_Boolean gp_Vec2d::IsEqual 32 (const gp_Vec2d& Other, 33 const Standard_Real LinearTolerance, 34 const Standard_Real AngularTolerance) const 35 { 36 const Standard_Real theNorm = Magnitude(); 37 const Standard_Real theOtherNorm = Other.Magnitude(); 38 Standard_Real val = theNorm - theOtherNorm; 39 if (val < 0.0) val = -val; 40 // Check for equal lengths 41 const Standard_Boolean isEqualLength = (val <= LinearTolerance); 42 // Check for small vectors 43 if (theNorm > LinearTolerance && theOtherNorm > LinearTolerance) 44 { 45 Standard_Real Ang = Angle(Other); 46 if (Ang < 0.0) Ang = -Ang; 47 // Check for zero angle 48 return isEqualLength && (Ang <= AngularTolerance); 49 } 50 return isEqualLength; 51 } 52 Angle(const gp_Vec2d & Other) const53Standard_Real gp_Vec2d::Angle (const gp_Vec2d& Other) const 54 { 55 // Commentaires : 56 // Au dessus de 45 degres l'arccos donne la meilleur precision pour le 57 // calcul de l'angle. Sinon il vaut mieux utiliser l'arcsin. 58 // Les erreurs commises sont loin d'etre negligeables lorsque l'on est 59 // proche de zero ou de 90 degres. 60 // En 2D les valeurs angulaires sont comprises entre -PI et PI 61 const Standard_Real theNorm = Magnitude(); 62 const Standard_Real theOtherNorm = Other.Magnitude(); 63 if (theNorm <= gp::Resolution() || theOtherNorm <= gp::Resolution()) 64 throw gp_VectorWithNullMagnitude(); 65 66 const Standard_Real D = theNorm * theOtherNorm; 67 const Standard_Real Cosinus = coord.Dot (Other.coord) / D; 68 const Standard_Real Sinus = coord.Crossed (Other.coord) / D; 69 if (Cosinus > -0.70710678118655 && Cosinus < 0.70710678118655) 70 { 71 if (Sinus > 0.0) return acos (Cosinus); 72 else return -acos (Cosinus); 73 } 74 else 75 { 76 if (Cosinus > 0.0) return asin (Sinus); 77 else 78 { 79 if (Sinus > 0.0) return M_PI - asin (Sinus); 80 else return - M_PI - asin (Sinus); 81 } 82 } 83 } 84 Mirror(const gp_Ax2d & A1)85void gp_Vec2d::Mirror (const gp_Ax2d& A1) 86 { 87 const gp_XY& XY = A1.Direction().XY(); 88 Standard_Real X = coord.X(); 89 Standard_Real Y = coord.Y(); 90 Standard_Real A = XY.X(); 91 Standard_Real B = XY.Y(); 92 Standard_Real M1 = 2.0 * A * B; 93 coord.SetX(((2.0 * A * A) - 1.) * X + M1 * Y); 94 coord.SetY(M1 * X + ((2. * B * B) - 1.0) * Y); 95 } 96 Mirrored(const gp_Ax2d & A1) const97gp_Vec2d gp_Vec2d::Mirrored (const gp_Ax2d& A1) const 98 { 99 gp_Vec2d Vres = *this; 100 Vres.Mirror(A1); 101 return Vres; 102 } 103 Transform(const gp_Trsf2d & T)104void gp_Vec2d::Transform (const gp_Trsf2d& T) 105 { 106 if (T.Form() == gp_Identity || T.Form() == gp_Translation) { } 107 else if (T.Form() == gp_PntMirror) coord.Reverse (); 108 else if (T.Form() == gp_Scale) coord.Multiply (T.ScaleFactor ()); 109 else coord.Multiply (T.VectorialPart ()); 110 } 111 Mirror(const gp_Vec2d & V)112void gp_Vec2d::Mirror (const gp_Vec2d& V) 113 { 114 const Standard_Real D = V.coord.Modulus(); 115 if (D > gp::Resolution()) 116 { 117 const gp_XY& XY = V.coord; 118 Standard_Real X = XY.X(); 119 Standard_Real Y = XY.Y(); 120 Standard_Real A = X / D; 121 Standard_Real B = Y / D; 122 Standard_Real M1 = 2.0 * A * B; 123 coord.SetX(((2.0 * A * A) - 1.0) * X + M1 * Y); 124 coord.SetY(M1 * X + ((2.0 * B * B) - 1.0) * Y); 125 } 126 } 127 Mirrored(const gp_Vec2d & V) const128gp_Vec2d gp_Vec2d::Mirrored (const gp_Vec2d& V) const 129 { 130 gp_Vec2d Vres = *this; 131 Vres.Mirror(V); 132 return Vres; 133 } 134