archivemirrors/re3
1
0
Fork 0
mirror of https://github.com/halpz/re3.git synced 2025-07-04 05:10:53 +00:00
Code Issues Packages Projects Releases Wiki Activity

acos

Browse Source
This commit is contained in:
Sergeanur
2020-01-29 13:00:40 +02:00
parent daf1fdf403
commit 81de0e0cbd
2 changed files with 5 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
src/peds/PedIK.cpp
View File

@ -344,11 +344,11 @@ void
CPedIK::ExtractYawAndPitchWorld(RwMatrixTag *mat, float *yaw, float *pitch)
{
float f = clamp(DotProduct(mat->up, CVector(0.0f, 1.0f, 0.0f)), -1.0f, 1.0f);
*yaw = HALFPI - Atan2(f, Sqrt(1.0f - f * f));
*yaw = Acos(f);
if (mat->up.x > 0.0f) *yaw = -*yaw;
f = clamp(DotProduct(mat->right, CVector(0.0f, 0.0f, 1.0f)), -1.0f, 1.0f);
*pitch = HALFPI - Atan2(f, Sqrt(1.0f - f * f));
*pitch = Acos(f);
if (mat->up.z > 0.0f) *pitch = -*pitch;
}
@ -356,11 +356,11 @@ void
CPedIK::ExtractYawAndPitchLocal(RwMatrixTag *mat, float *yaw, float *pitch)
{
float f = clamp(DotProduct(mat->at, CVector(0.0f, 0.0f, 1.0f)), -1.0f, 1.0f);
*yaw = HALFPI - Atan2(f, Sqrt(1.0f - f * f));
*yaw = Acos(f);
if (mat->at.y > 0.0f) *yaw = -*yaw;
f = clamp(DotProduct(mat->right, CVector(1.0f, 0.0f, 0.0f)), -1.0f, 1.0f);
*pitch = HALFPI - Atan2(f, Sqrt(1.0f - f * f));
*pitch = Acos(f);
if (mat->up.x > 0.0f) *pitch = -*pitch;
}