added camera

source/CMakeLists.txt

@@ -5,4 +5,5 @@ target_sources(omath PRIVATE
         Vector4.cpp)
 
 add_subdirectory(prediction)
-add_subdirectory(pathfinding)
+add_subdirectory(pathfinding)
+add_subdirectory(projection)

source/Vector3.cpp

@@ -219,7 +219,12 @@ namespace omath
         const auto sinYaw = std::sin(angles::DegreesToRadians(yaw));
 
 
-        return {cosPitch*cosYaw, cosPitch*sinYaw, sinPitch};
+        return
+        {
+            cosPitch*cosYaw,
+            cosPitch*sinYaw,
+            sinPitch
+        };
     }
 
     Vector3 Vector3::RightVector(const float pitch, const float yaw, const float roll)
@@ -230,13 +235,33 @@ namespace omath
         const auto cosYaw = std::cos(angles::DegreesToRadians(yaw));
         const auto sinYaw = std::sin(angles::DegreesToRadians(yaw));
 
-        const auto cosRoll = std::cos(angles::DegreesToRadians(yaw));
-        const auto sinRoll = std::sin(angles::DegreesToRadians(yaw));
+        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};
+                -sinRoll*cosPitch};
+    }
+
+    Vector3 Vector3::UpVector(float pitch, float yaw, float roll)
+    {
+        const auto cosPitch = std::cos(angles::DegreesToRadians(pitch));
+        const auto sinPitch = std::sin(angles::DegreesToRadians(pitch));
+
+        const auto cosYaw = std::cos(angles::DegreesToRadians(yaw));
+        const auto sinYaw = std::sin(angles::DegreesToRadians(yaw));
+
+        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,
+        };
     }
 
     Vector3 Vector3::Cross(const Vector3 &v) const

source/matrix.cpp

@@ -120,6 +120,12 @@ namespace omath
         return outMat;
     }
 
+    Matrix & Matrix::operator*=(const Matrix &other)
+    {
+        *this = *this * other;
+        return *this;
+    }
+
     Matrix Matrix::operator*(const float f) const
     {
         auto out = *this;

source/projection/CMakeLists.txt

@@ -0,0 +1 @@
+target_sources(omath PRIVATE Camera.cpp)

source/projection/Camera.cpp

@@ -0,0 +1,74 @@
+//
+// Created by Vlad on 27.08.2024.
+//
+#include "omath/projection/Camera.h"
+#include "omath/angles.h"
+
+
+namespace omath::projection
+{
+    Matrix Camera::GetViewMatrix() const
+    {
+        return GetOrientationMatrix() * GetTranslationMatrix();
+    }
+
+    Matrix Camera::GetProjectionMatrix() const
+    {
+        const auto aspectRatio = m_viewPort.x / m_viewPort.y;
+        const auto verticalFov = std::tan(angles::DegreesToRadians(m_fieldOfView) / 2.f);
+
+
+        return Matrix(
+            {
+                {1.f / (aspectRatio * verticalFov), 0.f, 0.f, 0.f},
+                {0.f, 1.f / verticalFov, 0.f, 0.f},
+                {0.f, 0.f, m_farPlaneDistance / (m_farPlaneDistance-m_nearPlaneDistance), -m_farPlaneDistance*m_nearPlaneDistance / (m_farPlaneDistance-m_nearPlaneDistance)},
+                {0.f, 0.f, 1.f, 0.f}
+            });
+    }
+
+    Matrix Camera::GetTranslationMatrix() const
+    {
+        return Matrix(
+        {
+            {1.f, 0.f, 0.f, m_origin.x},
+            {0.f, 1.f, 0.f, m_origin.y},
+            {0.f, 0.f, 1.f, m_origin.z},
+            {0.f, 0.f, 0.f, 1.f},
+        });
+    }
+
+    Matrix Camera::GetOrientationMatrix() const
+    {
+        const auto forward = Vector3::ForwardVector(m_viewAngles.x, m_viewAngles.y);
+        const auto right = Vector3::RightVector(m_viewAngles.x, m_viewAngles.y, m_viewAngles.z);
+        const auto up = Vector3::UpVector(m_viewAngles.x, m_viewAngles.y, m_viewAngles.z);
+
+
+        return Matrix(
+        {
+            {right.x,    up.y,        right.z,          0.f},
+            {up.x,       up.y,        up.y,             0.f},
+            {forward.x,  forward.y,   forward.z,        0.f},
+            {0.f,        0.f,         0.f,              1.f},
+        });
+    }
+
+    std::expected<Vector3, std::string_view> Camera::WorldToScreen(const Vector3 &worldPosition) const
+    {
+        const auto posVecAsMatrix = Matrix({{worldPosition.x, worldPosition.y, worldPosition.z, 1.f}});
+
+        const auto viewProjectionMatrix = GetViewMatrix() * GetProjectionMatrix();
+
+        auto projected = posVecAsMatrix * viewProjectionMatrix;
+
+        if (projected.At(0, 3) <= 0.f)
+            return std::unexpected("Projection point is out of camera field of view");
+
+        projected /= projected.At(0, 3);
+
+        projected *= Matrix::ToScreenMatrix(m_viewPort.x, m_viewPort.y);
+
+        return Vector3{projected.At(0, 0), projected.At(0, 1), projected.At(0, 2)};
+    }
+}