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.
26 * Do not initialize _center to save unneeded initialization time.
27 * Fix 'may be used uninitialized' warnings locally instead
29 // _center(0.0, 0.0, 0.0),
32 SGSphere(const SGVec3<T>& center, const T& radius) :
37 explicit SGSphere(const SGSphere<S>& sphere) :
38 _center(sphere.getCenter()),
39 _radius(sphere.getRadius())
42 const SGVec3<T>& getCenter() const
44 void setCenter(const SGVec3<T>& center)
47 const T& getRadius() const
49 void setRadius(const T& radius)
52 { return _radius*_radius; }
58 { return 0 <= _radius; }
63 void expandBy(const SGVec3<T>& v)
71 T dist2 = distSqr(_center, v);
72 if (dist2 <= getRadius2())
76 T newRadius = T(0.5)*(_radius + dist);
77 _center += ((newRadius - _radius)/dist)*(v - _center);
81 void expandBy(const SGSphere<T>& s)
87 _center = s.getCenter();
88 _radius = s.getRadius();
92 T dist = length(_center - s.getCenter());
93 if (dist <= SGLimits<T>::min()) {
94 _radius = SGMisc<T>::max(_radius, s._radius);
99 if (dist + s.getRadius() <= _radius)
102 // new one includes all
103 if (dist + _radius <= s.getRadius()) {
104 _center = s.getCenter();
105 _radius = s.getRadius();
109 T newRadius = T(0.5)*(_radius + dist + s.getRadius());
110 T ratio = (newRadius - _radius) / dist;
113 _center[0] += ratio*(s._center[0] - _center[0]);
114 _center[1] += ratio*(s._center[1] - _center[1]);
115 _center[2] += ratio*(s._center[2] - _center[2]);
118 void expandBy(const SGBox<T>& box)
124 _center = box.getCenter();
125 _radius = T(0.5)*length(box.getSize());
129 SGVec3<T> boxCenter = box.getCenter();
131 for (unsigned i = 0; i < 3; ++i) {
132 if (_center[i] < boxCenter[i])
133 corner[i] = box.getMax()[i];
135 corner[i] = box.getMin()[i];
145 /// Output to an ostream
146 template<typename char_type, typename traits_type, typename T>
148 std::basic_ostream<char_type, traits_type>&
149 operator<<(std::basic_ostream<char_type, traits_type>& s,
150 const SGSphere<T>& sphere)
152 return s << "center = " << sphere.getCenter()
153 << ", radius = " << sphere.getRadius();