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 }, }; /**