point_3d.hpp

#pragma once
 
#include <cmath>
#include <cassert>
 
#include "global.hpp"
 
#include "angle.hpp"
 
namespace Cvb
{
 
  CVB_BEGIN_INLINE_NS
 
#pragma pack(push, 4)
 
 
  template <class T, class ENABLE = void>
  class Point3D final
  {
 
#ifndef CVB_DOXYGEN
    static_assert(std::is_arithmetic<T>::value, "CVB: Unsupported data type - must be arithmetic!");
  };
 
  template <class T>
  class Point3D<T, typename EnableIfArithmetic<T>::type> final
  {
 
#endif
 
  public:
    using ValueType = T;
 
 
    Point3D() noexcept = default;
 
 
    Point3D(T x, T y, T z) noexcept
        : x_(x)
        , y_(y)
        , z_(z)
    {
    }
 
 
    template <std::size_t N>
    Point3D(const T (&list)[N]) noexcept  // NOLINT
    {
      static_assert(N == 3, "CVB: Point3D must have 3 elements");
      std::copy(std::begin(list), std::end(list), &x_);
    }
 
 
    T X() const noexcept
    {
      return x_;
    }
 
 
    void SetX(T x) noexcept
    {
      x_ = x;
    }
 
 
    T Y() const noexcept
    {
      return y_;
    }
 
 
    void SetY(T y)
    {
      y_ = y;
    }
 
 
    T Z() const noexcept
    {
      return z_;
    }
 
 
    void SetZ(T z)
    {
      z_ = z;
    }
 
 
    T Length() const noexcept
    {
      return sqrt(x_ * x_ + y_ * y_ + z_ * z_);
    }
 
 
    bool operator==(const Point3D<T> &other) const noexcept
    {
      return (x_ == other.x_ && y_ == other.y_ && z_ == other.z_);
    }
 
 
    bool operator!=(const Point3D<T> &other) const noexcept
    {
      return !(*this == other);
    }
 
    template <class C>
    explicit operator Point3D<C>() const noexcept
    {
      static_assert(std::is_floating_point<C>::value, "CVB: Unsupported data type - must be floating point!");
      return Point3D<C>(static_cast<C>(X()), static_cast<C>(Y()), static_cast<C>(Z()));
    }
 
 
    Point3D<T> &operator+=(const Point3D<T> &point) noexcept
    {
      x_ += point.x_;
      y_ += point.y_;
      z_ += point.z_;
      return *this;
    }
 
 
    Point3D<T> &operator-=(const Point3D<T> &point) noexcept
    {
      x_ -= point.x_;
      y_ -= point.y_;
      z_ -= point.z_;
      return *this;
    }
 
 
    Point3D<T> &operator*=(const T &value) noexcept
    {
      x_ *= value;
      y_ *= value;
      z_ *= value;
      return *this;
    }
 
 
    Point3D<T> &operator/=(const T &value) noexcept
    {
      x_ /= value;
      y_ /= value;
      z_ /= value;
      return *this;
    }
 
 
    const T &operator[](int index) const noexcept
    {
      assert(index < 3 && index >= 0);  // NOLINT(cppcoreguidelines-pro-bounds-array-to-pointer-decay)
      return *(&x_ + index);
    }
 
 
    T &operator[](int index) noexcept
    {
      assert(index < 3 && index >= 0);  // NOLINT(cppcoreguidelines-pro-bounds-array-to-pointer-decay)
      return *(&x_ + index);
    }
 
  private:
    T x_ = static_cast<T>(0.0);
    T y_ = static_cast<T>(0.0);
    T z_ = static_cast<T>(0.0);
  };
 
 
  template <class T>
  inline Point3D<T> operator+(const Point3D<T> &lhs, const Point3D<T> &rhs)
  {
    return Point3D<T>(lhs.X() + rhs.X(), lhs.Y() + rhs.Y(), lhs.Z() + rhs.Z());
  }
 
 
  template <class T>
  inline Point3D<T> operator-(const Point3D<T> &lhs, const Point3D<T> &rhs)
  {
    return Point3D<T>(lhs.X() - rhs.X(), lhs.Y() - rhs.Y(), lhs.Z() - rhs.Z());
  }
 
 
  template <class T>
  inline T operator*(const Point3D<T> &lhs, const Point3D<T> &rhs)
  {
    return lhs.X() * rhs.X() + lhs.Y() * rhs.Y() + lhs.Z() * rhs.Z();
  }
 
 
  template <class T>
  inline Point3D<T> operator*(const Point3D<T> &lhs, const T &rhs)
  {
    return Point3D<T>(lhs.X() * rhs, lhs.Y() * rhs, lhs.Z() * rhs);
  }
 
 
  template <class T>
  inline Point3D<T> operator*(const T &lhs, const Point3D<T> &rhs)
  {
    return rhs * lhs;
  }
 
 
  template <class T>
  inline Point3D<T> operator/(const Point3D<T> &lhs, const T &rhs)
  {
    return Point3D<T>(lhs.X() / rhs, lhs.Y() / rhs, lhs.Z() / rhs);
  }
 
 
  template <class T>
  inline Point3D<int> Round(const Point3D<T> &rhs) noexcept
  {
    static_assert(IsNumeric<T>::value, "CVB: Unsupported data type - must be numeric!");
    return Point3D<int>(static_cast<int>(std::round(rhs.X())), static_cast<int>(std::round(rhs.Y())),
                        static_cast<int>(std::round(rhs.Z())));
  }
 
  template <class T>
  using Vector3D = Point3D<T>;
 
#pragma pack(pop)
 
  CVB_END_INLINE_NS
 
}  // namespace Cvb