From add20389f64cea06a22278e36a70917f6fd324d8 Mon Sep 17 00:00:00 2001 From: Andreas Antener Date: Fri, 5 Jan 2018 11:30:35 +0100 Subject: [PATCH] conversion: added rotation +45 degree in pitch --- 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 9ebf0586e8..145b3b54c7 100644 --- a/src/lib/conversion/rotation.cpp +++ b/src/lib/conversion/rotation.cpp @@ -265,5 +265,12 @@ rotate_3f(enum Rotation rot, float &x, float &y, float &z) z = -0.156434f * tmpx + 0.000000f * tmpy + 0.987688f * tmpz; return; } + + case ROTATION_PITCH_45: { + 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 0a327e4b62..e37a1dfdce 100644 --- a/src/lib/conversion/rotation.h +++ b/src/lib/conversion/rotation.h @@ -81,6 +81,7 @@ enum Rotation { ROTATION_YAW_293_PITCH_68_ROLL_90 = 30, ROTATION_PITCH_90_ROLL_270 = 31, ROTATION_PITCH_9_YAW_180 = 32, + ROTATION_PITCH_45 = 33, ROTATION_MAX }; @@ -124,6 +125,7 @@ const rot_lookup_t rot_lookup[] = { { 90, 68, 293 }, {270, 90, 0 }, { 0, 9, 180 }, + { 0, 45, 0 }, }; /**