admin/omath
1
0
Fork 0
mirror of https://github.com/orange-cpp/omath.git synced 2026-02-13 23:13:26 +00:00
Code Issues Packages Projects Releases Wiki Activity

added unit test

Browse Source
This commit is contained in:
Orange
2024-08-27 10:56:56 +03:00
parent db57dfd5f9
commit 13188615ed
5 changed files with 39 additions and 11 deletions
Download Patch File Download Diff File Expand all files Collapse all files

21
source/Vector3.cpp
View File

@@ -238,10 +238,12 @@ namespace omath
const auto cosRoll = std::cos(angles::DegreesToRadians(roll));
const auto sinRoll = std::sin(angles::DegreesToRadians(roll));
return {-sinRoll*sinPitch*cosYaw + -cosRoll*-sinYaw,
-sinRoll*sinPitch*sinYaw + -cosRoll*cosYaw,
-sinRoll*cosPitch};
// Right vector calculation
return {
cosYaw * cosRoll - sinYaw * sinPitch * sinRoll, // X component
sinRoll * cosPitch, // Y component
sinYaw * cosRoll + cosYaw * sinPitch * sinRoll // Z component
};
}
Vector3 Vector3::UpVector(float pitch, float yaw, float roll)
@@ -255,12 +257,11 @@ namespace omath
const auto cosRoll = std::cos(angles::DegreesToRadians(roll));
const auto sinRoll = std::sin(angles::DegreesToRadians(roll));
return
{
cosRoll*sinPitch*cosYaw+-sinRoll*-sinYaw,
cosRoll*sinPitch*cosYaw+-sinRoll*-sinYaw,
cosRoll*cosPitch,
// Up vector calculation
return {
-sinRoll * cosYaw + cosRoll * sinPitch * sinYaw, // X component
cosRoll * cosPitch, // Y component
-sinRoll * sinYaw - cosRoll * sinPitch * cosYaw // Z component
};
}