line3d.h

Go to the documentation of this file.

// Copyright (C) 2002-2012 Nikolaus Gebhardt
// This file is part of the "Irrlicht Engine".
// For conditions of distribution and use, see copyright notice in irrlicht.h
 
#ifndef __IRR_LINE_3D_H_INCLUDED__
#define __IRR_LINE_3D_H_INCLUDED__
 
#include <glm/vec3.hpp>
 
namespace saga
{
namespace core
{
 
template <class T>
class line3d
{
  public:
 
 
    line3d() : start(0,0,0), end(1,1,1) {}
    line3d(T xa, T ya, T za, T xb, T yb, T zb) : start(xa, ya, za), end(xb, yb, zb) {}
    line3d(const glm::vec3& start, const glm::vec3& end) : start(start), end(end) {}
 
    // operators
 
    line3d<T> operator+(const glm::vec3& point) const { return line3d<T>(start + point, end + point); }
    line3d<T>& operator+=(const glm::vec3& point) { start += point; end += point; return *this; }
 
    line3d<T> operator-(const glm::vec3& point) const { return line3d<T>(start - point, end - point); }
    line3d<T>& operator-=(const glm::vec3& point) { start -= point; end -= point; return *this; }
 
    bool operator==(const line3d<T>& other) const
    { return (start==other.start && end==other.end) || (end==other.start && start==other.end);}
    bool operator!=(const line3d<T>& other) const
    { return !(start==other.start && end==other.end) || (end==other.start && start==other.end);}
 
    // functions
    void setLine(const T& xa, const T& ya, const T& za, const T& xb, const T& yb, const T& zb)
    { start = {xa, ya, za}; end = {xb, yb, zb}; }
    void setLine(const glm::vec3& nstart, const glm::vec3& nend)
    { start = nstart; end = nend; }
    void setLine(const line3d<T>& line)
    { start = line.start; end = line.end; }
 
 
    T getLength() const { return glm::distance(start, end); }
 
 
    T getLengthSQ() const { auto d = glm::distance(start, end);  return d * d; }
 
 
    glm::vec3 getMiddle() const
    {
      return (start + end)/(T)2;
    }
 
 
    glm::vec3 getVector() const
    {
      return end - start;
    }
 
 
    bool isPointBetweenStartAndEnd(const glm::vec3& point) const
    {
      return isBetweenPoints(point, start, end);
    }
 
 
    glm::vec3 getClosestPoint(const glm::vec3& point) const
    {
      glm::vec3 c = point - start;
      glm::vec3 v = end - start;
      T d = (T) glm::length(v);
      v /= d;
      T t = glm::dot(v, c);
 
      if (t < (T)0.0)
        return start;
      if (t > d)
        return end;
 
      v *= t;
      return start + v;
    }
 
 
    bool getIntersectionWithSphere(const glm::vec3& sorigin, T sradius, double& outdistance) const
    {
      const glm::vec3 q = sorigin - start;
      T c = glm::length(q);
      T v = glm::dot(q, glm::normalize(getVector()));
      T d = sradius * sradius - (c*c - v*v);
 
      if (d < 0.0)
        return false;
 
      outdistance = v - core::squareroot (d);
      return true;
    }
 
    // member variables
 
    glm::vec3 start;
    glm::vec3 end;
};
 
  typedef line3d<float> line3df;
  typedef line3d<std::int32_t> line3di;
 
} // namespace core
} // namespace saga
 
#endif