a213943b8c75b5232eec49f2a9417996c66b51b9
[occt.git] / src / gp / gp_Cone.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 // LPA, JCV  07/92 passage sur C1.
16 // JCV 07/92 Introduction de la method Dump 
17
18 #include <gp_Cone.hxx>
19
20 #include <gp_Ax1.hxx>
21 #include <gp_Ax2.hxx>
22 #include <gp_Ax3.hxx>
23 #include <gp_Pnt.hxx>
24 #include <gp_Trsf.hxx>
25 #include <gp_Vec.hxx>
26 #include <Standard_ConstructionError.hxx>
27
28 void gp_Cone::Coefficients
29 (Standard_Real& A1, Standard_Real& A2, Standard_Real& A3, 
30  Standard_Real& B1, Standard_Real& B2, Standard_Real& B3,
31  Standard_Real& C1, Standard_Real& C2, Standard_Real& C3,
32  Standard_Real& D) const
33 {
34   // Dans le repere du cone :
35   // X**2 + Y**2 - (radius + Z * Tan(semiAngle))**2 = 0.0
36   gp_Trsf T;
37   T.SetTransformation (pos);
38   Standard_Real KAng = Tan (semiAngle);
39   Standard_Real T11 = T.Value (1, 1);
40   Standard_Real T12 = T.Value (1, 2);
41   Standard_Real T13 = T.Value (1, 3);
42   Standard_Real T14 = T.Value (1, 4);
43   Standard_Real T21 = T.Value (2, 1);
44   Standard_Real T22 = T.Value (2, 2);
45   Standard_Real T23 = T.Value (2, 3);
46   Standard_Real T24 = T.Value (2, 4);
47   Standard_Real T31 = T.Value (3, 1) * KAng;
48   Standard_Real T32 = T.Value (3, 2) * KAng;
49   Standard_Real T33 = T.Value (3, 3) * KAng;
50   Standard_Real T34 = T.Value (3, 4) * KAng;
51   A1 = T11 * T11 + T21 * T21 - T31 * T31;
52   A2 = T12 * T12 + T22 * T22 - T32 * T32;
53   A3 = T13 * T13 + T23 * T23 - T33 * T33;
54   B1 = T11 * T12 + T21 * T22 - T31 * T32;
55   B2 = T11 * T13 + T21 * T23 - T31 * T33;
56   B3 = T12 * T13 + T22 * T23 - T32 * T33;
57   C1 = T11 * T14 + T21 * T24 - T31 * (radius + T34);
58   C2 = T12 * T14 + T22 * T24 - T32 * (radius + T34);
59   C3 = T13 * T14 + T23 * T24 - T33 * (radius + T34);
60   D = T14*T14 + T24*T24 - radius*radius - T34*T34 - 2.0*radius*T34;  
61 }
62
63 void gp_Cone::Mirror (const gp_Pnt& P)
64 { pos.Mirror (P); }
65
66 gp_Cone gp_Cone::Mirrored (const gp_Pnt& P) const
67 {
68   gp_Cone C = *this;
69   C.pos.Mirror (P);
70   return C;
71 }
72
73 void gp_Cone::Mirror (const gp_Ax1& A1)
74 { pos.Mirror (A1); }
75
76 gp_Cone gp_Cone::Mirrored (const gp_Ax1& A1) const
77 {
78   gp_Cone C = *this;
79   C.pos.Mirror (A1);
80   return C;
81 }
82
83 void gp_Cone::Mirror (const gp_Ax2& A2)
84 { pos.Mirror (A2); }
85
86 gp_Cone gp_Cone::Mirrored (const gp_Ax2& A2) const
87 {
88   gp_Cone C = *this;
89   C.pos.Mirror (A2);
90   return C;
91 }
92