itdominator
/
SWBF2-Classic-Msh-Viewer
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

different quat2eul function from the internet

This commit is contained in:
Anakin 2016-12-03 14:33:15 +01:00
parent 4078347023
commit 1c5a33cfa7
1 changed files with 12 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
MshViewer/Source/Object.cpp
View File

@ -574,21 +574,20 @@ void Object::readUV(Segment* dataDestination, std::streampos position)
void Object::quat2eul(float &quat0, float &quat1, float & quat2, float &quat3) void Object::quat2eul(float &quat0, float &quat1, float & quat2, float &quat3)
{ {
float eulX = atan2( float ysqr = quat1 * quat1;
2 * (quat0 * quat1 + quat2 * quat3), float t0 = -2.0f * (ysqr + quat2 * quat2) + 1.0f;
1 - 2 * (pow(quat1, 2) + pow(quat2, 2)) float t1 = +2.0f * (quat0 * quat1 - quat3 * quat2);
); float t2 = -2.0f * (quat0 * quat2 + quat3 * quat1);
float t3 = +2.0f * (quat1 * quat2 - quat3 * quat0);
float t4 = -2.0f * (quat0 * quat0 + ysqr) + 1.0f;
float eulY = asin(2 * (quat0 * quat2 - quat3 * quat1)); t2 = t2 > 1.0f ? 1.0f : t2;
t2 = t2 < -1.0f ? -1.0f : t2;
float eulZ = atan2(
2 * (quat0 * quat3 + quat1 * quat2), quat1 = std::asin(t2);
1 - 2 * (pow(quat2, 2) + pow(quat3, 2)) quat0 = std::atan2(t3, t4);
) - PI; quat2 = std::atan2(t1, t0);
quat0 = eulX;
quat1 = eulY;
quat2 = eulZ;
} }