-
Notifications
You must be signed in to change notification settings - Fork 0
/
Plane.h
72 lines (59 loc) · 2 KB
/
Plane.h
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
70
71
72
#ifndef _SMALL_PLANE_H_
#define _SMALL_PLANE_H_
#include "Vector.h"
#include <string>
#include <iostream>
/**
* The plane is defined the the plane equation Ax + By + Cz + D = 0. The normal
* of the plane is given by [A, B, C] and the distance is D. The normal is
* assumed to be normalized on construction, so the plane is in Hessian normal
* form.
*/
class Plane {
private:
Vector3 normal;
float distance;
public:
/**
* Plane constructor
*
* @param normal. The normal of the plane. Assumed to be normalized by the caller.
* @distance. The signed distance to origo modulated by the length of the
* normal (if not normalized). D in the plane equation.
*/
Plane(Vector3 normal = Vector3(1,0,0), float distance = 0)
: normal(normal), distance(distance) {}
/**
* Plane constructor
*
* @param normal. The normal of the plane. Assumed to be normalized by the caller.
* @point. A point in the plane.
*/
Plane(Vector3 normal, Vector3 point)
: normal(normal), distance(-Dot(normal, point)) {}
inline const Vector3 GetNormal() const { return normal; }
inline const float GetDistance() const { return distance; }
/**
* Calculates the signed distance from the point p to the plane. If the
* planes normal is not normalized then the distance needs to be divided by
* the length of the normal.
*
* @return The signed distance between the plane and p.
*/
inline float DistanceTo(const Vector3& p) {
return Dot(normal, p) + distance;
}
inline std::string ToString(const int precision = 2) const {
std::ostringstream out;
out << std::fixed << std::setprecision(precision) << "[normal: " << normal.ToString(precision) << ", distance: " << distance << "]";
return out.str();
}
};
/**
* Stream operator to ease the use printing values.
*/
std::ostream& operator<<(std::ostream& os, const Plane& p) {
os << p.ToString();
return os;
}
#endif //_SMALL_PLANE_H_