|
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
|
// 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
|