forked from bartvdbraak/blender
4e2143f639
Patch provied by gsrb3d bug tracker #7061 Kent
181 lines
4.2 KiB
C++
181 lines
4.2 KiB
C++
/*
|
|
* SOLID - Software Library for Interference Detection
|
|
*
|
|
* Copyright (C) 2001-2003 Dtecta. All rights reserved.
|
|
*
|
|
* This library may be distributed under the terms of the Q Public License
|
|
* (QPL) as defined by Trolltech AS of Norway and appearing in the file
|
|
* LICENSE.QPL included in the packaging of this file.
|
|
*
|
|
* This library may be distributed and/or modified under the terms of the
|
|
* GNU General Public License (GPL) version 2 as published by the Free Software
|
|
* Foundation and appearing in the file LICENSE.GPL included in the
|
|
* packaging of this file.
|
|
*
|
|
* This library is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
|
|
* WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
|
|
*
|
|
* Commercial use or any other use of this library not covered by either
|
|
* the QPL or the GPL requires an additional license from Dtecta.
|
|
* Please contact info@dtecta.com for enquiries about the terms of commercial
|
|
* use of this library.
|
|
*/
|
|
|
|
#ifndef INTERVAL_H
|
|
#define INTERVAL_H
|
|
|
|
#if defined (__sgi)
|
|
#include <assert.h>
|
|
#else
|
|
#include <cassert>
|
|
#endif
|
|
|
|
#include <iostream>
|
|
#include <algorithm>
|
|
|
|
namespace MT {
|
|
|
|
template <typename Scalar>
|
|
class Interval {
|
|
public:
|
|
Interval() {}
|
|
|
|
|
|
#if _MSC_VER <= 1200
|
|
explicit Interval(const Scalar& x)
|
|
: m_lb(x), m_ub(x)
|
|
{}
|
|
|
|
|
|
Interval(const Scalar& lb, const Scalar& ub)
|
|
: m_lb(lb), m_ub(ub)
|
|
{
|
|
assert(lb <= ub);
|
|
}
|
|
#else
|
|
template <typename Scalar2>
|
|
explicit Interval(const Scalar2& x)
|
|
: m_lb(x), m_ub(x)
|
|
{}
|
|
|
|
template <typename Scalar2>
|
|
Interval(const Scalar2& lb, const Scalar2& ub)
|
|
: m_lb(lb), m_ub(ub)
|
|
{
|
|
assert(lb <= ub);
|
|
}
|
|
|
|
template <typename Scalar2>
|
|
Interval(const Interval<Scalar2>& z)
|
|
{
|
|
*this = z;
|
|
}
|
|
|
|
template <typename Scalar2>
|
|
Interval<Scalar>& operator=(const Interval<Scalar2>& z)
|
|
{
|
|
m_lb = Scalar(z.lower());
|
|
m_ub = Scalar(z.upper());
|
|
return *this;
|
|
}
|
|
#endif
|
|
|
|
|
|
|
|
Scalar& lower() { return m_lb; }
|
|
const Scalar& lower() const { return m_lb; }
|
|
|
|
Scalar& upper() { return m_ub; }
|
|
const Scalar& upper() const { return m_ub; }
|
|
|
|
Scalar center() const { return (m_lb + m_ub) * Scalar(0.5); }
|
|
Scalar extent() const { return (m_ub - m_lb) * Scalar(0.5); }
|
|
|
|
|
|
protected:
|
|
Scalar m_lb, m_ub;
|
|
};
|
|
|
|
template <typename Scalar>
|
|
inline Interval<Scalar>
|
|
operator+(const Interval<Scalar>& z1, const Interval<Scalar>& z2)
|
|
{
|
|
return Interval<Scalar>(z1.lower() + z2.lower(),
|
|
z1.upper() + z2.upper());
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline Interval<Scalar>
|
|
operator-(const Interval<Scalar>& z1, const Interval<Scalar>& z2)
|
|
{
|
|
return Interval<Scalar>(z1.lower() - z2.upper(),
|
|
z1.upper() - z2.lower());
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline std::ostream&
|
|
operator<<(std::ostream& os, const Interval<Scalar>& z)
|
|
{
|
|
return os << '[' << z.lower() << ", " << z.upper() << ']';
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline Scalar
|
|
median(const Interval<Scalar>& z)
|
|
{
|
|
return (z.lower() + z.upper()) * Scalar(0.5);
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline Scalar
|
|
width(const Interval<Scalar>& z)
|
|
{
|
|
return z.upper() - z.lower();
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline bool
|
|
overlap(const Interval<Scalar>& z1, const Interval<Scalar>& z2)
|
|
{
|
|
return z1.lower() <= z2.upper() && z2.lower() <= z1.upper();
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline bool
|
|
in(const Interval<Scalar>& z1, const Interval<Scalar>& z2)
|
|
{
|
|
return z2.lower() <= z1.lower() && z1.upper() <= z2.upper();
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline bool
|
|
in(Scalar x, const Interval<Scalar>& z)
|
|
{
|
|
return z.lower() <= x && x <= z.upper();
|
|
}
|
|
|
|
template <typename Scalar>
|
|
inline Interval<Scalar>
|
|
widen(const Interval<Scalar>& z, const Scalar& x)
|
|
{
|
|
return Interval<Scalar>(z.lower() - x, z.upper() + x);
|
|
}
|
|
|
|
template<typename Scalar>
|
|
inline Interval<Scalar>
|
|
hull(const Interval<Scalar>& z1, const Interval<Scalar>& z2)
|
|
{
|
|
return Interval<Scalar>(GEN_min(z1.lower(), z2.lower()),
|
|
GEN_max(z1.upper(), z2.upper()));
|
|
}
|
|
|
|
template<typename Scalar>
|
|
inline Interval<Scalar>
|
|
operator+(Scalar x, const Interval<Scalar>& z)
|
|
{
|
|
return Interval<Scalar>(x + z.lower(), x + z.upper());
|
|
}
|
|
}
|
|
|
|
#endif
|