Go to the documentation of this file.
16 #ifndef SURGSIM_MATH_INTERVALARITHMETIC_INL_H
17 #define SURGSIM_MATH_INTERVALARITHMETIC_INL_H
32 SURGSIM_ASSERT(min <= max) <<
"Incorrect order of interval bounds";
65 minMax(a1, a2, &min, &max);
73 minMax(a1, a2, a3, &min, &max);
81 minMax(a1, a2, a3, a4, &min, &max);
94 return (m_min <= val && m_max >= val);
100 return contains(static_cast<T>(0));
106 return (std::abs(m_min - i.
m_min) <= epsilon) && (std::abs(m_max - i.
m_max) <= epsilon);
112 return (m_min == i.
m_min && m_max == i.
m_max);
118 return !(this->operator==(i));
248 *
this = minToMax(v * m_min, v * m_max);
255 SURGSIM_ASSERT(!containsZero()) <<
"Cannot invert or divide by an interval containing 0. Interval: [" <<
256 getMin() <<
", " << getMax() <<
"]" << std::endl;
257 return Interval<T>(static_cast<T>(1) / m_max, static_cast<T>(1) / m_min);
269 return (*
this) = (*this) * i.
inverse();
275 T lowerBoundSquared = m_min * m_min;
276 T upperBoundSquared = m_max * m_max;
277 T minSquare, maxSquare;
278 minMax(lowerBoundSquared, upperBoundSquared, &minSquare, &maxSquare);
279 return Interval<T>((m_min < 0 && m_max > 0) ? 0 : minSquare, maxSquare);
297 return Interval<T>(m_min, (m_min + m_max) * static_cast<T>(0.5));
303 return Interval<T>((m_min + m_max) * static_cast<T>(0.5), m_max);
307 template <
class T,
int N>
310 for (
int i = 0; i < N; i++)
316 template <
class T,
int N>
319 for (
int i = 0; i < N; i++)
321 m_interval[i] = x[i];
325 template <
class T,
int N>
328 for (
int i = 0; i < N; i++)
334 template <
class T,
int N>
337 for (
int j = 0; j < N; j++)
339 m_interval[j] = i.m_interval[j];
343 template <
class T,
int N>
346 for (
int i = 0; i < N; ++i)
352 template <
class T,
int N>
355 for (
int i = 0; i < N; i++)
362 template <
class T,
int N>
367 for (
int j = 0; j < N; j++)
369 m_interval[j] = i.m_interval[j];
376 template <
class T,
int N>
380 for (
int i = 0; i < N; ++i)
382 if (!m_interval[i].overlapsWith(interval.
m_interval[i]))
390 template <
class T,
int N>
393 for (
int i = 0; i < N; i++)
395 if (!m_interval[i].isApprox(interval.
m_interval[i], epsilon))
403 template <
class T,
int N>
406 for (
int i = 0; i < N; i++)
416 template <
class T,
int N>
419 return !(this->operator==(interval));
422 template <
class T,
int N>
425 for (
int i = 0; i < N; i++)
427 m_interval[i].addThickness(thickness);
432 template <
class T,
int N>
436 for (
int i = 0; i < N; i++)
443 template <
class T,
int N>
446 for (
int i = 0; i < N; i++)
453 template <
class T,
int N>
457 for (
int i = 0; i < N; i++)
464 template <
class T,
int N>
467 for (
int i = 0; i < N; i++)
474 template <
class T,
int N>
478 for (
int i = 0; i < N; i++)
485 template <
class T,
int N>
488 for (
int i = 0; i < N; i++)
495 template <
class T,
int N>
499 for (
int i = 0; i < N; i++)
506 template <
class T,
int N>
510 for (
int i = 0; i < N; i++)
517 template <
class T,
int N>
520 for (
int i = 0; i < N; i++)
527 template <
class T,
int N>
530 Interval<T> ret(static_cast<T>(0), static_cast<T>(0));
531 for (
int i = 0; i < N; i++)
533 ret += m_interval[i] * interval.
m_interval[i];
538 template <
class T,
int N>
542 for (
int i = 1; i < N; ++i)
544 result += m_interval[i].
square();
549 template <
class T,
int N>
557 template <
class T,
int N>
560 return m_interval[i];
770 template <
typename T>
776 template <
typename T>
838 template <
typename T>
841 o <<
"[" << interval.
getMin() <<
"," << interval.
getMax() <<
"]";
846 template <
typename T,
int N>
849 o <<
"(" << interval.
getAxis(0);
850 for (
int i = 1; i < N; ++i)
852 o <<
";" << interval.
getAxis(i);
899 #endif // SURGSIM_MATH_INTERVALARITHMETIC_INL_H
#define SURGSIM_ASSERT(condition)
Assert that condition is true.
Definition: Assert.h:77
Interval< T > square() const
Definition: IntervalArithmetic-inl.h:273
bool operator!=(const Interval< T > &i) const
Definition: IntervalArithmetic-inl.h:116
IntervalND< T, N > operator+(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:433
T m_min
The lower (m_min) and upper (m_max) limits of the interval.
Definition: IntervalArithmetic.h:187
Interval< T > & operator+=(const Interval< T > &i)
Definition: IntervalArithmetic-inl.h:170
Interval< T > & operator*=(const Interval< T > &i)
Definition: IntervalArithmetic-inl.h:239
void IntervalArithmetic_addsub(const Interval< T > &a, const Interval< T > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:804
IntervalND<T,3> defines the concept of a group of mathematical intervals specialized to 3 intervals a...
Definition: IntervalArithmetic.h:307
Interval< T > inverse() const
Definition: IntervalArithmetic-inl.h:253
T getMax() const
Definition: IntervalArithmetic-inl.h:289
Interval< T > dotProduct(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:528
Interval< T > & addThickness(const T &thickness)
Widens the current interval by thickness on both sides.
Definition: IntervalArithmetic-inl.h:122
Interval< T > upperHalf() const
Definition: IntervalArithmetic-inl.h:301
IntervalND< T, N > & operator-=(const IntervalND< T, N > &interval)
Definition: IntervalArithmetic-inl.h:465
IntervalND< T, N > operator/(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:507
IntervalND< T, N > & operator=(const IntervalND< T, N > &interval)
Assignment operator.
Definition: IntervalArithmetic-inl.h:353
Interval< T > operator+(const Interval< T > &i) const
Definition: IntervalArithmetic-inl.h:158
std::array< Interval< T >, N > m_interval
The N dimensional group of intervals.
Definition: IntervalArithmetic.h:297
bool isApprox(const Interval< T > &i, const T &epsilon) const
Definition: IntervalArithmetic-inl.h:104
bool isApprox(const IntervalND< T, N > &interval, const T &epsilon) const
Definition: IntervalArithmetic-inl.h:391
bool overlapsWith(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:377
void IntervalArithmetic_sub(const Interval< T > &a, const Interval< T > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:797
IntervalND< T, N > operator-(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:454
Definition: CompoundShapeToGraphics.cpp:29
Interval< T > operator*(T v, const Interval< T > &i)
Definition: IntervalArithmetic-inl.h:777
Interval< T > & operator/=(const Interval< T > &i)
Definition: IntervalArithmetic-inl.h:267
IntervalND< T, N > operator*(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:475
IntervalND< T, N > inverse() const
Definition: IntervalArithmetic-inl.h:496
Interval< T > magnitude() const
Definition: IntervalArithmetic-inl.h:550
void IntervalArithmetic_addmul(const Interval< T > &a, const Interval< T > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:820
IntervalND()
Constructor.
Definition: IntervalArithmetic-inl.h:308
Interval defines the concept of a mathematical interval and provides operations on it including arith...
Definition: IntervalArithmetic.h:34
std::ostream & operator<<(std::ostream &o, const Interval< T > &interval)
Write a textual version of the interval to an output stream.
Definition: IntervalArithmetic-inl.h:839
void IntervalArithmetic_dotProduct(const IntervalND< T, 3 > &a, const IntervalND< T, 3 > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:889
std::array< Interval< T >, 3 > m_interval
The 3 dimensional group of intervals.
Definition: IntervalArithmetic.h:424
void IntervalArithmetic_crossProduct(const IntervalND< T, 3 > &a, const IntervalND< T, 3 > &b, IntervalND< T, 3 > *res)
Definition: IntervalArithmetic-inl.h:876
Interval< T > operator*(const Interval< T > &i) const
Definition: IntervalArithmetic-inl.h:220
IntervalND< T, N > & addThickness(const T &thickness)
Widens every interval in the current interval group by thickness on both sides.
Definition: IntervalArithmetic-inl.h:423
T m_max
Definition: IntervalArithmetic.h:187
Interval()
Constructor.
Definition: IntervalArithmetic-inl.h:27
static Interval< T > minToMax(const T &a1, const T &a2)
Generate an interval from min to max based on the inputs.
Definition: IntervalArithmetic-inl.h:62
IntervalND defines the concept of a group of mathematical intervals and provides operations on them i...
Definition: IntervalArithmetic.h:199
T getMin() const
Definition: IntervalArithmetic-inl.h:283
void IntervalArithmetic_submul(const Interval< T > &a, const Interval< T > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:829
bool overlapsWith(const Interval< T > &i) const
Definition: IntervalArithmetic-inl.h:86
Interval< T > magnitudeSquared() const
Definition: IntervalArithmetic-inl.h:539
Interval< T > lowerHalf() const
Definition: IntervalArithmetic-inl.h:295
Interval< T > operator/(const Interval< T > &i) const
Definition: IntervalArithmetic-inl.h:261
IntervalND< T, N > & operator+=(const IntervalND< T, N > &interval)
Definition: IntervalArithmetic-inl.h:444
void IntervalArithmetic_mul(const Interval< T > &a, const Interval< T > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:811
IntervalND< T, N > & operator*=(const IntervalND< T, N > &interval)
Definition: IntervalArithmetic-inl.h:486
Interval< T > & extendToInclude(const T &x)
Widens the current interval on one end to include x.
Definition: IntervalArithmetic-inl.h:130
bool containsZero() const
Definition: IntervalArithmetic-inl.h:98
Interval< T > operator-() const
Definition: IntervalArithmetic-inl.h:186
bool operator==(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:404
bool contains(const T &val) const
Definition: IntervalArithmetic-inl.h:92
Interval< T > & operator-=(const Interval< T > &i)
Definition: IntervalArithmetic-inl.h:204
bool operator==(const Interval< T > &i) const
Definition: IntervalArithmetic-inl.h:110
IntervalND< T, N > & operator/=(const IntervalND< T, N > &interval)
Definition: IntervalArithmetic-inl.h:518
Interval< T > & operator=(const Interval< T > &i)
Assignment operator.
Definition: IntervalArithmetic-inl.h:46
Interval< T > operator+(T v, const Interval< T > &i)
Definition: IntervalArithmetic-inl.h:771
void IntervalArithmetic_add(const Interval< T > &a, const Interval< T > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:783
const Interval< T > & getAxis(size_t i) const
Definition: IntervalArithmetic-inl.h:558
void minMax(const T &a1, const T &a2, T *minVal, T *maxVal)
Calculate the minimum and maximum of two values.
Definition: MinMax-inl.h:27
bool operator!=(const IntervalND< T, N > &interval) const
Definition: IntervalArithmetic-inl.h:417
void IntervalArithmetic_addadd(const Interval< T > &a, const Interval< T > &b, Interval< T > *res)
Definition: IntervalArithmetic-inl.h:790