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
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
|
/*
* Copyright (c) 2020, Stephan Unverwerth <s.unverwerth@gmx.de>
*
* SPDX-License-Identifier: BSD-2-Clause
*/
#pragma once
#include <math.h>
namespace Gfx {
template<typename T>
class Vector3 {
public:
Vector3() = default;
Vector3(T x, T y, T z)
: m_x(x)
, m_y(y)
, m_z(z)
{
}
T x() const { return m_x; }
T y() const { return m_y; }
T z() const { return m_z; }
void set_x(T value) { m_x = value; }
void set_y(T value) { m_y = value; }
void set_z(T value) { m_z = value; }
Vector3 operator+(const Vector3& other) const
{
return Vector3(m_x + other.m_x, m_y + other.m_y, m_z + other.m_z);
}
Vector3 operator-(const Vector3& other) const
{
return Vector3(m_x - other.m_x, m_y - other.m_y, m_z - other.m_z);
}
Vector3 operator*(T f) const
{
return Vector3(m_x * f, m_y * f, m_z * f);
}
Vector3 operator/(T f) const
{
return Vector3(m_x / f, m_y / f, m_z / f);
}
T dot(const Vector3& other) const
{
return m_x * other.m_x + m_y * other.m_y + m_z * other.m_z;
}
Vector3 cross(const Vector3& other) const
{
return Vector3(
m_y * other.m_z - m_z * other.m_y,
m_z * other.m_x - m_x * other.m_z,
m_x * other.m_y - m_y * other.m_x);
}
Vector3 normalized() const
{
T inv_length = 1 / length();
return *this * inv_length;
}
Vector3 clamped(T m, T x) const
{
Vector3 copy { *this };
copy.clamp(m, x);
return copy;
}
void clamp(T min_value, T max_value)
{
m_x = max(min_value, m_x);
m_y = max(min_value, m_y);
m_z = max(min_value, m_z);
m_x = min(max_value, m_x);
m_y = min(max_value, m_y);
m_z = min(max_value, m_z);
}
void normalize()
{
T inv_length = 1 / length();
m_x *= inv_length;
m_y *= inv_length;
m_z *= inv_length;
}
T length() const
{
return sqrt(m_x * m_x + m_y * m_y + m_z * m_z);
}
private:
T m_x;
T m_y;
T m_z;
};
typedef Vector3<float> FloatVector3;
typedef Vector3<double> DoubleVector3;
}
using Gfx::DoubleVector3;
using Gfx::FloatVector3;
using Gfx::Vector3;
|