diff options
Diffstat (limited to 'src/mbgl/util/mat3.hpp')
-rw-r--r-- | src/mbgl/util/mat3.hpp | 29 |
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); |