plane_3d.hpp

#pragma once
 
#include <cmath>
 
#include "global.hpp"
 
#include "point_3d.hpp"
 
namespace Cvb
{
 
CVB_BEGIN_INLINE_NS
 
 
class Plane3D final
{
public:
 
  Plane3D() noexcept = default;
 
 
  Plane3D(double nx, double ny, double nz, double distanceToOrigin) noexcept
      : normal_{nx, ny, nz}, distanceToOrigin_{distanceToOrigin}
  {
  }
 
 
  Plane3D(Point3D<double> normal, double distanceToOrigin) noexcept
      : normal_{normal}, distanceToOrigin_{distanceToOrigin}
  {
  }
 
 
  Point3D<double> Normal() const noexcept { return normal_; }
 
 
  void SetNormal(Point3D<double> normal) noexcept { normal_ = normal; }
 
 
  double DistanceToOrigin() const noexcept { return distanceToOrigin_; }
 
 
  void SetDistanceToOrigin(double distanceToOrigin) noexcept { distanceToOrigin_ = distanceToOrigin; }
 
 
  double DistanceToPoint(const Point3D<double> &pt) const noexcept { return DistanceToPoint(pt.X(), pt.Y(), pt.Z()); }
 
 
  double DistanceToPoint(double x, double y, double z) const noexcept
  {
    auto normal = normal_ / normal_.Length();
    return abs(normal.X() * x + normal.Y() * y + normal.Z() * z - distanceToOrigin_);
  }
 
private:
  Point3D<double> normal_{0.0, 0.0, 0.0};
  double distanceToOrigin_ = 0.0;
};
 
CVB_END_INLINE_NS
}