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
|
#ifndef POINT3D_H
#define POINT3D_H
struct Point3d
{
float x, y, z;
Point3d()
: x(0)
, y(0)
, z(0)
{
}
Point3d(float x_, float y_, float z_)
: x(x_)
, y(y_)
, z(z_)
{
}
Point3d operator-(const Point3d &p) const
{
return Point3d(x - p.x, y - p.y, z - p.z);
}
Point3d operator+(const Point3d &p) const
{
return Point3d(x + p.x, y + p.y, z + p.z);
}
Point3d normalize() const
{
float r = 1. / sqrt(x * x + y * y + z * z);
return Point3d(x * r, y * r, z * r);
}
Point3d operator*(float f) const
{
return Point3d(x * f, y * f, z * f);
}
};
inline float dot(const Point3d &a, const Point3d &b)
{
return a.x * b.x + a.y * b.y + a.z * b.z;
}
inline Point3d cross(const Point3d &a, const Point3d &b)
{
return Point3d(a.y * b.z - a.z * b.y,
a.z * b.x - a.x * b.z,
a.x * b.y - a.y * b.x);
}
#endif
|
