|
Packit |
8dc392 |
///////////////////////////////////////////////////////////////////////////
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
// Copyright (c) 2002-2012, Industrial Light & Magic, a division of Lucas
|
|
Packit |
8dc392 |
// Digital Ltd. LLC
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
// All rights reserved.
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
// Redistribution and use in source and binary forms, with or without
|
|
Packit |
8dc392 |
// modification, are permitted provided that the following conditions are
|
|
Packit |
8dc392 |
// met:
|
|
Packit |
8dc392 |
// * Redistributions of source code must retain the above copyright
|
|
Packit |
8dc392 |
// notice, this list of conditions and the following disclaimer.
|
|
Packit |
8dc392 |
// * Redistributions in binary form must reproduce the above
|
|
Packit |
8dc392 |
// copyright notice, this list of conditions and the following disclaimer
|
|
Packit |
8dc392 |
// in the documentation and/or other materials provided with the
|
|
Packit |
8dc392 |
// distribution.
|
|
Packit |
8dc392 |
// * Neither the name of Industrial Light & Magic nor the names of
|
|
Packit |
8dc392 |
// its contributors may be used to endorse or promote products derived
|
|
Packit |
8dc392 |
// from this software without specific prior written permission.
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
Packit |
8dc392 |
// "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
Packit |
8dc392 |
// LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
|
Packit |
8dc392 |
// A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
Packit |
8dc392 |
// OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
|
Packit |
8dc392 |
// SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
Packit |
8dc392 |
// LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
Packit |
8dc392 |
// DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
Packit |
8dc392 |
// THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
Packit |
8dc392 |
// (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
|
Packit |
8dc392 |
// OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
///////////////////////////////////////////////////////////////////////////
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
#ifndef INCLUDED_IMATHPLANE_H
|
|
Packit |
8dc392 |
#define INCLUDED_IMATHPLANE_H
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
//----------------------------------------------------------------------
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
// template class Plane3
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
// The Imath::Plane3<> class represents a half space, so the
|
|
Packit |
8dc392 |
// normal may point either towards or away from origin. The
|
|
Packit |
8dc392 |
// plane P can be represented by Imath::Plane3 as either p or -p
|
|
Packit |
8dc392 |
// corresponding to the two half-spaces on either side of the
|
|
Packit |
8dc392 |
// plane. Any function which computes a distance will return
|
|
Packit |
8dc392 |
// either negative or positive values for the distance indicating
|
|
Packit |
8dc392 |
// which half-space the point is in. Note that reflection, and
|
|
Packit |
8dc392 |
// intersection functions will operate as expected.
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
//----------------------------------------------------------------------
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
#include "ImathVec.h"
|
|
Packit |
8dc392 |
#include "ImathLine.h"
|
|
Packit |
8dc392 |
#include "ImathNamespace.h"
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
IMATH_INTERNAL_NAMESPACE_HEADER_ENTER
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
class Plane3
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
public:
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
Vec3<T> normal;
|
|
Packit |
8dc392 |
T distance;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
Plane3() {}
|
|
Packit |
8dc392 |
Plane3(const Vec3<T> &normal, T distance);
|
|
Packit |
8dc392 |
Plane3(const Vec3<T> &point, const Vec3<T> &normal);
|
|
Packit |
8dc392 |
Plane3(const Vec3<T> &point1,
|
|
Packit |
8dc392 |
const Vec3<T> &point2,
|
|
Packit |
8dc392 |
const Vec3<T> &point3;;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
//----------------------
|
|
Packit |
8dc392 |
// Various set methods
|
|
Packit |
8dc392 |
//----------------------
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
void set(const Vec3<T> &normal,
|
|
Packit |
8dc392 |
T distance);
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
void set(const Vec3<T> &point,
|
|
Packit |
8dc392 |
const Vec3<T> &normal);
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
void set(const Vec3<T> &point1,
|
|
Packit |
8dc392 |
const Vec3<T> &point2,
|
|
Packit |
8dc392 |
const Vec3<T> &point3 );
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
//----------------------
|
|
Packit |
8dc392 |
// Utilities
|
|
Packit |
8dc392 |
//----------------------
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
bool intersect(const Line3<T> &line,
|
|
Packit |
8dc392 |
Vec3<T> &intersection) const;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
bool intersectT(const Line3<T> &line,
|
|
Packit |
8dc392 |
T ¶meter) const;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
T distanceTo(const Vec3<T> &) const;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
Vec3<T> reflectPoint(const Vec3<T> &) const;
|
|
Packit |
8dc392 |
Vec3<T> reflectVector(const Vec3<T> &) const;
|
|
Packit |
8dc392 |
};
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
//--------------------
|
|
Packit |
8dc392 |
// Convenient typedefs
|
|
Packit |
8dc392 |
//--------------------
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
typedef Plane3<float> Plane3f;
|
|
Packit |
8dc392 |
typedef Plane3<double> Plane3d;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
//---------------
|
|
Packit |
8dc392 |
// Implementation
|
|
Packit |
8dc392 |
//---------------
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline Plane3<T>::Plane3(const Vec3<T> &p0,
|
|
Packit |
8dc392 |
const Vec3<T> &p1,
|
|
Packit |
8dc392 |
const Vec3<T> &p2)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
set(p0,p1,p2);
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline Plane3<T>::Plane3(const Vec3<T> &n, T d)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
set(n, d);
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline Plane3<T>::Plane3(const Vec3<T> &p, const Vec3<T> &n)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
set(p, n);
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline void Plane3<T>::set(const Vec3<T>& point1,
|
|
Packit |
8dc392 |
const Vec3<T>& point2,
|
|
Packit |
8dc392 |
const Vec3<T>& point3)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
normal = (point2 - point1) % (point3 - point1);
|
|
Packit |
8dc392 |
normal.normalize();
|
|
Packit |
8dc392 |
distance = normal ^ point1;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline void Plane3<T>::set(const Vec3<T>& point, const Vec3<T>& n)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
normal = n;
|
|
Packit |
8dc392 |
normal.normalize();
|
|
Packit |
8dc392 |
distance = normal ^ point;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline void Plane3<T>::set(const Vec3<T>& n, T d)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
normal = n;
|
|
Packit |
8dc392 |
normal.normalize();
|
|
Packit |
8dc392 |
distance = d;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline T Plane3<T>::distanceTo(const Vec3<T> &point) const
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
return (point ^ normal) - distance;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline Vec3<T> Plane3<T>::reflectPoint(const Vec3<T> &point) const
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
return normal * distanceTo(point) * -2.0 + point;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline Vec3<T> Plane3<T>::reflectVector(const Vec3<T> &v) const
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
return normal * (normal ^ v) * 2.0 - v;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline bool Plane3<T>::intersect(const Line3<T>& line, Vec3<T>& point) const
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
T d = normal ^ line.dir;
|
|
Packit |
8dc392 |
if ( d == 0.0 ) return false;
|
|
Packit |
8dc392 |
T t = - ((normal ^ line.pos) - distance) / d;
|
|
Packit |
8dc392 |
point = line(t);
|
|
Packit |
8dc392 |
return true;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template <class T>
|
|
Packit |
8dc392 |
inline bool Plane3<T>::intersectT(const Line3<T>& line, T &t) const
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
T d = normal ^ line.dir;
|
|
Packit |
8dc392 |
if ( d == 0.0 ) return false;
|
|
Packit |
8dc392 |
t = - ((normal ^ line.pos) - distance) / d;
|
|
Packit |
8dc392 |
return true;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template<class T>
|
|
Packit |
8dc392 |
std::ostream &operator<< (std::ostream &o, const Plane3<T> &plane)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
return o << "(" << plane.normal << ", " << plane.distance
|
|
Packit |
8dc392 |
<< ")";
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template<class T>
|
|
Packit |
8dc392 |
Plane3<T> operator* (const Plane3<T> &plane, const Matrix44<T> &M)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
// T
|
|
Packit |
8dc392 |
// -1
|
|
Packit |
8dc392 |
// Could also compute M but that would suck.
|
|
Packit |
8dc392 |
//
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
Vec3<T> dir1 = Vec3<T> (1, 0, 0) % plane.normal;
|
|
Packit |
8dc392 |
T dir1Len = dir1 ^ dir1;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
Vec3<T> tmp = Vec3<T> (0, 1, 0) % plane.normal;
|
|
Packit |
8dc392 |
T tmpLen = tmp ^ tmp;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
if (tmpLen > dir1Len)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
dir1 = tmp;
|
|
Packit |
8dc392 |
dir1Len = tmpLen;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
tmp = Vec3<T> (0, 0, 1) % plane.normal;
|
|
Packit |
8dc392 |
tmpLen = tmp ^ tmp;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
if (tmpLen > dir1Len)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
dir1 = tmp;
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
Vec3<T> dir2 = dir1 % plane.normal;
|
|
Packit |
8dc392 |
Vec3<T> point = plane.distance * plane.normal;
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
return Plane3<T> ( point * M,
|
|
Packit |
8dc392 |
(point + dir2) * M,
|
|
Packit |
8dc392 |
(point + dir1) * M );
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
template<class T>
|
|
Packit |
8dc392 |
Plane3<T> operator- (const Plane3<T> &plane)
|
|
Packit |
8dc392 |
{
|
|
Packit |
8dc392 |
return Plane3<T>(-plane.normal,-plane.distance);
|
|
Packit |
8dc392 |
}
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
IMATH_INTERNAL_NAMESPACE_HEADER_EXIT
|
|
Packit |
8dc392 |
|
|
Packit |
8dc392 |
#endif // INCLUDED_IMATHPLANE_H
|