Fix Underworld camera matrix and FOV

Author: TheIndra55

src/cdc/math/Math.cpp

@@ -1,4 +1,5 @@
 #include "Math.h"
+#include "util/Hooking.h"
 
 cdc::Vector3 cdc::Mul3x3(Matrix* matA, Vector3* vecB)
 {
@@ -26,4 +27,12 @@ cdc::Vector3 cdc::Mul3x4(Matrix* matA, Vector3* vecB)
 				matA->col3.vec128)));
 
 	return result;
+}
+
+void cdc::OrthonormalInverse3x4(cdc::Matrix* result, cdc::Matrix* m)
+{
+	// Imagine doing all this math yourself
+	auto addr = GET_ADDRESS(0x000000, 0x000000, 0x49BE10);
+
+	Hooking::Call(addr, result, m);
 }

src/cdc/math/Math.h

@@ -7,4 +7,6 @@ namespace cdc
 {
 	Vector3 Mul3x3(Matrix* matA, Vector3* vecB);
 	Vector3 Mul3x4(Matrix* matA, Vector3* vecB);
+
+	void OrthonormalInverse3x4(cdc::Matrix* result, cdc::Matrix* m);
 }

src/cdc/math/Vector.h

@@ -44,4 +44,8 @@ namespace cdc
 	class Euler : public Vector
 	{
 	};
+
+	class Quat : public Vector
+	{
+	};
 }

src/game/Camera.h

@@ -26,6 +26,11 @@ struct Camera
 	char pad1[16];
 
 	cdc::Matrix transform;
+	cdc::Matrix invTransform;
+	cdc::Vector3 position;
+	cdc::Quat orientation;
+
+	float fov;
 };
 #endif
 

src/modules/camera/Underworld.cpp

@@ -35,6 +35,7 @@ void UnderworldCamera::ToggleMode()
 		// Set the camera position to the player position
 		auto camera = CAMERA_GetCamera();
 		camera->transform.col3 = Game::GetPlayerInstance()->position;
+		camera->fov = static_cast<float>(M_PI) / 2;
 
 		m_rotation = { static_cast<float>(M_PI) / -2.f, 0.f, 0.f };
 	}
@@ -56,6 +57,8 @@ void UnderworldCamera::OnControl()
 	// Apply the rotation and position
 	camera->transform.Build(&m_rotation);
 	camera->transform.col3 = m_position;
+
+	cdc::OrthonormalInverse3x4(&camera->invTransform, &camera->transform);
 }
 
 void UnderworldCamera::Rotate(float x, float z)