YourWishes/cglm
1
0
Fork 0
mirror of https://github.com/recp/cglm.git synced 2026-02-17 03:39:05 +00:00
Code Issues Packages Projects Releases Wiki Activity

improve extracting euler angles

Browse Source
This commit is contained in:
Recep Aslantas
2016-10-24 21:42:40 +03:00
parent baf60f0a31
commit e8cb10de72
1 changed files with 19 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

23
include/cglm-euler.h
View File

@@ -11,7 +11,7 @@
#include "cglm-common.h" #include "cglm-common.h"
/*! /*!
* @brief euler angles (in radian) for xyz sequence * @brief euler angles (in radian) using xyz sequence
* *
* @param[in] m affine transform * @param[in] m affine transform
* @param[out] pitch x * @param[out] pitch x
@@ -26,9 +26,24 @@ glm_euler_angles(mat4 m,
float * __restrict roll) { float * __restrict roll) {
if (m[2][0] < 1.0f) { if (m[2][0] < 1.0f) {
if (m[2][0] > -1.0f) { if (m[2][0] > -1.0f) {
*yaw = asinf(m[2][0]); float a[2][3];
*pitch = atan2f(-m[2][1], m[2][2]); int path;
*roll = atan2f(-m[1][0], m[0][0]);
a[0][0] = asinf(m[2][0]);
a[1][0] = M_PI - a[0][0];
a[0][1] = atan2f(-m[2][1] / cosf(a[0][0]), m[2][2] / cosf(a[0][0]));
a[1][1] = atan2f(-m[2][1] / cosf(a[1][0]), m[2][2] / cosf(a[1][0]));
a[0][2] = atan2f(-m[1][0] / cosf(a[0][0]), m[0][0] / cosf(a[0][0]));
a[1][2] = atan2f(-m[1][0] / cosf(a[1][0]), m[0][0] / cosf(a[1][0]));
path = (fabsf(a[0][0]) + fabsf(a[0][1]) + fabsf(a[0][2])) >
(fabsf(a[1][0]) + fabsf(a[1][1]) + fabsf(a[1][2]));
*yaw = a[path][0];
*pitch = a[path][1];
*roll = a[path][2];
} else { } else {
*yaw = -M_PI_2; *yaw = -M_PI_2;
*pitch = -atan2(m[0][1], m[2][1]); *pitch = -atan2(m[0][1], m[2][1]);