Reverted incorrect merge (missing files)
[blender.git] / extern / solid / src / convex / DT_Cone.cpp
1 /*
2  * SOLID - Software Library for Interference Detection
3  * 
4  * Copyright (C) 2001-2003  Dtecta.  All rights reserved.
5  *
6  * This library may be distributed under the terms of the Q Public License
7  * (QPL) as defined by Trolltech AS of Norway and appearing in the file
8  * LICENSE.QPL included in the packaging of this file.
9  *
10  * This library may be distributed and/or modified under the terms of the
11  * GNU General Public License (GPL) version 2 as published by the Free Software
12  * Foundation and appearing in the file LICENSE.GPL included in the
13  * packaging of this file.
14  *
15  * This library is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
16  * WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
17  *
18  * Commercial use or any other use of this library not covered by either 
19  * the QPL or the GPL requires an additional license from Dtecta. 
20  * Please contact info@dtecta.com for enquiries about the terms of commercial
21  * use of this library.
22  */
23
24 #include "DT_Cone.h"
25
26 MT_Point3 DT_Cone::support(const MT_Vector3& v) const 
27 {
28     MT_Scalar v_len = v.length();
29
30     if (v[1] > v_len * sinAngle)
31         {
32                 return MT_Point3(MT_Scalar(0.0), halfHeight, MT_Scalar(0.0));
33         }
34     else
35         {
36         MT_Scalar s = MT_sqrt(v[0] * v[0] + v[2] * v[2]);
37         if (s != MT_Scalar(0.0))
38                 {
39             MT_Scalar d = bottomRadius / s;  
40             return MT_Point3(v[0] * d, -halfHeight, v[2] * d);
41         }
42         else
43                 {
44                         return MT_Point3(bottomRadius, -halfHeight, MT_Scalar(0.0));
45                 }
46     }
47 }
48