From 9f8c9c61e87868510ee2951c93044c4995478641 Mon Sep 17 00:00:00 2001 From: Mikko Pulkki Date: Wed, 22 Apr 2020 17:49:50 +0300 Subject: Add vec3 math operations --- src/mbgl/util/bounding_volumes.cpp | 28 ---------------------------- src/mbgl/util/mat3.hpp | 29 +++++++++++++++++++++++++++++ 2 files changed, 29 insertions(+), 28 deletions(-) diff --git a/src/mbgl/util/bounding_volumes.cpp b/src/mbgl/util/bounding_volumes.cpp index 8d34f9bd62..ccad4d95af 100644 --- a/src/mbgl/util/bounding_volumes.cpp +++ b/src/mbgl/util/bounding_volumes.cpp @@ -11,34 +11,6 @@ vec3 toVec3(const vec4& v) { return vec3{v[0], v[1], v[2]}; } -vec3 vec3Sub(const vec3& a, const vec3& b) { - return vec3{a[0] - b[0], a[1] - b[1], a[2] - b[2]}; -} - -vec3 vec3Scale(const vec3& a, double s) { - return vec3{a[0] * s, a[1] * s, a[2] * s}; -} - -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]}; -} - -double vec3Dot(const vec3& a, const vec3& b) { - return a[0] * b[0] + a[1] * b[1] + a[2] * b[2]; -} - -double vec3LengthSq(const vec3& a) { - return vec3Dot(a, a); -} - -double vec3Length(const vec3& a) { - return std::sqrt(vec3LengthSq(a)); -} - -vec3 vec3Normalize(const vec3& a) { - return vec3Scale(a, 1.0 / vec3Length(a)); -} - double vec4Dot(const vec4& a, const vec4& b) { return a[0] * b[0] + a[1] * b[1] + a[2] * b[2] + a[3] * b[3]; } 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 +#include namespace mbgl { @@ -31,6 +32,34 @@ using vec3f = std::array; using vec3i = std::array; using mat3 = std::array; +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); -- cgit v1.2.1