1 // Copyright (C) 2006 Mathias Froehlich - Mathias.Froehlich@web.de
3 // This library is free software; you can redistribute it and/or
4 // modify it under the terms of the GNU Library General Public
5 // License as published by the Free Software Foundation; either
6 // version 2 of the License, or (at your option) any later version.
8 // This library is distributed in the hope that it will be useful,
9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 // Library General Public License for more details.
13 // You should have received a copy of the GNU General Public License
14 // along with this program; if not, write to the Free Software
15 // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
27 SGSphere(const SGVec3<T>& center, const T& radius) :
32 explicit SGSphere(const SGSphere<S>& sphere) :
33 _center(sphere.getCenter()),
34 _radius(sphere.getRadius())
37 const SGVec3<T>& getCenter() const
39 void setCenter(const SGVec3<T>& center)
42 const T& getRadius() const
44 void setRadius(const T& radius)
47 { return _radius*_radius; }
53 { return 0 <= _radius; }
58 void expandBy(const SGVec3<T>& v)
66 T dist2 = distSqr(_center, v);
67 if (dist2 <= getRadius2())
71 T newRadius = T(0.5)*(_radius + dist);
72 _center += ((newRadius - _radius)/dist)*(v - _center);
76 void expandBy(const SGSphere<T>& s)
82 _center = s.getCenter();
83 _radius = s.getRadius();
87 T dist = length(_center - s.getCenter());
88 if (dist <= SGLimits<T>::min()) {
89 _radius = SGMisc<T>::max(_radius, s._radius);
94 if (dist + s.getRadius() <= _radius)
97 // new one includes all
98 if (dist + _radius <= s.getRadius()) {
99 _center = s.getCenter();
100 _radius = s.getRadius();
104 T newRadius = T(0.5)*(_radius + dist + s.getRadius());
105 T ratio = (newRadius - _radius) / dist;
108 _center[0] += ratio*(s._center[0] - _center[0]);
109 _center[1] += ratio*(s._center[1] - _center[1]);
110 _center[2] += ratio*(s._center[2] - _center[2]);
113 void expandBy(const SGBox<T>& box)
119 _center = box.getCenter();
120 _radius = T(0.5)*length(box.getSize());
124 SGVec3<T> boxCenter = box.getCenter();
126 for (unsigned i = 0; i < 3; ++i) {
127 if (_center[i] < boxCenter[i])
128 corner[i] = box.getMax()[i];
130 corner[i] = box.getMin()[i];
140 /// Output to an ostream
141 template<typename char_type, typename traits_type, typename T>
143 std::basic_ostream<char_type, traits_type>&
144 operator<<(std::basic_ostream<char_type, traits_type>& s,
145 const SGSphere<T>& sphere)
147 return s << "center = " << sphere.getCenter()
148 << ", radius = " << sphere.getRadius();