diff options
author | Roman Masanin <36927roma@gmail.com> | 2020-09-14 20:47:15 +0200 |
---|---|---|
committer | Roman Masanin <36927roma@gmail.com> | 2020-09-14 20:47:15 +0200 |
commit | 97550b4fd90cf1c3e9704ac03295475a3a21b01c (patch) | |
tree | 2f415a4829c705e6a2cdfb033ad861bf448aa7e5 /src/math/Vector.cpp | |
parent | finish work on ProcessPlayerVehicleEngine and cleanup (diff) | |
parent | Move a bunch of math to cpp files + small fixes (diff) | |
download | re3-97550b4fd90cf1c3e9704ac03295475a3a21b01c.tar re3-97550b4fd90cf1c3e9704ac03295475a3a21b01c.tar.gz re3-97550b4fd90cf1c3e9704ac03295475a3a21b01c.tar.bz2 re3-97550b4fd90cf1c3e9704ac03295475a3a21b01c.tar.lz re3-97550b4fd90cf1c3e9704ac03295475a3a21b01c.tar.xz re3-97550b4fd90cf1c3e9704ac03295475a3a21b01c.tar.zst re3-97550b4fd90cf1c3e9704ac03295475a3a21b01c.zip |
Diffstat (limited to 'src/math/Vector.cpp')
-rw-r--r-- | src/math/Vector.cpp | 46 |
1 files changed, 46 insertions, 0 deletions
diff --git a/src/math/Vector.cpp b/src/math/Vector.cpp new file mode 100644 index 00000000..42e1828e --- /dev/null +++ b/src/math/Vector.cpp @@ -0,0 +1,46 @@ +#include "common.h" + +void +CVector::Normalise(void) +{ + float sq = MagnitudeSqr(); + if (sq > 0.0f) { + float invsqrt = RecipSqrt(sq); + x *= invsqrt; + y *= invsqrt; + z *= invsqrt; + } else + x = 1.0f; +} + +CVector +CrossProduct(const CVector &v1, const CVector &v2) +{ + return CVector(v1.y * v2.z - v1.z * v2.y, v1.z * v2.x - v1.x * v2.z, v1.x * v2.y - v1.y * v2.x); +} + +CVector +Multiply3x3(const CMatrix &mat, const CVector &vec) +{ + // TODO: VU0 code + return CVector(mat.m_matrix.right.x * vec.x + mat.m_matrix.up.x * vec.y + mat.m_matrix.at.x * vec.z, + mat.m_matrix.right.y * vec.x + mat.m_matrix.up.y * vec.y + mat.m_matrix.at.y * vec.z, + mat.m_matrix.right.z * vec.x + mat.m_matrix.up.z * vec.y + mat.m_matrix.at.z * vec.z); +} + +CVector +Multiply3x3(const CVector &vec, const CMatrix &mat) +{ + return CVector(mat.m_matrix.right.x * vec.x + mat.m_matrix.right.y * vec.y + mat.m_matrix.right.z * vec.z, + mat.m_matrix.up.x * vec.x + mat.m_matrix.up.y * vec.y + mat.m_matrix.up.z * vec.z, + mat.m_matrix.at.x * vec.x + mat.m_matrix.at.y * vec.y + mat.m_matrix.at.z * vec.z); +} + +CVector +operator*(const CMatrix &mat, const CVector &vec) +{ + // TODO: VU0 code + return CVector(mat.m_matrix.right.x * vec.x + mat.m_matrix.up.x * vec.y + mat.m_matrix.at.x * vec.z + mat.m_matrix.pos.x, + mat.m_matrix.right.y * vec.x + mat.m_matrix.up.y * vec.y + mat.m_matrix.at.y * vec.z + mat.m_matrix.pos.y, + mat.m_matrix.right.z * vec.x + mat.m_matrix.up.z * vec.y + mat.m_matrix.at.z * vec.z + mat.m_matrix.pos.z); +} |