ray_3d_sphere_3d.h

Go to the documentation of this file.

/** @file
 *  @author Bram de Greve (bramz@users.sourceforge.net)
 *  @author Tom De Muer (tomdemuer@users.sourceforge.net)
 *
 *  *** BEGIN LICENSE INFORMATION ***
 *  
 *  The contents of this file are subject to the Common Public Attribution License 
 *  Version 1.0 (the "License"); you may not use this file except in compliance with 
 *  the License. You may obtain a copy of the License at 
 *  http://lass.sourceforge.net/cpal-license. The License is based on the 
 *  Mozilla Public License Version 1.1 but Sections 14 and 15 have been added to cover 
 *  use of software over a computer network and provide for limited attribution for 
 *  the Original Developer. In addition, Exhibit A has been modified to be consistent 
 *  with Exhibit B.
 *  
 *  Software distributed under the License is distributed on an "AS IS" basis, WITHOUT 
 *  WARRANTY OF ANY KIND, either express or implied. See the License for the specific 
 *  language governing rights and limitations under the License.
 *  
 *  The Original Code is LASS - Library of Assembled Shared Sources.
 *  
 *  The Initial Developer of the Original Code is Bram de Greve and Tom De Muer.
 *  The Original Developer is the Initial Developer.
 *  
 *  All portions of the code written by the Initial Developer are:
 *  Copyright (C) 2004-2007 the Initial Developer.
 *  All Rights Reserved.
 *  
 *  Contributor(s):
 *
 *  Alternatively, the contents of this file may be used under the terms of the 
 *  GNU General Public License Version 2 or later (the GPL), in which case the 
 *  provisions of GPL are applicable instead of those above.  If you wish to allow use
 *  of your version of this file only under the terms of the GPL and not to allow 
 *  others to use your version of this file under the CPAL, indicate your decision by 
 *  deleting the provisions above and replace them with the notice and other 
 *  provisions required by the GPL License. If you do not delete the provisions above,
 *  a recipient may use your version of this file under either the CPAL or the GPL.
 *  
 *  *** END LICENSE INFORMATION ***
 */

#ifndef LASS_GUARDIAN_OF_INCLUSION_PRIM_RAY_3D_SPHERE_3D_H
#define LASS_GUARDIAN_OF_INCLUSION_PRIM_RAY_3D_SPHERE_3D_H

#include "prim_common.h"
#include "ray_3d.h"
#include "sphere_3d.h"
#include "../num/basic_ops.h"
#include "../num/floating_point_consistency.h"

namespace lass
{
namespace prim
{

namespace impl
{
    /** @internal
     */
    template <class NormalizingPolicy>
    struct RaySphere
    {
        template <typename T, class PP>
        static Result intersect(
                const Sphere3D<T>& sphere, const Ray3D<T, NormalizingPolicy, PP>& ray, 
                T& t, const T& tMin)
        {
            typedef Vector3D<T> TVector;
            typedef typename TVector::TValue TValue;
            typedef typename TVector::TNumTraits TNumTraits;
            typedef num::Consistent<T> TConsistent;

            const TVector cs = ray.support() - sphere.center();

            // at² + bt + c == 0
            const TValue a = ray.direction().squaredNorm();
            const TValue b = dot(cs, ray.direction());
            const TValue c = cs.squaredNorm() - num::sqr(sphere.radius());

            const TValue discriminant = num::sqr(b) - a * c;

            if (discriminant > TNumTraits::zero)
            {
                const TValue sqrtD = num::sqrt(discriminant);
                const TValue invA = num::inv(a);
                const TConsistent t1 = (-b - sqrtD) * invA;
                if (t1 > tMin)
                {
                    t = t1.value();
                    return rOne;
                }
                const TConsistent t2 = (-b + sqrtD) * invA;
                if (t2 > tMin)
                {
                    t = t2.value();
                    return rOne;
                }
            }
            else if (discriminant == TNumTraits::zero)
            {
                const TConsistent t1 = -b / a;
                if (t1 > tMin)
                {
                    t = t1.value();
                    return rOne;
                }
            }
            return rNone;
        }
    };

    /** @internal
     */
    template <>
    struct RaySphere<Normalized>
    {
        template <typename T, class PP>
        static Result intersect(const Sphere3D<T>& sphere, 
                                const Ray3D<T, Normalized, PP>& ray, 
                                T& t, const T& tMin)
        {
            typedef Vector3D<T> TVector;
            typedef typename TVector::TValue TValue;
            typedef typename TVector::TNumTraits TNumTraits;
            typedef num::Consistent<T> TConsistent;

            typedef typename num::DoublePrecision<T>::Type TDouble;
            typedef Vector3D<TDouble> TVectorDouble;

            const TVectorDouble cs(ray.support() - sphere.center());

            // at² + bt + c == 0
            //const TValue a = 1;
            const TDouble b = dot(cs, TVectorDouble(ray.direction()));
            const TDouble c = cs.squaredNorm() - num::sqr(TDouble(sphere.radius()));

            const TDouble discriminant = num::sqr(b) - c;

            if (discriminant > TNumTraits::zero)
            {
                const TDouble sqrtD = num::sqrt(discriminant);
                const TConsistent t1 = static_cast<TValue>(-b - sqrtD);
                if (t1 > tMin)
                {
                    t = t1.value();
                    return rOne;
                }
                const TConsistent t2 = static_cast<TValue>(-b + sqrtD);
                if (t2 > tMin)
                {
                    t = t2.value();
                    return rOne;
                }
            }
            else if (discriminant == TNumTraits::zero)
            {
                const TConsistent t1 = static_cast<TValue>(-b);
                if (t1 > tMin)
                {
                    t = t1.value();
                    return rOne;
                }
            }
            return rNone;
        }
    };
}




/** Find the intersection of a ray and a sphere by their parameter t on the ray.
 *  @relates lass::prim::Ray3D
 *  @relates lass::prim:Sphere3D
 *
 *  @param sphere [in] the sphere
 *  @param ray [in] the ray
 *  @param t [out] the parameter of the intersection point > @a tMin.
 *  @param tMin [in] the minimum t that may be returned as valid intersection.
 *  @return @arg rNone      no intersections with @a t > @a tMin found
 *                          @a t is not assigned.
 *          @arg rOne       a intersection with @a t > @a tMin is found
 *                          @a t is assigned.
 *
 *  http://flipcode.dxbug.com/wiki/index.php?title=Line-Sphere_%28Collision%29
 */
template<typename T, class NP, class PP> inline
Result intersect(
        const Sphere3D<T>& sphere, const Ray3D<T, NP, PP>& ray, 
        T& t, const T& tMin = T())
{
#ifdef NDEBUG
    return impl::RaySphere<NP>::intersect(sphere, ray, t, tMin);
#else
    const Result result = impl::RaySphere<NP>::intersect(sphere, ray, t, tMin);
    LASS_ASSERT(t > tMin || result == rNone);
    return result;
#endif
}

}
}

#endif

// EOF