From ab9ee3aa6c7e0ed41502f3e76151e8fa97d3736a Mon Sep 17 00:00:00 2001 From: Andreas Antener Date: Fri, 5 Jan 2018 11:57:58 +0100 Subject: [PATCH] conversion: added -45 deg pitch rotation --- src/lib/conversion/rotation.cpp | 7 +++++++ src/lib/conversion/rotation.h | 2 ++ 2 files changed, 9 insertions(+) diff --git a/src/lib/conversion/rotation.cpp b/src/lib/conversion/rotation.cpp index 145b3b54c7..61da4d882a 100644 --- a/src/lib/conversion/rotation.cpp +++ b/src/lib/conversion/rotation.cpp @@ -272,5 +272,12 @@ rotate_3f(enum Rotation rot, float &x, float &y, float &z) x = tmp; return; } + + case ROTATION_PITCH_315: { + tmp = HALF_SQRT_2 * x - HALF_SQRT_2 * z; + z = HALF_SQRT_2 * z + HALF_SQRT_2 * x; + x = tmp; + return; + } } } diff --git a/src/lib/conversion/rotation.h b/src/lib/conversion/rotation.h index e37a1dfdce..a2624844a2 100644 --- a/src/lib/conversion/rotation.h +++ b/src/lib/conversion/rotation.h @@ -82,6 +82,7 @@ enum Rotation { ROTATION_PITCH_90_ROLL_270 = 31, ROTATION_PITCH_9_YAW_180 = 32, ROTATION_PITCH_45 = 33, + ROTATION_PITCH_315 = 34, ROTATION_MAX }; @@ -126,6 +127,7 @@ const rot_lookup_t rot_lookup[] = { {270, 90, 0 }, { 0, 9, 180 }, { 0, 45, 0 }, + { 0, 315, 0 }, }; /**