summaryrefslogtreecommitdiff
path: root/src/mbgl/util/mat3.hpp
diff options
context:
space:
mode:
Diffstat (limited to 'src/mbgl/util/mat3.hpp')
-rw-r--r--src/mbgl/util/mat3.hpp29
1 files changed, 29 insertions, 0 deletions
diff --git a/src/mbgl/util/mat3.hpp b/src/mbgl/util/mat3.hpp
index 5069e02056..6b2e61a006 100644
--- a/src/mbgl/util/mat3.hpp
+++ b/src/mbgl/util/mat3.hpp
@@ -23,6 +23,7 @@
#pragma once
#include <array>
+#include <cmath>
namespace mbgl {
@@ -31,6 +32,34 @@ using vec3f = std::array<float, 3>;
using vec3i = std::array<int, 3>;
using mat3 = std::array<double, 9>;
+inline vec3 vec3Cross(const vec3& a, const vec3& b) {
+ return vec3{a[1] * b[2] - a[2] * b[1], a[2] * b[0] - a[0] * b[2], a[0] * b[1] - a[1] * b[0]};
+}
+
+inline double vec3Dot(const vec3& a, const vec3& b) {
+ return a[0] * b[0] + a[1] * b[1] + a[2] * b[2];
+}
+
+inline double vec3LengthSq(const vec3& a) {
+ return vec3Dot(a, a);
+}
+
+inline double vec3Length(const vec3& a) {
+ return std::sqrt(vec3LengthSq(a));
+}
+
+inline vec3 vec3Scale(const vec3& a, double s) {
+ return vec3{a[0] * s, a[1] * s, a[2] * s};
+}
+
+inline vec3 vec3Normalize(const vec3& a) {
+ return vec3Scale(a, 1.0 / vec3Length(a));
+}
+
+inline vec3 vec3Sub(const vec3& a, const vec3& b) {
+ return vec3{a[0] - b[0], a[1] - b[1], a[2] - b[2]};
+}
+
namespace matrix {
void identity(mat3& out);