AuroraMiddleware/bullet3
1
0
Fork 0
mirror of https://github.com/bulletphysics/bullet3 synced 2024-12-15 22:20:12 +00:00
Code Issues Releases Wiki Activity

fixed 'getEuler' method

Browse Source
This commit is contained in:
ejcoumans 2007-05-30 03:07:39 +00:00
parent eca55afe4d
commit f1e929f8a4
1 changed files with 7 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
src/LinearMath/btMatrix3x3.h
View File

@ -207,30 +207,32 @@ class btMatrix3x3 {
q.setValue(temp[0],temp[1],temp[2],temp[3]);
}
void getEuler(btScalar& yaw, btScalar& pitch, btScalar& roll) const
{
pitch = btScalar(btAsin(-m_el[2].x()));
if (pitch < SIMD_2_PI)
if (btScalar(m_el[1].z()) < btScalar(1))
{
if (pitch > SIMD_2_PI)
if (btScalar(m_el[1].z()) > -btScalar(1))
{
yaw = btScalar(btAtan2(m_el[1].x(), m_el[0].x()));
pitch = btScalar(btAsin(-m_el[1].y()));
roll = btScalar(btAtan2(m_el[2].y(), m_el[2].z()));
}
else
{
yaw = btScalar(-btAtan2(-m_el[0].y(), m_el[0].z()));
pitch = SIMD_HALF_PI;
roll = btScalar(0.0);
}
}
else
{
yaw = btScalar(btAtan2(-m_el[0].y(), m_el[0].z()));
pitch = -SIMD_HALF_PI;
roll = btScalar(0.0);
}
}