Line3D.h

Go to the documentation of this file.

// Hep-LIKE geometrical 3D LINE class
//
//
// Author: BKH
//
 
#ifndef HepLine3D_hh
#define HepLine3D_hh
 
#include "CLHEP/Geometry/Point3D.h"
#include "CLHEP/Geometry/Normal3D.h"
#include "CLHEP/Geometry/Plane3D.h"
#include <iostream>
 
class HepLine3D {
protected:
  HepGeom::Point3D<double> pp;
  HepGeom::Vector3D<double> uu;
  double eps;
 
public:
  HepLine3D(const HepGeom::Point3D<double>& p, const HepGeom::Vector3D<double>& v, double sml = 1.e-10)
      : pp(p), uu(v * (v.mag() > 1.e-10 ? 1. / v.mag() : 1)), eps(fabs(sml)) {}
 
  HepLine3D(const HepGeom::Point3D<double>& p1, const HepGeom::Point3D<double>& p2, double sml = 1.e-10)
      : pp(p1), uu((p2 - p1) * ((p2 - p1).mag() > 1.e-10 ? 1. / (p2 - p1).mag() : 1)), eps(fabs(sml)) {}
 
  // Copy constructor
  HepLine3D(const HepLine3D& line) : pp(line.pp), uu(line.uu), eps(line.eps) {}
 
  // Destructor
  ~HepLine3D(){};
 
  // Assignment
  HepLine3D& operator=(const HepLine3D& line) {
    pp = line.pp;
    uu = line.uu;
    eps = line.eps;
    return *this;
  }
 
  // Test for equality
  bool operator==(const HepLine3D& l) const { return pp == l.pp && uu == l.uu; }
 
  // Test for inequality
  bool operator!=(const HepLine3D& l) const { return pp != l.pp || uu != l.uu; }
 
  const HepGeom::Point3D<double>& pt() const { return pp; }
 
  const HepGeom::Vector3D<double>& uv() const { return uu; }
 
  HepGeom::Point3D<double> point(const HepGeom::Plane3D<double>& pl, bool& parallel) const {
    const double num(-pl.d() - pl.a() * pp.x() - pl.b() * pp.y() - pl.c() * pp.z());
    const double den(pl.a() * uu.x() + pl.b() * uu.y() + pl.c() * uu.z());
 
    parallel = (eps > fabs(num)) || (eps > fabs(den));
 
    return (parallel ? pp : HepGeom::Point3D<double>(pp + uu * (num / den)));
  }
 
  HepGeom::Point3D<double> point(const HepGeom::Point3D<double>& q) const {
    return (pp + ((q.x() - pp.x()) * uu.x() + (q.y() - pp.y()) * uu.y() + (q.z() - pp.z()) * uu.z()) * uu);
  }
 
  double dist2(const HepGeom::Point3D<double>& q) const { return (q - point(q)).mag2(); }
  double dist(const HepGeom::Point3D<double>& q) const { return (q - point(q)).mag(); }
};
 
#endif