#include "camera.h"
#include <collections.h>
#include <glm/gtx/transform.hpp>
#include <maths.h>
#include <ray.h>

Camera::Camera(GlobalPosition3D pos, Angle fov, Angle aspect, GlobalDistance zNear, GlobalDistance zFar) :
	position {pos}, forward {::north}, up {::up}, near {zNear}, far {zFar}, view {},
	projection {
			glm::perspective(fov, aspect, static_cast<RelativeDistance>(zNear), static_cast<RelativeDistance>(zFar))},
	viewProjection {}, inverseViewProjection {}
{
	updateView();
}

Ray<GlobalPosition3D>
Camera::unProject(const ScreenRelCoord & mouse) const
{
	static constexpr const glm::vec4 SCREEN {0, 0, 1, 1};
	return {
			.start = position,
			.direction = glm::normalize(glm::unProject(mouse || 1.F, view, projection, SCREEN)),
	};
}

void
Camera::updateView()
{
	view = glm::lookAt({}, forward, up);
	viewProjection = projection * view;
	inverseViewProjection = glm::inverse(viewProjection);
}

Direction3D
Camera::upFromForward(const Direction3D & forward)
{
	const auto right = crossProduct(forward, ::down);
	return crossProduct(forward, right);
}

std::array<GlobalPosition4D, 4>
Camera::extentsAtDist(const GlobalDistance dist) const
{
	const auto clampToSeaFloor = [this, dist](GlobalPosition3D target) -> GlobalPosition4D {
		target += position;
		if (target.z < -1500) {
			const CalcPosition3D diff = target - position;
			const CalcDistance limit = -1500 - position.z;
			return {position + ((limit * diff) / diff.z), (limit * dist) / diff.z};
		}
		return {target, dist};
	};
	const auto depth = -(2.F * (static_cast<float>(dist - near)) * static_cast<float>(far))
					/ (static_cast<float>(dist) * (static_cast<float>(near - far)))
			- 1.F;
	static constexpr const std::array extents {-1.F, 1.F};
	static constexpr const auto cartesianExtents = extents * extents;
	return cartesianExtents * [&depth, this, &clampToSeaFloor](const auto & extent) {
		const glm::vec4 in {extent.first, extent.second, depth, 1.F};
		return clampToSeaFloor(perspective_divide(inverseViewProjection * in));
	};
}